diff --git a/js/msp/MSPCodes.js b/js/msp/MSPCodes.js index 4cf789fb..614fc213 100644 --- a/js/msp/MSPCodes.js +++ b/js/msp/MSPCodes.js @@ -189,5 +189,7 @@ var MSPCodes = { MSP2_INAV_MC_BRAKING: 0x200B, MSP2_INAV_SET_MC_BRAKING: 0x200C, - MSP2_INAV_SELECT_BATTERY_PROFILE: 0x2018 + MSP2_INAV_SELECT_BATTERY_PROFILE: 0x2018, + + MSP2_INAV_DEBUG: 0x2019 }; diff --git a/js/msp/MSPHelper.js b/js/msp/MSPHelper.js index 7ad94f59..f22d8be0 100644 --- a/js/msp/MSPHelper.js +++ b/js/msp/MSPHelper.js @@ -649,6 +649,10 @@ var mspHelper = (function (gui) { for (i = 0; i < 4; i++) SENSOR_DATA.debug[i] = data.getInt16((2 * i), 1); break; + case MSPCodes.MSP2_INAV_DEBUG: + for (i = 0; i < 8; i++) + SENSOR_DATA.debug[i] = data.getInt32((4 * i), 1); + break; case MSPCodes.MSP_SET_MOTOR: console.log('Motor Speeds Updated'); break; diff --git a/tabs/sensors.html b/tabs/sensors.html index 44bf0177..fe9723eb 100644 --- a/tabs/sensors.html +++ b/tabs/sensors.html @@ -337,6 +337,66 @@ + +
+
+
Debug 4
+
+
X:
+
0
+
+
+ + + + + + + +
+
+
Debug 5
+
+
X:
+
0
+
+
+ + + + + + + +
+
+
Debug 6
+
+
X:
+
0
+
+
+ + + + + + + +
+
+
Debug 7
+
+
X:
+
0
+
+
+ + + + + + diff --git a/tabs/sensors.js b/tabs/sensors.js index e8f0522f..41d76be5 100644 --- a/tabs/sensors.js +++ b/tabs/sensors.js @@ -276,6 +276,10 @@ TABS.sensors.initialize = function (callback) { initDataArray(1), initDataArray(1), initDataArray(1), + initDataArray(1), + initDataArray(1), + initDataArray(1), + initDataArray(1), initDataArray(1) ]; @@ -289,7 +293,11 @@ TABS.sensors.initialize = function (callback) { initGraphHelpers('#debug1', samples_debug_i), initGraphHelpers('#debug2', samples_debug_i), initGraphHelpers('#debug3', samples_debug_i), - initGraphHelpers('#debug4', samples_debug_i) + initGraphHelpers('#debug4', samples_debug_i), + initGraphHelpers('#debug5', samples_debug_i), + initGraphHelpers('#debug6', samples_debug_i), + initGraphHelpers('#debug7', samples_debug_i), + initGraphHelpers('#debug8', samples_debug_i) ]; var raw_data_text_ements = { @@ -449,7 +457,11 @@ TABS.sensors.initialize = function (callback) { return; } - MSP.send_message(MSPCodes.MSP_DEBUG, false, false, update_debug_graphs); + if (semver.gte(CONFIG.flightControllerVersion, '2.1.0')) { + MSP.send_message(MSPCodes.MSP2_INAV_DEBUG, false, false, update_debug_graphs); + } else { + MSP.send_message(MSPCodes.MSP_DEBUG, false, false, update_debug_graphs); + } }, rates.debug, true); } @@ -516,7 +528,7 @@ TABS.sensors.initialize = function (callback) { } function update_debug_graphs() { - for (var i = 0; i < 4; i++) { + for (var i = 0; i < 8; i++) { updateGraphHelperSize(debugHelpers[i]); addSampleToData(debug_data[i], samples_debug_i, [SENSOR_DATA.debug[i]]);