Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-09 17:38:32 -04:00
Code Issues Packages Projects Releases Wiki Activity

HAL_AVR: constrain Vcc used in voltage_average()

Browse Source 
this ensures a bad Vcc reading doesn't throw off analog inputs too
much
This commit is contained in:
Andrew Tridgell 2013-04-22 11:36:00 +10:00
parent a9da3c9d3d
commit 5f1bd1a452
1 changed files with 7 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/AP_HAL_AVR/AnalogIn_ADC.cpp
View File

@ -44,6 +44,13 @@ float ADCSource::voltage_average(void)
{ {
float vcc_mV = hal.analogin->channel(ANALOG_INPUT_BOARD_VCC)->read_average(); float vcc_mV = hal.analogin->channel(ANALOG_INPUT_BOARD_VCC)->read_average();
float v = read_average(); float v = read_average();
// constrain Vcc reading so that a bad Vcc doesn't throw off
// the reading of other sources too badly
if (vcc_mV < 4000) {
vcc_mV = 4000;
} else if (vcc_mV > 6000) {
vcc_mV = 6000;
}
return v * vcc_mV * 9.765625e-7; // 9.765625e-7 = 1.0/(1024*1000) return v * vcc_mV * 9.765625e-7; // 9.765625e-7 = 1.0/(1024*1000)
} }