WIP

Src/mmr_can_ecu_messages.c

@@ -0,0 +1,55 @@
+#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,
+  };
+}
+