mirror of https://github.com/rusefi/rusefi-1.git
67 lines
1.6 KiB
C++
67 lines
1.6 KiB
C++
#include "global.h"
|
|
|
|
#if EFI_CAN_SUPPORT
|
|
#include "AemXSeriesLambda.h"
|
|
#include "efilib.h"
|
|
|
|
#if EFI_TUNER_STUDIO
|
|
#include "tunerstudio_outputs.h"
|
|
#include "engine.h"
|
|
|
|
EXTERN_ENGINE;
|
|
#endif
|
|
|
|
AemXSeriesWideband::AemXSeriesWideband(uint8_t sensorIndex, SensorType type)
|
|
: CanSensorBase(
|
|
0x180 + sensorIndex, // 0th sensor is 0x180, others sequential above that
|
|
type,
|
|
MS2NT(21) // sensor transmits at 100hz, allow a frame to be missed
|
|
)
|
|
{}
|
|
|
|
void AemXSeriesWideband::decodeFrame(const CANRxFrame& frame, efitick_t nowNt) {
|
|
if (frame.DLC != 8) {
|
|
invalidate();
|
|
return;
|
|
}
|
|
|
|
// reports in 0.0001 lambda per LSB
|
|
uint16_t lambdaInt = SWAP_UINT16(frame.data16[0]);
|
|
float lambdaFloat = 0.0001f * lambdaInt;
|
|
|
|
// This bit is a reserved bit on AEM - but is set on rusEfi's controller
|
|
bool isRusefiController = frame.data8[7] & 0x80;
|
|
|
|
#if EFI_TUNER_STUDIO
|
|
// rusEfi controller sends some extra diagnostic data about its internal workings
|
|
if (isRusefiController && CONFIG(debugMode) == DBG_RUSEFI_WIDEBAND) {
|
|
float pumpDuty = frame.data8[2] / 255.0f;
|
|
float sensorEsr = frame.data8[3] * 4;
|
|
float heaterDuty = frame.data8[4] / 255.0f;
|
|
|
|
tsOutputChannels.debugFloatField1 = pumpDuty;
|
|
tsOutputChannels.debugFloatField2 = sensorEsr;
|
|
tsOutputChannels.debugFloatField3 = heaterDuty;
|
|
tsOutputChannels.debugFloatField4 = lambdaFloat;
|
|
}
|
|
#endif
|
|
|
|
// bit 6 indicates sensor fault
|
|
bool sensorFault = frame.data8[7] & 0x40;
|
|
if (sensorFault) {
|
|
invalidate();
|
|
return;
|
|
}
|
|
|
|
// bit 7 indicates valid
|
|
bool valid = frame.data8[6] & 0x80;
|
|
if (!valid) {
|
|
invalidate();
|
|
return;
|
|
}
|
|
|
|
setValidValue(lambdaFloat, nowNt);
|
|
}
|
|
|
|
#endif
|