Add modelId to MSP_PILOT

bob01 · Sep 2, 2024 · 52237ee · 52237ee
1 parent c05a133
commit 52237ee
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/src/main/msp/msp.c b/src/main/msp/msp.c
@@ -1103,6 +1103,7 @@ static bool mspProcessOutCommand(int16_t cmdMSP, sbuf_t *dst)
             for (int i = 0; i < nameLen; i++) {
                 sbufWriteU8(dst, pilotConfig()->name[i]);
             }
+            sbufWriteU8(dst, pilotConfig()->modelId);
         }
         break;
 
@@ -3201,6 +3202,9 @@ static mspResult_e mspProcessInCommand(mspDescriptor_t srcDesc, int16_t cmdMSP,
         for (unsigned int i = 0; i < MIN(MAX_NAME_LENGTH, dataSize); i++) {
             pilotConfigMutable()->name[i] = sbufReadU8(src);
         }
+        if (sbufBytesRemaining(src) >= 1) {
+            pilotConfigMutable()->modelId = sbufReadU8(src);
+        }
 #ifdef USE_OSD
         osdAnalyzeActiveElements();
 #endif