10 lines
435 B
C++
10 lines
435 B
C++
#include "Battery.h"
|
|||
|
|
#include "Config.h"
|
||
|
|
|
||
|
|
void Battery::update(float dt) {
|
||
|
|
if (BATTERY_SENSE_PIN == 255) return; // not fitted: stays 0
|
||
|
|
float v = analogRead(BATTERY_SENSE_PIN) * (BATTERY_ADC_REF_V / BATTERY_ADC_MAX) * BATTERY_DIVIDER;
|
||
|
|
if (!primed_) { volts_ = v; primed_ = true; return; }
|
||
|
|
float a = constrain(dt / 2.0f, 0.0f, 1.0f); // ~2 s time constant: servo load makes it sag and bounce
|
||
|
|
volts_ += (v - volts_) * a;
|
||
|
|
}
|