HoTT TLM / Support VSpeak turbine protocol (#3382)

* initial commit

* fix overflow

* update for fuel in ml

* Support HoTT turbine protocol, detects ESC and turbine protocol

* cleanup

* changed EGT back to 8bit to maintain comaptibility with Graupner radios

* update to VSpeak/ELRS telemetry spec V1.0

* cleanup

* updated source for pumpV/pumpPW due to VSpeak spec change

* deleted redundant code

* review comments

* code cleanup

* code cleanup

Author: mha1

src/src/rx-serial/SerialHoTT_TLM.cpp

@@ -29,6 +29,10 @@
 #define VOLT_MIN_CRSFRATE 5000
 #define AIRSPEED_MIN_CRSFRATE 5000
 
+constexpr uint8_t SIZE_8BIT = 1;
+constexpr uint8_t SIZE_16BIT = 2;
+constexpr uint8_t SIZE_24BIT = 3;
+
 extern Telemetry telemetry;
 
 SerialHoTT_TLM::SerialHoTT_TLM(Stream &out, Stream &in, const int8_t serial1TXpin)
@@ -265,6 +269,8 @@ void SerialHoTT_TLM::scheduleCRSFtelemetry(uint32_t now)
         else if (device[ESC].present)
         {
             deviceToUse = ESC;
+
+            escIsTurbine = esc.version == TURBINE_PROTOCOL;
         }
 
         sendCRSFrpm(now, deviceToUse);
@@ -348,13 +354,13 @@ void SerialHoTT_TLM::sendCRSFrpm(uint32_t now, HoTTDevices device)
 
     crsfRpm.p.source_id = device;
 
-    uint8_t payloadSize = 1 + 2 * 3;
+    uint8_t payloadSize = SIZE_8BIT + SIZE_24BIT * 2;
 
     if (device == EAM)
     {
         crsfRpm.p.rpm0 = htobe24(eam.rpm * HOTT_RPM_SCALE);
 
-        payloadSize = 1 + 3;
+        payloadSize = SIZE_8BIT + SIZE_24BIT * 1;
     }
     else if (device == GAM)
     {
@@ -363,8 +369,16 @@ void SerialHoTT_TLM::sendCRSFrpm(uint32_t now, HoTTDevices device)
     }
     else if (device == ESC)
     {
-        crsfRpm.p.rpm0 = htobe24(esc.rpm * HOTT_RPM_SCALE);
+        crsfRpm.p.rpm0 = htobe24(esc.rpm * HOTT_RPM_SCALE);                            // turbine: RPM
         crsfRpm.p.rpm1 = htobe24(esc.rpmMax * HOTT_RPM_SCALE);
+
+        if (escIsTurbine)
+        {
+            crsfRpm.p.rpm2 = htobe24((esc.becTemp + (esc.capacitorTemp << 8)));        // turbine: fuel in ml
+            crsfRpm.p.rpm3 = htobe24(esc.becCurrent);                                  // turbine: fuel flow in ml/min
+ 
+            payloadSize += SIZE_8BIT + SIZE_24BIT * 2;
+        }
     }
 
     crsfRouter.SetHeaderAndCrc((crsf_header_t *)&crsfRpm, CRSF_FRAMETYPE_RPM, CRSF_FRAME_SIZE(payloadSize), CRSF_ADDRESS_RADIO_TRANSMITTER);
@@ -389,7 +403,7 @@ void SerialHoTT_TLM::sendCRSFtemp(uint32_t now, HoTTDevices device)
 
     crsfTemp.p.source_id = device;
 
-    uint8_t payloadSize = 1 + 2 * 2;
+    uint8_t payloadSize = SIZE_8BIT + SIZE_16BIT * 2;
 
     if (device == EAM)
     {
@@ -405,11 +419,19 @@ void SerialHoTT_TLM::sendCRSFtemp(uint32_t now, HoTTDevices device)
     {
         crsfTemp.p.temperature[0] = htobe16((esc.escTemp - HOTT_TEMP_OFFSET) * HOTT_TEMP_SCALE);
         crsfTemp.p.temperature[1] = htobe16((esc.becTemp - HOTT_TEMP_OFFSET) * HOTT_TEMP_SCALE);
-        crsfTemp.p.temperature[2] = htobe16((esc.motorTemp - HOTT_TEMP_OFFSET) * HOTT_TEMP_SCALE);
+        crsfTemp.p.temperature[2] = htobe16((esc.motorTemp - HOTT_TEMP_OFFSET) * HOTT_TEMP_SCALE);          // turbine: EGT
         crsfTemp.p.temperature[3] = htobe16((esc.pumpTemp - HOTT_TEMP_OFFSET) * HOTT_TEMP_SCALE);
         crsfTemp.p.temperature[4] = htobe16((esc.auxTemp - HOTT_TEMP_OFFSET) * HOTT_TEMP_SCALE);
 
-        payloadSize = 1 + 2 * 5;
+        payloadSize = SIZE_8BIT + SIZE_16BIT * 5;
+
+        if (escIsTurbine)
+        {
+            crsfTemp.p.temperature[5] = htobe16((esc.throttle) * HOTT_TEMP_SCALE);                          // turbine: throttle %
+            crsfTemp.p.temperature[6] = htobe16(((int8_t)esc.turbineNumber) * HOTT_TEMP_SCALE);             // turbine: status
+
+            payloadSize += SIZE_8BIT + SIZE_16BIT * 2;
+        } 
     }
 
     crsfRouter.SetHeaderAndCrc((crsf_header_t *)&crsfTemp, CRSF_FRAMETYPE_TEMP, CRSF_FRAME_SIZE(payloadSize), CRSF_ADDRESS_RADIO_TRANSMITTER);
@@ -437,7 +459,7 @@ void SerialHoTT_TLM::sendCRSFcells(uint32_t now, HoTTDevices device)
 
     crsfCells.p.source_id = device;
 
-    uint8_t payloadSize = 1 + 14 * 2;
+    uint8_t payloadSize = SIZE_8BIT + SIZE_16BIT * 14;
 
     if (device == EAM)
     {
@@ -466,7 +488,7 @@ void SerialHoTT_TLM::sendCRSFcells(uint32_t now, HoTTDevices device)
         crsfCells.p.cell[4] = htobe16(gam.voltageCell5 * HOTT_CELL_SCALE);
         crsfCells.p.cell[5] = htobe16(gam.voltageCell6 * HOTT_CELL_SCALE);
 
-        payloadSize = 1 + 6 * 2;
+        payloadSize = SIZE_8BIT + SIZE_16BIT * 6;
     }
 
     crsfRouter.SetHeaderAndCrc((crsf_header_t *)&crsfCells, CRSF_FRAMETYPE_CELLS, CRSF_FRAME_SIZE(payloadSize), CRSF_ADDRESS_RADIO_TRANSMITTER);
@@ -491,7 +513,7 @@ void SerialHoTT_TLM::sendCRSFvolt(uint32_t now, HoTTDevices device)
 
     crsfVolt.p.source_id = 128 + device;
 
-    uint8_t payloadSize = 1 + 2 * 3;
+    uint8_t payloadSize = SIZE_8BIT + SIZE_16BIT * 3;
 
     if (device == EAM)
     {
@@ -507,10 +529,10 @@ void SerialHoTT_TLM::sendCRSFvolt(uint32_t now, HoTTDevices device)
     }
     else if (device == ESC)
     {
-        crsfVolt.p.cell[0] = htobe16(esc.inputVoltage * HOTT_VOLT_SCALE);
-        crsfVolt.p.cell[1] = htobe16(esc.becVoltage * HOTT_VOLT_SCALE);
+        crsfVolt.p.cell[0] = htobe16(esc.inputVoltage * HOTT_VOLT_SCALE);                   // turbine: ECU voltage
+        crsfVolt.p.cell[1] = htobe16(esc.becVoltage * HOTT_VOLT_SCALE);                     // turbine: pumpV or pumpPW depending on turbine
 
-        payloadSize = 1 + 2 * 2;
+        payloadSize = SIZE_8BIT + SIZE_16BIT * 2;
     }
 
     crsfRouter.SetHeaderAndCrc((crsf_header_t *)&crsfVolt, CRSF_FRAMETYPE_CELLS, CRSF_FRAME_SIZE(payloadSize), CRSF_ADDRESS_RADIO_TRANSMITTER);