1
0
Fork 0
mirror of https://github.com/iNavFlight/inav-configurator.git synced 2025-07-13 11:29:53 +03:00

updating MSP

This commit is contained in:
cTn 2013-11-08 10:24:12 +01:00
parent 542b75e8c8
commit 0497924b9c

View file

@ -21,6 +21,9 @@ var MSP_codes = {
MSP_MOTOR_PINS: 115,
MSP_BOXNAMES: 116,
MSP_PIDNAMES: 117,
MSP_WP: 118,
MSP_BOXIDS: 119,
MSP_SERVO_CONF: 120,
MSP_SET_RAW_RC: 200,
MSP_SET_RAW_GPS: 201,
@ -32,6 +35,9 @@ var MSP_codes = {
MSP_SET_MISC: 207,
MSP_RESET_CONF: 208,
MSP_SELECT_SETTING: 210,
MSP_SET_HEAD: 211,
MSP_SET_SERVO_CONF: 212,
MSP_SET_MOTOR: 214,
MSP_BIND: 240,
@ -89,6 +95,8 @@ var RC_tuning = {
var AUX_CONFIG = new Array();
var AUX_CONFIG_values = new Array();
var SERVO_CONFIG = new Array();
var SENSOR_DATA = {
gyroscope: [0, 0, 0],
accelerometer: [0, 0, 0],
@ -366,7 +374,7 @@ function onCharRead(readInfo) {
case 6: // CRC
if (message_checksum == data[i]) {
// process data
process_message(message_code, message_buffer);
process_message(message_code, message_buffer, message_length_expected);
}
// Reset variables
@ -426,7 +434,7 @@ function send_message(code, data) {
});
}
function process_message(code, data) {
function process_message(code, data, bytes) {
var view = new DataView(data, 0);
switch (code) {
@ -590,6 +598,22 @@ function process_message(code, data) {
case MSP_codes.MSP_PIDNAMES:
console.log(data);
break;
case MSP_codes.MSP_WP:
console.log(data);
break;
case MSP_codes.MSP_BOXIDS:
console.log(data);
break;
case MSP_codes.MSP_SERVO_CONF:
// drop previous data
SERVO_CONFIG = [];
for (var i = 0; i < bytes; i += 7) {
var arr = {'min': view.getInt16(i, 1), 'max': view.getInt16(i + 2, 1), 'middle': view.getInt16(i + 4, 1), 'rate': view.getInt8(6, 1)};
SERVO_CONFIG.push(arr);
}
break;
case MSP_codes.MSP_SET_RAW_RC:
console.log(data);
break;