ESC Setup / programming (bidirectional telemetry / forward programming) - implemented for YGE and Scorpion ESCs

src/main/cli/settings.c

@@ -489,11 +489,11 @@ const char * const lookupTableCrsfFmReuse[] = {
 };
 
 const char * const lookupTableCrsfAttReuse[] = {
-    "NONE", "THROTTLE", "ESC_TEMP", "MCU_TEMP", "MCU_LOAD", "SYS_LOAD", "RT_LOAD", "BEC_VOLTAGE", "BUS_VOLTAGE", "MCU_VOLTAGE",
+    "NONE", "THROTTLE", "ESC_TEMP", "ESC_PWM", "ESC_BEC_VOLTAGE", "ESC_BEC_CURRENT", "ESC_BEC_TEMP", "ESC_STATUS", "ESC_STATUS2", "MCU_TEMP", "MCU_LOAD", "SYS_LOAD", "RT_LOAD", "BEC_VOLTAGE", "BUS_VOLTAGE", "MCU_VOLTAGE",
 };
 
 const char * const lookupTableCrsfGpsReuse[] = {
-    "NONE", "HEADSPEED", "THROTTLE", "ESC_TEMP", "MCU_TEMP", "MCU_LOAD", "SYS_LOAD", "RT_LOAD",
+    "NONE", "HEADSPEED", "THROTTLE", "ESC_TEMP", "ESC_PWM", "ESC_THROTTLE", "ESC_BEC_VOLTAGE", "ESC_BEC_CURRENT", "ESC_BEC_TEMP", "ESC_STATUS", "ESC_STATUS2", "MCU_TEMP", "MCU_LOAD", "SYS_LOAD", "RT_LOAD", "BEC_VOLTAGE", "BUS_VOLTAGE", "MCU_VOLTAGE",
 };
 
 const char * const lookupTableCrsfGpsSatsReuse[] = {

src/main/msp/msp.c

@@ -804,6 +804,16 @@ static bool mspCommonProcessOutCommand(int16_t cmdMSP, sbuf_t *dst, mspPostProce
         sbufWriteU8(dst, escSensorConfig()->hw4_current_gain);
         sbufWriteU8(dst, escSensorConfig()->hw4_voltage_gain);
         break;
+
+    case MSP_ESC_PARAMETERS:
+        {
+            const uint8_t len = escGetParamBufferLength();
+            if (len == 0)
+                return false;
+
+            sbufWriteData(dst, escGetParamBuffer(), len);
+        }
+        break;
 #endif
 
     case MSP_BATTERY_STATE:
@@ -2641,6 +2651,19 @@ static mspResult_e mspProcessInCommand(mspDescriptor_t srcDesc, int16_t cmdMSP,
         escSensorConfigMutable()->hw4_current_gain = sbufReadU8(src);
         escSensorConfigMutable()->hw4_voltage_gain = sbufReadU8(src);
         break;
+
+    case MSP_SET_ESC_PARAMETERS:
+        {
+            const uint8_t len = escGetParamBufferLength();
+            if (len == 0)
+                return MSP_RESULT_ERROR;
+
+            sbufReadData(src, escGetParamUpdBuffer(), len);
+
+            if (!escCommitParameters())
+                return MSP_RESULT_ERROR;
+        }
+        break;
 #endif
 
     case MSP_EEPROM_WRITE:

src/main/msp/msp_protocol.h

@@ -234,6 +234,9 @@
 #define MSP_SET_NAV_CONFIG                   215
 #define MSP_SET_ESC_SENSOR_CONFIG            216
 
+#define MSP_ESC_PARAMETERS                   217
+#define MSP_SET_ESC_PARAMETERS               218
+
 #define MSP_SET_RESET_CURR_PID               219
 #define MSP_SET_SENSOR_ALIGNMENT             220
 #define MSP_SET_LED_STRIP_MODECOLOR          221