mirror of https://github.com/ArduPilot/ardupilot
Sailboat wind measurement working.
This commit is contained in:
parent
9da193f66c
commit
1d9efea9af
|
@ -41,7 +41,7 @@ static const Matrix3f compassOrientation = AP_COMPASS_COMPONENTS_UP_PINS_FORWARD
|
||||||
// compass orientation: See AP_Compass_HMC5843.h for possible values
|
// compass orientation: See AP_Compass_HMC5843.h for possible values
|
||||||
|
|
||||||
// battery monitoring
|
// battery monitoring
|
||||||
static const bool batteryMonitorEnabled = true;
|
static const bool batteryMonitorEnabled = false;
|
||||||
static const uint8_t batteryPin = 0;
|
static const uint8_t batteryPin = 0;
|
||||||
static const float batteryVoltageDivRatio = 6;
|
static const float batteryVoltageDivRatio = 6;
|
||||||
static const float batteryMinVolt = 10.0;
|
static const float batteryMinVolt = 10.0;
|
||||||
|
|
|
@ -44,6 +44,8 @@ private:
|
||||||
}
|
}
|
||||||
void autoLoop(const float dt) {
|
void autoLoop(const float dt) {
|
||||||
//_hal->debug->printf_P(PSTR("cont: ch1: %f\tch2: %f\n"),_hal->rc[ch_sail]->getRadioPosition(), _hal->rc[ch_str]->getRadioPosition());
|
//_hal->debug->printf_P(PSTR("cont: ch1: %f\tch2: %f\n"),_hal->rc[ch_sail]->getRadioPosition(), _hal->rc[ch_str]->getRadioPosition());
|
||||||
|
float windDir = analogRead(1);
|
||||||
|
_hal->debug->printf_P(PSTR("wind directiono: %f\n"),windDir);
|
||||||
// neglects heading command derivative
|
// neglects heading command derivative
|
||||||
float steering = pidStr.update(_guide->getHeadingError(), -_nav->getYawRate(), dt);
|
float steering = pidStr.update(_guide->getHeadingError(), -_nav->getYawRate(), dt);
|
||||||
float sail = 0;
|
float sail = 0;
|
||||||
|
|
|
@ -41,7 +41,7 @@ static const Matrix3f compassOrientation = AP_COMPASS_COMPONENTS_UP_PINS_FORWARD
|
||||||
// compass orientation: See AP_Compass_HMC5843.h for possible values
|
// compass orientation: See AP_Compass_HMC5843.h for possible values
|
||||||
|
|
||||||
// battery monitoring
|
// battery monitoring
|
||||||
static const bool batteryMonitorEnabled = true;
|
static const bool batteryMonitorEnabled = false;
|
||||||
static const uint8_t batteryPin = 0;
|
static const uint8_t batteryPin = 0;
|
||||||
static const float batteryVoltageDivRatio = 6;
|
static const float batteryVoltageDivRatio = 6;
|
||||||
static const float batteryMinVolt = 10.0;
|
static const float batteryMinVolt = 10.0;
|
||||||
|
|
|
@ -47,16 +47,17 @@ void setup() {
|
||||||
hal->scheduler = new AP_TimerProcess;
|
hal->scheduler = new AP_TimerProcess;
|
||||||
hal->scheduler->init(hal->isr_registry);
|
hal->scheduler->init(hal->isr_registry);
|
||||||
|
|
||||||
|
|
||||||
|
// initialize the adc
|
||||||
|
hal->debug->println_P(PSTR("initializing adc"));
|
||||||
|
hal->adc = new ADC_CLASS;
|
||||||
|
hal->adc->Init(hal->scheduler);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Sensor initialization
|
* Sensor initialization
|
||||||
*/
|
*/
|
||||||
if (hal->getMode() == MODE_LIVE) {
|
if (hal->getMode() == MODE_LIVE) {
|
||||||
|
|
||||||
|
|
||||||
hal->debug->println_P(PSTR("initializing adc"));
|
|
||||||
hal->adc = new ADC_CLASS;
|
|
||||||
hal->adc->Init(hal->scheduler);
|
|
||||||
|
|
||||||
if (batteryMonitorEnabled) {
|
if (batteryMonitorEnabled) {
|
||||||
hal->batteryMonitor = new AP_BatteryMonitor(batteryPin,batteryVoltageDivRatio,batteryMinVolt,batteryMaxVolt);
|
hal->batteryMonitor = new AP_BatteryMonitor(batteryPin,batteryVoltageDivRatio,batteryMinVolt,batteryMaxVolt);
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue