mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-22 07:44:03 -04:00
HAL_AVR: expand analog input test to more channels
This commit is contained in:
parent
5f4c5f8201
commit
fae396e64f
@ -6,30 +6,51 @@
|
||||
|
||||
#include <AP_HAL.h>
|
||||
#include <AP_HAL_AVR.h>
|
||||
#include <AP_HAL_AVR_SITL.h>
|
||||
#include <AP_HAL_PX4.h>
|
||||
#include <AP_HAL_Empty.h>
|
||||
|
||||
#if CONFIG_HAL_BOARD == HAL_BOARD_APM2
|
||||
const AP_HAL::HAL& hal = AP_HAL_AVR_APM2;
|
||||
#elif CONFIG_HAL_BOARD == HAL_BOARD_APM1
|
||||
const AP_HAL::HAL& hal = AP_HAL_AVR_APM1;
|
||||
#endif
|
||||
const AP_HAL::HAL& hal = AP_HAL_BOARD_DRIVER;
|
||||
|
||||
AP_HAL::AnalogSource* ch0;
|
||||
AP_HAL::AnalogSource* ch1;
|
||||
AP_HAL::AnalogSource* ch2;
|
||||
AP_HAL::AnalogSource* ch10;
|
||||
AP_HAL::AnalogSource* ch11;
|
||||
AP_HAL::AnalogSource* ch12;
|
||||
AP_HAL::AnalogSource* ch13;
|
||||
AP_HAL::AnalogSource* vcc;
|
||||
|
||||
void setup (void) {
|
||||
hal.console->printf_P(PSTR("Starting AP_HAL_AVR::AnalogIn test\r\n"));
|
||||
ch0 = hal.analogin->channel(0);
|
||||
ch1 = hal.analogin->channel(1);
|
||||
ch2 = hal.analogin->channel(2);
|
||||
ch10 = hal.analogin->channel(10);
|
||||
ch11 = hal.analogin->channel(11);
|
||||
ch12 = hal.analogin->channel(12);
|
||||
ch13 = hal.analogin->channel(13);
|
||||
vcc = hal.analogin->channel(ANALOG_INPUT_BOARD_VCC);
|
||||
}
|
||||
|
||||
void loop (void) {
|
||||
float meas_ch0 = ch0->read_average();
|
||||
float meas_ch1 = ch1->read_average();
|
||||
float meas_ch0 = ch0->read_average();
|
||||
float meas_ch1 = ch1->read_average();
|
||||
float meas_ch2 = ch2->read_average();
|
||||
float meas_ch10 = ch10->read_average();
|
||||
float meas_ch11 = ch11->read_average();
|
||||
float meas_ch12 = ch12->read_average();
|
||||
float meas_ch13 = ch13->read_average();
|
||||
float meas_vcc = vcc->read_average();
|
||||
hal.console->printf_P(PSTR("read ch0: %f, ch1: %f, vcc: %f\r\n"),
|
||||
meas_ch0, meas_ch1, meas_vcc);
|
||||
hal.console->printf_P(PSTR("read ch0:%.1f ch1:%.1f ch2:%.1f ch10:%.1f ch11:%.1f ch12:%.1f ch13:%.1f vcc:%.1f\n"),
|
||||
meas_ch0,
|
||||
meas_ch1,
|
||||
meas_ch2,
|
||||
meas_ch10,
|
||||
meas_ch11,
|
||||
meas_ch12,
|
||||
meas_ch13,
|
||||
meas_vcc);
|
||||
hal.scheduler->delay(10);
|
||||
}
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user