can: add counter to last byte of StandartData and DiagData

rusefi · Dec 6, 2023 · f338ac0 · f338ac0
1 parent 72d5a0d
commit f338ac0
Show file tree

Hide file tree

Showing 2 changed files with 12 additions and 2 deletions.
diff --git a/firmware/can.cpp b/firmware/can.cpp
@@ -139,8 +139,14 @@ void InitCan()
 
 void SendRusefiFormat(uint8_t ch)
 {
+    static uint8_t counter = 0;
     auto baseAddress = WB_DATA_BASE_ADDR + 2 * (ch + configuration->CanIndexOffset);
 
+    if (ch == 0)
+    {
+        counter++;
+    }
+
     const auto& sampler = GetSampler(ch);
     const auto& heater = GetHeaterController(ch);
 
@@ -158,6 +164,7 @@ void SendRusefiFormat(uint8_t ch)
         bool heaterClosedLoop = heater.IsRunningClosedLoop();
         bool nernstValid = nernstDc > (NERNST_TARGET - 0.1f) && nernstDc < (NERNST_TARGET + 0.1f);
         frame.get().Valid = (heaterClosedLoop && nernstValid) ? 0x01 : 0x00;
+        frame.get().counter = counter;
     }
 
     {
@@ -170,6 +177,7 @@ void SendRusefiFormat(uint8_t ch)
         frame.get().PumpDuty = GetPumpOutputDuty(ch) * 255;
         frame.get().Status = GetCurrentFault(ch);
         frame.get().HeaterDuty = GetHeaterDuty(ch) * 255;
+        frame.get().counter = counter;
     }
 }
 

diff --git a/for_rusefi/wideband_can.h b/for_rusefi/wideband_can.h
@@ -52,7 +52,9 @@ struct StandardData
     uint16_t Lambda;
     uint16_t TemperatureC;
 
-    uint16_t pad;
+    uint8_t pad;
+
+    uint8_t counter;
 };
 
 struct DiagData
@@ -63,7 +65,7 @@ struct DiagData
     Fault Status;
 
     uint8_t HeaterDuty;
-    uint8_t pad;
+    uint8_t counter;
 };
 
 static inline const char* describeFault(Fault fault) {