FOME-Tech
/
fome-fw
mirror of https://github.com/FOME-Tech/fome-fw.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

fix obd2 lambda PID

This commit is contained in:
Matthew Kennedy 2023-03-08 13:31:46 -08:00
parent 1918b734b0
commit e3a25429ef
1 changed files with 2 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
firmware/controllers/can/obd2.cpp
View File

@ -156,11 +156,9 @@ static void handleGetDataRequest(const CANRxFrame& rx, size_t busIndex) {
obdSendValue(_1_MODE, pid, 1, Sensor::getOrZero(SensorType::Tps1) * ODB_TPS_BYTE_PERCENT, busIndex); // (A*100/255)
break;
case PID_FUEL_AIR_RATIO_1: {
float lambda = Sensor::getOrZero(SensorType::Lambda1);
// phi = 1 / lambda
float phi = clampF(0, 1 / lambda, 1.99f);
float lambda = clampF(0, Sensor::getOrZero(SensorType::Lambda1), 1.99f);
uint16_t scaled = phi * 32768;
uint16_t scaled = lambda * 32768;
obdSendPacket(1, pid, 4, scaled << 16, busIndex);
break;