rusefi-1/firmware/init/sensor/init_vbatt.cpp

28 lines
789 B
C++

#include "pch.h"
#include "init.h"
#include "adc_subscription.h"
#include "functional_sensor.h"
#include "linear_func.h"
static LinearFunc vbattFunc;
static FunctionalSensor vbattSensor(SensorType::BatteryVoltage, /* timeout = */ MS2NT(100));
void initVbatt() {
vbattFunc.configure(0, 0, 1, engineConfiguration->vbattDividerCoeff, 0, 50);
vbattSensor.setFunction(vbattFunc);
if (!isAdcChannelValid(engineConfiguration->vbattAdcChannel)) {
return;
}
// adcVoltsPerVolt is set to 1.0 because vbatt doesn't go thru the analog input divider
AdcSubscription::SubscribeSensor(vbattSensor, engineConfiguration->vbattAdcChannel, /* filter HZ = */ 20, /* adcVoltsPerVolt = */ 1.0f);
vbattSensor.Register();
}
void deinitVbatt() {
AdcSubscription::UnsubscribeSensor(vbattSensor);
}