Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-21 15:25:36 +03:00
Code Issues Wiki Activity

Fix delta for battery filtering

Browse source 
fix
This commit is contained in:
borisbstyle 2016-02-12 10:20:30 +01:00
parent c8e7850c3d
commit f47b332b6f
1 changed files with 5 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

6
src/main/sensors/battery.c
View file

@ -65,10 +65,14 @@ static void updateBatteryVoltage(void)
{ {
uint16_t vbatSample; uint16_t vbatSample;
static filterStatePt1_t vbatFilterState; static filterStatePt1_t vbatFilterState;
static uint32_t previousTime;
uint32_t now;
// store the battery voltage with some other recent battery voltage readings // store the battery voltage with some other recent battery voltage readings
vbatSample = vbatLatestADC = adcGetChannel(ADC_BATTERY); vbatSample = vbatLatestADC = adcGetChannel(ADC_BATTERY);
float delta = micros() * 0.000001f; now = micros();
float delta = (now - previousTime) * 0.000001f;
previousTime = now;
vbatSample = filterApplyPt1(vbatSample, &vbatFilterState, VBATT_LPF_FREQ, delta); vbatSample = filterApplyPt1(vbatSample, &vbatFilterState, VBATT_LPF_FREQ, delta);
vbat = batteryAdcToVoltage(vbatSample); vbat = batteryAdcToVoltage(vbatSample);
} }