Fix handling of MSP_SERVO and MSP_MOTOR. Previously the code assumed

there was always 8 servos and 8 motors.
cleanflight · Jun 1, 2015 · 8d39b3f · 8d39b3f
1 parent 774fcf5
commit 8d39b3f
Showing 1 changed file with 4 additions and 2 deletions.
diff --git a/js/msp.js b/js/msp.js
@@ -240,16 +240,18 @@ var MSP = {
                 SENSOR_DATA.magnetometer[2] = data.getInt16(16, 1) / 1090;
                 break;
             case MSP_codes.MSP_SERVO:
+                var servoCount = message_length / 2;
                 var needle = 0;
-                for (var i = 0; i < 8; i++) {
+                for (var i = 0; i < servoCount; i++) {
                     SERVO_DATA[i] = data.getUint16(needle, 1);
 
                     needle += 2;
                 }
                 break;
             case MSP_codes.MSP_MOTOR:
+                var motorCount = message_length / 2;
                 var needle = 0;
-                for (var i = 0; i < 8; i++) {
+                for (var i = 0; i < motorCount; i++) {
                     MOTOR_DATA[i] = data.getUint16(needle, 1);
 
                     needle += 2;