Add MSP2_INAV_OUTPUT_MAPPING decoding

pull/401/head
Michel Pastor 7 years ago
parent 05355f749c
commit 1e981d50a4

@ -52,7 +52,8 @@ var CONFIG,
FW_CONFIG,
DEBUG_TRACE,
MIXER_CONFIG,
BATTERY_CONFIG;
BATTERY_CONFIG,
OUTPUT_MAPPING;
var FC = {
MAX_SERVO_RATE: 125,
@ -490,6 +491,8 @@ var FC = {
};
RXFAIL_CONFIG = [];
OUTPUT_MAPPING = [];
},
getFeatures: function () {
var features = [

@ -169,6 +169,7 @@ var MSPCodes = {
MSPV2_INAV_RATE_PROFILE: 0x2007,
MSPV2_INAV_SET_RATE_PROFILE: 0x2008,
MSPV2_INAV_AIR_SPEED: 0x2009,
MSPV2_INAV_OUTPUT_MAPPING: 0x200A,
MSP2_INAV_MIXER: 0x2010,
MSP2_INAV_SET_MIXER: 0x2011,

@ -1328,7 +1328,24 @@ var mspHelper = (function (gui) {
case MSPCodes.MSP2_INAV_OSD_SET_PREFERENCES:
console.log('OSD preferences saved');
break;
case MSPCodes.MSPV2_INAV_OUTPUT_MAPPING:
OUTPUT_MAPPING = [];
output_usage_values = [
{ usage: 'MC_MOTOR', value: (1<<2) },
{ usage: 'MC_SERVO', value: (1<<3) },
{ usage: 'FW_MOTOR', value: (1<<5) },
{ usage: 'FW_SERVO', value: (1<<6) }
];
for (i = 0; i < data.byteLength; ++i) {
output_usage_value = data.getUint8(i);
output_usage = [];
for (usage_value_index = 0; usage_value_index < output_usage_values.length; ++usage_value_index) {
if (output_usage_value & output_usage_values[usage_value_index].value)
output_usage.push(output_usage_values[usage_value_index].usage)
}
OUTPUT_MAPPING.push(output_usage);
}
break;
default:
console.log('Unknown code detected: ' + dataHandler.code);
} else {
@ -2528,6 +2545,10 @@ var mspHelper = (function (gui) {
MSP.send_message(MSPCodes.MSPV2_INAV_MISC, false, false, callback);
};
self.loadOutputMapping = function (callback) {
MSP.send_message(MSPCodes.MSPV2_INAV_OUTPUT_MAPPING, false, false, callback);
};
self.loadBatteryConfig = function (callback) {
MSP.send_message(MSPCodes.MSPV2_BATTERY_CONFIG, false, false, callback);
};

Loading…
Cancel
Save