Reworked msp.js

MISC.auto_disarm_delay, MISC.disarm_kill_switch are CONFIG.apiVersion dependent
pull/3/head
tricopterY 10 years ago
parent 911c09076b
commit 9261163ca2

@ -349,24 +349,33 @@ var MSP = {
break; break;
*/ */
case MSP_codes.MSP_MISC: // 24 bytes case MSP_codes.MSP_MISC: // 24 bytes
MISC.midrc = data.getInt16(0, 1); var offset = 0;
MISC.minthrottle = data.getUint16(2, 1); // 0-2000 MISC.midrc = data.getInt16(offset, 1);
MISC.maxthrottle = data.getUint16(4, 1); // 0-2000 offset += 2;
MISC.mincommand = data.getUint16(6, 1); // 0-2000 MISC.minthrottle = data.getUint16(offset, 1); // 0-2000
MISC.failsafe_throttle = data.getUint16(8, 1); // 1000-2000 offset += 2;
MISC.gps_type = data.getUint8(10); MISC.maxthrottle = data.getUint16(offset, 1); // 0-2000
MISC.gps_baudrate = data.getUint8(11); offset += 2;
MISC.gps_ubx_sbas = data.getInt8(12); MISC.mincommand = data.getUint16(offset, 1); // 0-2000
MISC.multiwiicurrentoutput = data.getUint8(13); offset += 2;
MISC.rssi_channel = data.getUint8(14); MISC.failsafe_throttle = data.getUint16(offset, 1); // 1000-2000
MISC.placeholder2 = data.getUint8(15); offset += 2;
MISC.mag_declination = data.getInt16(16, 1) / 10; // -18000-18000 MISC.gps_type = data.getUint8(offset);
MISC.vbatscale = data.getUint8(18, 1); // 10-200 MISC.gps_baudrate = data.getUint8(++offset);
MISC.vbatmincellvoltage = data.getUint8(19, 1) / 10; // 10-50 MISC.gps_ubx_sbas = data.getInt8(++offset);
MISC.vbatmaxcellvoltage = data.getUint8(20, 1) / 10; // 10-50 MISC.multiwiicurrentoutput = data.getUint8(++offset);
MISC.vbatwarningcellvoltage = data.getUint8(21, 1) / 10; // 10-50 MISC.rssi_channel = data.getUint8(++offset);
MISC.auto_disarm_delay = data.getUint8(22, 1);//tri MISC.placeholder2 = data.getUint8(++offset);
MISC.disarm_kill_switch = data.getUint8(23); MISC.mag_declination = data.getInt16(++offset, 1) / 10; // -18000-18000
offset += 2;
MISC.vbatscale = data.getUint8(offset, 1); // 10-200
MISC.vbatmincellvoltage = data.getUint8(++offset, 1) / 10; // 10-50
MISC.vbatmaxcellvoltage = data.getUint8(++offset, 1) / 10; // 10-50
MISC.vbatwarningcellvoltage = data.getUint8(++offset, 1) / 10; // 10-50
if (CONFIG.apiVersion >= 1.8) {
MISC.auto_disarm_delay = data.getUint8(++offset, 1);//tri
MISC.disarm_kill_switch = data.getUint8(++offset);
}
break; break;
case MSP_codes.MSP_MOTOR_PINS: case MSP_codes.MSP_MOTOR_PINS:
console.log(data); console.log(data);
@ -983,8 +992,10 @@ MSP.crunch = function (code) {
buffer.push(MISC.vbatmincellvoltage * 10); buffer.push(MISC.vbatmincellvoltage * 10);
buffer.push(MISC.vbatmaxcellvoltage * 10); buffer.push(MISC.vbatmaxcellvoltage * 10);
buffer.push(MISC.vbatwarningcellvoltage * 10); buffer.push(MISC.vbatwarningcellvoltage * 10);
if (CONFIG.apiVersion >= 1.8) {
buffer.push(MISC.auto_disarm_delay); buffer.push(MISC.auto_disarm_delay);
buffer.push(MISC.disarm_kill_switch); buffer.push(MISC.disarm_kill_switch);
}
break; break;
case MSP_codes.MSP_SET_SERVO_CONF: case MSP_codes.MSP_SET_SERVO_CONF:
for (var i = 0; i < SERVO_CONFIG.length; i++) { for (var i = 0; i < SERVO_CONFIG.length; i++) {

Loading…
Cancel
Save