CAN: set sensor type command

Author: dron0gus

firmware/boards/f0_module/port.cpp

@@ -132,7 +132,7 @@ void SetConfiguration()
 
 SensorType GetSensorType()
 {
-    return SensorType::LSU49;
+    return config.sensorType;
 }
 
 void SetupESRDriver(SensorType)

firmware/can.cpp

@@ -151,6 +151,19 @@ void CanRxThread(void*)
             SetConfiguration();
             SendAck();
         }
+        // Set sensor type command?
+        else if (CAN_ID(frame) == WB_MSG_SET_SENS_TYPE &&
+            frame.DLC == 2 && frame.data8[0] == BoardGetHwId())
+        {
+            uint8_t type = frame.data8[1];
+            if ((type <= (uint8_t)SensorType::LSU49_FAE) &&
+                (type >= (uint8_t)SensorType::LSU49)) {
+                // TODO: check if HW supports this type of sensor
+                configuration->sensorType = (SensorType)type;
+                SetConfiguration();
+                SendAck();
+            }
+        }
         else if (CAN_ID(frame) == WB_MSG_PING && frame.DLC == 1)
         {
             // broadcast or with our HW ID
@@ -220,6 +233,9 @@ void SendRusefiFormat(uint8_t ch)
         frame.get().TemperatureC = sampler.GetSensorTemperature();
         bool heaterClosedLoop = heater.IsRunningClosedLoop();
         frame.get().Valid = (heaterClosedLoop && lambdaValid) ? 0x01 : 0x00;
+        // Sensor type flags
+        frame.get().Valid |= (GetSensorType() == SensorType::LSU49) ? 0x02 : 0x00;
+        frame.get().Valid |= (GetSensorType() == SensorType::LSU49_FAE) ? 0x04 : 0x00;
     }
 
     if (configuration->afr[ch].RusEfiTxDiag) {

for_rusefi/wideband_can.h

@@ -14,6 +14,7 @@
 #define WB_OPCODE_SET_INDEX 4
 #define WB_OPCODE_ECU_STATUS 5
 #define WB_OPCODE_PING 6
+#define WB_OPCODE_SET_SENS_TYPE 7
 
 #define WB_BL_BASE (WB_BL_HEADER << 4)
 #define WB_BL_CMD(opcode, extra) (((WB_BL_BASE | (opcode)) << 16) | (extra))
@@ -38,6 +39,8 @@
 #define WB_MGS_ECU_STATUS WB_BL_CMD(WB_OPCODE_ECU_STATUS, 0)
 // 0xEF6'0000
 #define WB_MSG_PING WB_BL_CMD(WB_OPCODE_PING, 0)
+// 0xEF7'0000
+#define WB_MSG_SET_SENS_TYPE WB_BL_CMD(WB_OPCODE_SET_SENS_TYPE, 0)
 
 #define WB_DATA_BASE_ADDR 0x190