Stefano Calabretti
56 lines
1.8 KiB
C
56 lines
1.8 KiB
C
#include "mmr_can_ecu_messages.h"
|
|
#include "mmr_can.h"
|
|
|
|
#define ecuToHost(byteA, byteB) ((byteA << 8) | (byteB))
|
|
|
|
|
|
EcuPedalThrottle MMR_CAN_GetEcuPedalThrottle(MmrCanMessage *message) {
|
|
uint8_t *buffer = message->store
|
|
return (EcuPedalThrottle) {
|
|
.apsAVoltage = ecuToHost(buffer[0], buffer[1]) / 1000,
|
|
.apsBVoltage = ecuToHost(buffer[2], buffer[3]) / 1000,
|
|
.throttleAVoltage = ecuToHost(buffer[4], buffer[5]) / 1000,
|
|
.throttleBVoltage = ecuToHost(buffer[6], buffer[7]) / 1000,
|
|
};
|
|
}
|
|
|
|
EcuTemperatures MMR_CAN_GetEcuTemperatures(MmrCanMessage *message) {
|
|
uint8_t *buffer = message->store
|
|
return (EcuTemperatures) {
|
|
.oil = ecuToHost(buffer[0], buffer[1]) - 40,
|
|
.engine = ecuToHost(buffer[2], buffer[3]) - 40,
|
|
.intake = ecuToHost(buffer[4], buffer[5]) - 40,
|
|
.ambient = ecuToHost(buffer[6], buffer[7]) - 40,
|
|
};
|
|
}
|
|
|
|
EcuEngineFn1 MMR_CAN_GetEcuEngineFn1(MmrCanMessage *message) {
|
|
uint8_t *buffer = message->store
|
|
return (EcuEngineFn1) {
|
|
.engineRpm = ecuToHost(buffer[0], buffer[1]),
|
|
.gear = ecuToHost(buffer[2], buffer[3])
|
|
.vehicleSpeed = ecuToHost(buffer[4], buffer[5]) / 100,
|
|
.throttle = ecuToHost(buffer[6], buffer[7]) / 100,
|
|
};
|
|
}
|
|
|
|
EcuPressures MMR_CAN_GetEcuPressures(MmrCanMessage *message) {
|
|
uint8_t *buffer = message->store
|
|
return (EcuPressures) {
|
|
.oil = ecuToHost(buffer[0], buffer[1]) / 100,
|
|
.fuel = ecuToHost(buffer[2], buffer[3]) / 100,
|
|
.intake = ecuToHost(buffer[4], buffer[5]) / 10,
|
|
.ambient = ecuToHost(buffer[6], buffer[7]) / 10,
|
|
};
|
|
}
|
|
|
|
EcuEngineFn2 MMR_CAN_GetEcuEngineFn2(MmrCanMessage *message) {
|
|
uint8_t *buffer = message->store
|
|
return (EcuEngineFn2) {
|
|
.batteryVoltage = ecuToHost(buffer[0], buffer[1]) / 1000,
|
|
.acceleratorPedal = ecuToHost(buffer[2], buffer[3]) / 100,
|
|
.fanControl = ecuToHost(buffer[4], buffer[5]) / 100,
|
|
};
|
|
}
|
|
|