From 0730408796bce23abef05486e977a3e84efa0cb8 Mon Sep 17 00:00:00 2001 From: "Pawel Spychalski (DzikuVx)" Date: Fri, 26 Jan 2018 15:46:05 +0100 Subject: [PATCH] MSP2_COMMON_MOTOR_MIXER support --- js/msp/MSPHelper.js | 19 +++++++++++++++++++ 1 file changed, 19 insertions(+) diff --git a/js/msp/MSPHelper.js b/js/msp/MSPHelper.js index e634b62c..6c68111d 100644 --- a/js/msp/MSPHelper.js +++ b/js/msp/MSPHelper.js @@ -366,6 +366,25 @@ var mspHelper = (function (gui) { break; + case MSPCodes.MSP2_COMMON_MOTOR_MIXER: + MOTOR_RULES.flush(); + + if (data.byteLength % 8 === 0) { + for (i = 0; i < data.byteLength; i += 8) { + var rule = new MotorMixRule(0, 0, 0, 0); + + MOTOR_RULES.put(rule.fromMsp( + data.getUint16(i + 0, true), + data.getUint16(i + 2, true), + data.getUint16(i + 4, true), + data.getUint16(i + 6, true) + )); + } + } + MOTOR_RULES.cleanup(); + + break; + case MSPCodes.MSP_SERVO_CONFIGURATIONS: //noinspection JSUndeclaredVariable SERVO_CONFIG = []; // empty the array as new data is coming in