mirror of https://github.com/ArduPilot/ardupilot
81 lines
1.3 KiB
C++
81 lines
1.3 KiB
C++
|
#include "AnalogIn.h"
|
||
|
#include "RCOutput.h"
|
||
|
|
||
|
using namespace QURT;
|
||
|
|
||
|
#define ANALOG_PIN_VOLTAGE 1
|
||
|
#define ANALOG_PIN_CURRENT 2
|
||
|
|
||
|
#define NUM_CHANNELS 10
|
||
|
|
||
|
extern const AP_HAL::HAL &hal;
|
||
|
|
||
|
// static table of voltage sources
|
||
|
static AnalogSource sources[NUM_CHANNELS];
|
||
|
|
||
|
AnalogIn::AnalogIn()
|
||
|
{
|
||
|
}
|
||
|
|
||
|
float AnalogSource::read_average()
|
||
|
{
|
||
|
return read_latest();
|
||
|
}
|
||
|
|
||
|
float AnalogSource::voltage_average()
|
||
|
{
|
||
|
return read_latest();
|
||
|
}
|
||
|
|
||
|
float AnalogSource::voltage_latest()
|
||
|
{
|
||
|
return read_latest();
|
||
|
}
|
||
|
|
||
|
float AnalogSource::read_latest()
|
||
|
{
|
||
|
const auto *rcout = (QURT::RCOutput *)hal.rcout;
|
||
|
switch (pin) {
|
||
|
case ANALOG_PIN_VOLTAGE:
|
||
|
return rcout->get_voltage();
|
||
|
case ANALOG_PIN_CURRENT:
|
||
|
return rcout->get_current();
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
bool AnalogSource::set_pin(uint8_t p)
|
||
|
{
|
||
|
switch (p) {
|
||
|
case ANALOG_PIN_VOLTAGE:
|
||
|
case ANALOG_PIN_CURRENT:
|
||
|
pin = p;
|
||
|
return true;
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
void AnalogIn::init()
|
||
|
{
|
||
|
}
|
||
|
|
||
|
AP_HAL::AnalogSource* AnalogIn::channel(int16_t n)
|
||
|
{
|
||
|
if (next_chan >= ARRAY_SIZE(sources)) {
|
||
|
return nullptr;
|
||
|
}
|
||
|
return &sources[next_chan++];
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
not available, report 5v to keep GCS happy
|
||
|
*/
|
||
|
float AnalogIn::board_voltage(void)
|
||
|
{
|
||
|
return 5.0f;
|
||
|
}
|