Fixed serialization in MSP_MOTOR command.

NOS-Copter · Feb 1, 2016 · 6a4823a · 6a4823a
1 parent 4a9e90b
commit 6a4823a
Showing 1 changed file with 4 additions and 1 deletion.
diff --git a/src/main/io/serial_msp.c b/src/main/io/serial_msp.c
@@ -731,7 +731,10 @@ static bool processOutCommand(uint8_t cmdMSP)
         break;
 #endif
     case MSP_MOTOR:
-        s_struct((uint8_t *)motor, 16);
+        headSerialReply(16);
+        for (i = 0; i < 8; i++) {
+            serialize16(i < MAX_SUPPORTED_MOTORS ? motor[i] : 0);
+        }
         break;
     case MSP_RC:
         headSerialReply(2 * rxRuntimeConfig.channelCount);