add profile to extended telemetry

Author: error414

src/main/telemetry/crsf.c

@@ -460,6 +460,7 @@ static telemetrySensor_t crsfCustomTelemetrySensors[] =
     TLM_SENSOR(CPU_LOAD,                0x1150,   500,  3000,    10,    U8),
     TLM_SENSOR(FLIGHT_MODE,             0x1251,   200,  3000,    0,     U16),
     TLM_SENSOR(ARMING_FLAGS,            0x1252,   200,  3000,    0,     U8),
+    TLM_SENSOR(PROFILES,                0x1253,   200,  3000,    0,     U24),
 };
 
 telemetrySensor_t * crsfGetCustomSensor(sensor_id_e id)

src/main/telemetry/sensors.c

@@ -166,6 +166,10 @@ int telemetrySensorValue(sensor_id_e id)
         ////// SYSTEM  //////////////////////////
         case TELEM_FLIGHT_MODE:
             return (int)flightModeFlags;
+        case TELEM_PROFILES:
+            return ((getConfigBatteryProfile() & 0xFF) << 16) |
+                   ((getConfigMixerProfile() & 0xFF) << 8) |
+                   ((getConfigProfile() & 0xFF));
         case TELEM_ARMING_FLAGS:
             return (int)armingFlags;
         case TELEM_CPU_LOAD:
@@ -376,11 +380,12 @@ bool telemetrySensorAllowed(sensor_id_e id)
         ////// SYSTEM  //////////////////////////
         case TELEM_CPU_LOAD:
             return true;
-
         case TELEM_FLIGHT_MODE:
             return true;
         case TELEM_ARMING_FLAGS:
             return true;
+        case TELEM_PROFILES:
+            return true;
 
         ////////////////////////////////////////
         ////// LEGACY SMARTPORT  ////////////////

src/main/telemetry/sensors.h

@@ -92,34 +92,35 @@ typedef enum
     ////// SYSTEM  //////////////////////////
     TELEM_CPU_LOAD                      = 42,
     TELEM_FLIGHT_MODE                   = 43,
-    TELEM_ARMING_FLAGS                  = 44,
-
-    /////////////////////////////////////////
-    ////// LEGACY SMARTPORT  ////////////////
-    TELEM_LEGACY_VFAS                   = 45,
-    TELEM_LEGACY_CURRENT                = 46,
-    TELEM_LEGACY_ALTITUDE               = 47,
-    TELEM_LEGACY_FUEL                   = 48,
-    TELEM_LEGACY_VARIO                  = 49,
-    TELEM_LEGACY_HEADING                = 50,
-    TELEM_LEGACY_PITCH                  = 51,
-    TELEM_LEGACY_ROLL                   = 52,
-    TELEM_LEGACY_ACCX                   = 53,
-    TELEM_LEGACY_ACCY                   = 54,
-    TELEM_LEGACY_ACCZ                   = 55,
-    TELEM_LEGACY_MODES                  = 56,
-
-    TELEM_LEGACY_GNSS                   = 57,
-    TELEM_LEGACY_SPEED                  = 58,
-    TELEM_LEGACY_LAT                    = 59,
-    TELEM_LEGACY_LON                    = 60,
-    TELEM_LEGACY_HOME_DIST              = 61,
-    TELEM_LEGACY_GPS_ALT                = 62,
-    TELEM_LEGACY_FPV                    = 63,
-    TELEM_LEGACY_AZIMUTH                = 64,
-
-    TELEM_LEGACY_A4                     = 65,
-    TELEM_LEGACY_ASPD                   = 66,
+    TELEM_PROFILES                      = 44,
+    TELEM_ARMING_FLAGS                  = 45,
+
+/////////////////////////////////////////
+////// LEGACY SMARTPORT  ////////////////
+    TELEM_LEGACY_VFAS                   = 46,
+    TELEM_LEGACY_CURRENT                = 47,
+    TELEM_LEGACY_ALTITUDE               = 48,
+    TELEM_LEGACY_FUEL                   = 49,
+    TELEM_LEGACY_VARIO                  = 50,
+    TELEM_LEGACY_HEADING                = 51,
+    TELEM_LEGACY_PITCH                  = 52,
+    TELEM_LEGACY_ROLL                   = 53,
+    TELEM_LEGACY_ACCX                   = 54,
+    TELEM_LEGACY_ACCY                   = 55,
+    TELEM_LEGACY_ACCZ                   = 56,
+    TELEM_LEGACY_MODES                  = 57,
+
+    TELEM_LEGACY_GNSS                   = 58,
+    TELEM_LEGACY_SPEED                  = 59,
+    TELEM_LEGACY_LAT                    = 60,
+    TELEM_LEGACY_LON                    = 61,
+    TELEM_LEGACY_HOME_DIST              = 62,
+    TELEM_LEGACY_GPS_ALT                = 63,
+    TELEM_LEGACY_FPV                    = 64,
+    TELEM_LEGACY_AZIMUTH                = 65,
+
+    TELEM_LEGACY_A4                     = 66,
+    TELEM_LEGACY_ASPD                   = 67,
 
     TELEM_SENSOR_COUNT
 

src/main/telemetry/smartport.c

@@ -240,6 +240,7 @@ static telemetrySensor_t smartportTelemetrySensors[] =
         TLM_SENSOR(CPU_LOAD,                0x51D0,   200,  3000,   1,  10,   10,   INT),
         TLM_SENSOR(FLIGHT_MODE,             0x5121,   100,  3000,   1,   1,   0,    INT),
         TLM_SENSOR(ARMING_FLAGS,            0x5122,   100,  3000,   1,   1,   0,    INT),
+        TLM_SENSOR(PROFILES,                0x5123,   100,  3000,   1,   1,   0,    INT),
 
 #ifdef USE_ESC_SENSOR
         TLM_SENSOR(ESC1_RPM,                0x5130,   100,  3000,   1,  10,   0,    INT),