mirror of https://github.com/FOME-Tech/fome-fw.git
41 lines
852 B
C++
41 lines
852 B
C++
|
#include "main.h"
|
||
|
|
#include "engine_configuration.h"
|
||
|
|
#include "interpolation.h"
|
||
|
|
#include "boards.h"
|
||
|
|
#include "adc_inputs.h"
|
||
|
|
|
||
|
|
extern engine_configuration_s *engineConfiguration;
|
||
|
|
|
||
|
|
float getAfr(void) {
|
||
|
|
afr_sensor_s * sensor = &engineConfiguration->afrSensor;
|
||
|
|
|
||
|
|
float volts = getVoltageDivided(sensor->afrAdcChannel);
|
||
|
|
|
||
|
|
return interpolate(sensor->v1, sensor->value1, sensor->v2, sensor->value2, volts);
|
||
|
|
}
|
||
|
|
|
||
|
|
void initEgoSensor(afr_sensor_s *sensor, ego_sensor_e type) {
|
||
|
|
|
||
|
|
switch (type) {
|
||
|
|
case ES_BPSX_D1:
|
||
|
|
/**
|
||
|
|
* This decodes BPSX D1 Wideband Controller analog signal
|
||
|
|
*/
|
||
|
|
sensor->v1 = 0;
|
||
|
|
sensor->value1 = 9;
|
||
|
|
sensor->v2 = 5;
|
||
|
|
sensor->value2 = 19;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case ES_Innovate_MTX_L:
|
||
|
|
sensor->v1 = 0;
|
||
|
|
sensor->value1 = 7.35;
|
||
|
|
sensor->v2 = 5;
|
||
|
|
sensor->value2 = 22.39;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
firmwareError("Unexpected EGO %d", type);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|