betaflight-configurator/tabs/pid_tuning.js

812 lines
30 KiB
JavaScript
Raw Normal View History

'use strict';
TABS.pid_tuning = {
2016-07-26 14:46:13 +00:00
showAllPids: false,
profileDirty: false,
loadingProfile: true
};
2014-08-12 14:20:26 +00:00
TABS.pid_tuning.initialize = function (callback) {
var self = this;
2016-07-06 23:55:15 +00:00
if (GUI.active_tab != 'pid_tuning') {
GUI.active_tab = 'pid_tuning';
}
2014-03-08 05:25:15 +00:00
// requesting MSP_STATUS manually because it contains CONFIG.profile
MSP.promise(MSP_codes.MSP_STATUS).then(function() {
2016-07-29 09:37:04 +00:00
if (semver.gte(CONFIG.apiVersion, CONFIGURATOR.pidControllerChangeMinApiVersion)) {
return MSP.promise(MSP_codes.MSP_PID_CONTROLLER);
}
}).then(function() {
return MSP.promise(MSP_codes.MSP_PIDNAMES)
}).then(function() {
return MSP.promise(MSP_codes.MSP_PID);
}).then(function () {
2016-07-30 17:24:35 +00:00
if (semver.gte(CONFIG.flightControllerVersion, "2.9.0") && semver.lt(CONFIG.flightControllerVersion, "3.0.0")) {
return MSP.promise(MSP_codes.MSP_SPECIAL_PARAMETERS);
}
}).then(function() {
if (semver.gte(CONFIG.flightControllerVersion, "2.8.2")) {
return MSP.promise(MSP_codes.MSP_PID_ADVANCED);
}
}).then(function() {
return MSP.promise(MSP_codes.MSP_RC_TUNING);
}).then(function() {
return MSP.promise(MSP_codes.MSP_FILTER_CONFIG);
}).then(function() {
var promise = true;
if (CONFIG.flightControllerIdentifier === "BTFL" && semver.gte(CONFIG.flightControllerVersion, "2.8.0")) {
promise = MSP.promise(MSP_codes.MSP_BF_CONFIG);
}
return promise;
}).then(function() {
$('#content').load("./tabs/pid_tuning.html", process_html);
});
2015-03-11 20:24:46 +00:00
function pid_and_rc_to_form() {
if (semver.gte(CONFIG.flightControllerVersion, "2.8.1")) {
$('input[name="vbatpidcompensation"]').prop('checked', ADVANCED_TUNING.vbatPidCompensation !== 0);
}
2016-07-26 14:46:13 +00:00
if (semver.gte(CONFIG.flightControllerVersion, "2.8.2")) {
$('.delta select').val(ADVANCED_TUNING.deltaMethod);
}
2015-03-11 20:34:02 +00:00
// Fill in the data from PIDs array
var i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .ROLL input').each(function () {
switch (i) {
case 0:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[0][i++]);
break;
case 1:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[0][i++]);
break;
case 2:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[0][i++]);
break;
}
});
2014-03-08 05:25:15 +00:00
i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .PITCH input').each(function () {
switch (i) {
case 0:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[1][i++]);
break;
case 1:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[1][i++]);
break;
case 2:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[1][i++]);
break;
}
});
2014-03-08 05:25:15 +00:00
i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .YAW input').each(function () {
switch (i) {
case 0:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[2][i++]);
break;
case 1:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[2][i++]);
break;
case 2:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[2][i++]);
break;
}
});
2013-04-08 23:09:11 +00:00
i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .ALT input').each(function () {
switch (i) {
case 0:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[3][i++]);
break;
case 1:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[3][i++]);
break;
case 2:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[3][i++]);
break;
}
});
2013-04-08 23:09:11 +00:00
i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .Pos input').each(function () {
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[4][i++]);
});
2014-03-08 05:25:15 +00:00
i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .PosR input').each(function () {
switch (i) {
case 0:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[5][i++]);
break;
case 1:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[5][i++]);
break;
case 2:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[5][i++]);
break;
}
});
2013-04-08 23:09:11 +00:00
i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .NavR input').each(function () {
switch (i) {
case 0:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[6][i++]);
break;
case 1:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[6][i++]);
break;
case 2:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[6][i++]);
break;
}
});
2013-04-08 23:09:11 +00:00
i = 0;
$('.pid_tuning .ANGLE input').each(function () {
switch (i) {
case 0:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[7][i++]);
break;
}
});
$('.pid_tuning .HORIZON input').each(function () {
switch (i) {
case 1:
$(this).val(PIDs[7][i++]);
break;
case 2:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[7][i++]);
break;
}
});
2013-04-08 23:09:11 +00:00
i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .MAG input').each(function () {
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[8][i++]);
});
2013-04-08 23:49:49 +00:00
i = 0;
2014-08-12 14:20:26 +00:00
$('.pid_tuning .Vario input').each(function () {
switch (i) {
case 0:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[9][i++]);
break;
case 1:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[9][i++]);
break;
case 2:
2016-06-17 18:27:10 +00:00
$(this).val(PIDs[9][i++]);
break;
}
});
2014-03-08 05:25:15 +00:00
// Fill in data from RC_tuning object
$('.pid_tuning input[name="rc_rate"]').val(RC_tuning.RC_RATE.toFixed(2));
$('.pid_tuning input[name="roll_pitch_rate"]').val(RC_tuning.roll_pitch_rate.toFixed(2));
$('.pid_tuning input[name="roll_rate"]').val(RC_tuning.roll_rate.toFixed(2));
$('.pid_tuning input[name="pitch_rate"]').val(RC_tuning.pitch_rate.toFixed(2));
$('.pid_tuning input[name="yaw_rate"]').val(RC_tuning.yaw_rate.toFixed(2));
$('.pid_tuning input[name="rc_expo"]').val(RC_tuning.RC_EXPO.toFixed(2));
$('.pid_tuning input[name="rc_yaw_expo"]').val(RC_tuning.RC_YAW_EXPO.toFixed(2));
$('.pid_tuning input[name="rc_rate_yaw"]').val(RC_tuning.rcYawRate.toFixed(2));
2016-07-26 14:46:13 +00:00
$('.throttle input[name="mid"]').val(RC_tuning.throttle_MID.toFixed(2));
$('.throttle input[name="expo"]').val(RC_tuning.throttle_EXPO.toFixed(2));
2016-06-28 13:17:33 +00:00
$('.tpa input[name="tpa"]').val(RC_tuning.dynamic_THR_PID.toFixed(2));
$('.tpa input[name="tpa-breakpoint"]').val(RC_tuning.dynamic_THR_breakpoint);
if (semver.lt(CONFIG.apiVersion, "1.10.0")) {
$('.pid_tuning input[name="rc_yaw_expo"]').hide();
$('.pid_tuning input[name="rc_expo"]').attr("rowspan", "3");
}
2016-06-21 00:16:22 +00:00
$('.pid_tuning input[name="gyro"]').val(FILTER_CONFIG.gyro_soft_lpf_hz);
$('.pid_tuning input[name="dterm"]').val(FILTER_CONFIG.dterm_lpf_hz);
$('.pid_tuning input[name="yaw"]').val(FILTER_CONFIG.yaw_lpf_hz);
2016-06-24 12:29:46 +00:00
2016-07-26 14:46:13 +00:00
if (semver.lt(CONFIG.flightControllerVersion, "2.8.1")) {
2016-06-24 12:29:46 +00:00
$('.pid_filter').hide();
$('.pid_tuning input[name="rc_rate_yaw"]').hide();
}
}
function form_to_pid_and_rc() {
if (semver.gte(CONFIG.flightControllerVersion, "2.8.0")) {
BF_CONFIG.features.updateData($('.pid_tuning input[name="SUPEREXPO_RATES"]'));
}
if (semver.gte(CONFIG.flightControllerVersion, "2.8.1")) {
ADVANCED_TUNING.vbatPidCompensation = $('input[name="vbatpidcompensation"]').is(':checked') ? 1 : 0;
}
2016-07-26 14:46:13 +00:00
if (semver.gte(CONFIG.flightControllerVersion, "2.8.2")) {
ADVANCED_TUNING.deltaMethod = $('.delta select').val();
}
// Fill in the data from PIDs array
2015-03-11 20:34:02 +00:00
// Catch all the changes and stuff the inside PIDs array
var i = 0;
$('table.pid_tuning tr.ROLL input').each(function () {
PIDs[0][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.PITCH input').each(function () {
PIDs[1][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.YAW input').each(function () {
PIDs[2][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.ALT input').each(function () {
PIDs[3][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.Vario input').each(function () {
PIDs[9][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.Pos input').each(function () {
PIDs[4][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.PosR input').each(function () {
PIDs[5][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.NavR input').each(function () {
PIDs[6][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.ANGLE input').each(function () {
PIDs[7][i++] = parseFloat($(this).val());
});
$('table.pid_tuning tr.HORIZON input').each(function () {
PIDs[7][i++] = parseFloat($(this).val());
});
i = 0;
$('table.pid_tuning tr.MAG input').each(function () {
PIDs[8][i++] = parseFloat($(this).val());
});
// catch RC_tuning changes
RC_tuning.RC_RATE = parseFloat($('.pid_tuning input[name="rc_rate"]').val());
RC_tuning.roll_pitch_rate = parseFloat($('.pid_tuning input[name="roll_pitch_rate"]').val());
RC_tuning.roll_rate = parseFloat($('.pid_tuning input[name="roll_rate"]').val());
RC_tuning.pitch_rate = parseFloat($('.pid_tuning input[name="pitch_rate"]').val());
RC_tuning.yaw_rate = parseFloat($('.pid_tuning input[name="yaw_rate"]').val());
RC_tuning.RC_EXPO = parseFloat($('.pid_tuning input[name="rc_expo"]').val());
RC_tuning.RC_YAW_EXPO = parseFloat($('.pid_tuning input[name="rc_yaw_expo"]').val());
RC_tuning.rcYawRate = parseFloat($('.pid_tuning input[name="rc_rate_yaw"]').val());
2016-06-28 13:17:33 +00:00
RC_tuning.throttle_MID = parseFloat($('.throttle input[name="mid"]').val());
RC_tuning.throttle_EXPO = parseFloat($('.throttle input[name="expo"]').val())
RC_tuning.dynamic_THR_PID = parseFloat($('.tpa input[name="tpa"]').val());
RC_tuning.dynamic_THR_breakpoint = parseInt($('.tpa input[name="tpa-breakpoint"]').val());
FILTER_CONFIG.gyro_soft_lpf_hz = parseInt($('.pid_tuning input[name="gyro"]').val());
FILTER_CONFIG.dterm_lpf_hz = parseInt($('.pid_tuning input[name="dterm"]').val());
FILTER_CONFIG.yaw_lpf_hz = parseInt($('.pid_tuning input[name="yaw"]').val());
}
function showAllPids() {
$('.tab-pid_tuning .pid_tuning').show();
}
function hideUnusedPids() {
$('.tab-pid_tuning .pid_tuning').hide();
$('#pid_main').show();
2016-07-26 20:48:44 +00:00
if (semver.gte(CONFIG.flightControllerVersion, "2.9.0")) {
$('#pid_filter').show();
}
if (have_sensor(CONFIG.activeSensors, 'acc')) {
$('#pid_accel').show();
2016-07-04 07:37:26 +00:00
$('#pid_level').show();
}
var showTitle = false;
if (have_sensor(CONFIG.activeSensors, 'baro') ||
have_sensor(CONFIG.activeSensors, 'sonar')) {
$('#pid_baro').show();
showTitle = true;
}
if (have_sensor(CONFIG.activeSensors, 'mag')) {
$('#pid_mag').show();
showTitle = true;
}
if (BF_CONFIG.features.isEnabled('GPS')) {
$('#pid_gps').show();
showTitle = true;
}
if (showTitle) {
$('#pid_optional').show();
}
2015-11-02 09:10:08 +00:00
}
function drawAxes(curveContext, width, height, scaleHeight) {
2016-07-03 15:02:15 +00:00
curveContext.strokeStyle = '#000000';
curveContext.lineWidth = 4;
2016-07-03 15:02:15 +00:00
// Horizontal
curveContext.beginPath();
curveContext.moveTo(0, height / 2);
curveContext.lineTo(width, height / 2);
curveContext.stroke();
// Vertical
curveContext.beginPath();
curveContext.moveTo(width / 2, 0);
curveContext.lineTo(width / 2, height);
curveContext.stroke();
if (scaleHeight <= height / 2) {
curveContext.strokeStyle = '#c0c0c0';
curveContext.lineWidth = 4;
2016-07-03 15:02:15 +00:00
curveContext.beginPath();
curveContext.moveTo(0, height / 2 + scaleHeight);
curveContext.lineTo(width, height / 2 + scaleHeight);
2016-07-03 15:02:15 +00:00
curveContext.stroke();
curveContext.beginPath();
curveContext.moveTo(0, height / 2 - scaleHeight);
curveContext.lineTo(width, height / 2 - scaleHeight);
curveContext.stroke();
2016-07-03 15:02:15 +00:00
}
}
function checkInput(element) {
var value = parseFloat(element.val());
if (value < parseFloat(element.prop('min'))
|| value > parseFloat(element.prop('max'))) {
value = undefined;
2016-07-03 15:02:15 +00:00
}
return value;
2016-07-03 15:02:15 +00:00
}
var useLegacyCurve = false;
if (CONFIG.flightControllerIdentifier !== "BTFL" || semver.lt(CONFIG.flightControllerVersion, "2.8.0")) {
useLegacyCurve = true;
}
self.rateCurve = new RateCurve(useLegacyCurve);
function printMaxAngularVel(rate, rcRate, rcExpo, useSuperExpo, maxAngularVelElement) {
var maxAngularVel = self.rateCurve.getMaxAngularVel(rate, rcRate, rcExpo, useSuperExpo);
maxAngularVelElement.text(maxAngularVel);
return maxAngularVel;
}
function drawCurve(rate, rcRate, rcExpo, useSuperExpo, maxAngularVel, colour, yOffset, context) {
context.save();
context.strokeStyle = colour;
context.translate(0, yOffset);
self.rateCurve.draw(rate, rcRate, rcExpo, useSuperExpo, maxAngularVel, context);
context.restore();
}
function process_html() {
if (semver.gte(CONFIG.flightControllerVersion, "2.8.0")) {
2016-07-27 01:14:00 +00:00
BF_CONFIG.features.generateElements($('.tab-pid_tuning .features'));
}
// translate to user-selected language
localize();
2016-07-06 22:13:07 +00:00
// Local cache of current rates
self.currentRates = {
roll_rate: RC_tuning.roll_rate,
pitch_rate: RC_tuning.pitch_rate,
yaw_rate: RC_tuning.yaw_rate,
rc_rate: RC_tuning.RC_RATE,
rc_rate_yaw: RC_tuning.rcYawRate,
rc_expo: RC_tuning.RC_EXPO,
rc_yaw_expo: RC_tuning.RC_YAW_EXPO,
superexpo: BF_CONFIG.features.isEnabled('SUPEREXPO_RATES')
2016-07-06 22:13:07 +00:00
};
if (CONFIG.flightControllerIdentifier !== "BTFL" || semver.lt(CONFIG.flightControllerVersion, "2.8.1")) {
self.currentRates.rc_rate_yaw = self.currentRates.rc_rate;
}
if (semver.lt(CONFIG.apiVersion, "1.7.0")) {
self.currentRates.roll_rate = RC_tuning.roll_pitch_rate;
self.currentRates.pitch_rate = RC_tuning.roll_pitch_rate;
}
2015-11-02 09:10:08 +00:00
2016-07-17 00:18:19 +00:00
var showAllButton = $('#showAllPids');
function updatePidDisplay() {
if (!TABS.pid_tuning.showAllPids) {
hideUnusedPids();
showAllButton.text(chrome.i18n.getMessage("pidTuningShowAllPids"));
} else {
showAllPids();
showAllButton.text(chrome.i18n.getMessage("pidTuningHideUnusedPids"));
}
}
updatePidDisplay();
showAllButton.on('click', function(){
TABS.pid_tuning.showAllPids = !TABS.pid_tuning.showAllPids;
updatePidDisplay();
2015-11-02 09:10:08 +00:00
});
$('#resetPIDs').on('click', function(){
2016-07-26 14:46:13 +00:00
TABS.pid_tuning.profileLoading = true;
MSP.promise(MSP_codes.MSP_SET_RESET_CURR_PID).then(function () {
TABS.pid_tuning.refresh(function () {
TABS.pid_tuning.profileDirty = false;
2016-07-26 14:46:13 +00:00
GUI.log(chrome.i18n.getMessage('pidTuningPidsReset'));
});
});
});
2016-07-26 14:46:13 +00:00
$('.tab-pid_tuning select[name="profilechange"]').change(function () {
var profile = parseInt($(this).val());
2016-07-26 14:46:13 +00:00
TABS.pid_tuning.loadingProfile = true;
MSP.promise(MSP_codes.MSP_SELECT_SETTING, [profile]).then(function () {
TABS.pid_tuning.refresh(function () {
TABS.pid_tuning.loadingProfile = false;
GUI.log(chrome.i18n.getMessage('pidTuningLoadedProfile', [profile + 1]));
});
});
});
2015-11-02 09:10:08 +00:00
$('.pid_tuning tr').each(function(){
for(i = 0; i < PID_names.length; i++) {
if($(this).hasClass(PID_names[i])) {
$(this).find('td:first').text(PID_names[i]);
}
}
});
2015-03-11 20:24:46 +00:00
pid_and_rc_to_form();
2014-03-08 05:25:15 +00:00
var pidController_e = $('select[name="controller"]');
var pidControllerList;
if (semver.lt(CONFIG.apiVersion, "1.14.0")) {
pidControllerList = [
{ name: "MultiWii (Old)"},
{ name: "MultiWii (rewrite)"},
{ name: "LuxFloat"},
{ name: "MultiWii (2.3 - latest)"},
{ name: "MultiWii (2.3 - hybrid)"},
{ name: "Harakiri"}
]
2016-07-17 22:50:50 +00:00
} else if (semver.gte(CONFIG.flightControllerVersion, "3.0.0")) {
pidControllerList = [
{ name: "Legacy"},
{ name: "Betaflight"},
]
} else {
pidControllerList = [
{ name: ""},
{ name: "Integer"},
{ name: "Float"},
]
}
2016-06-29 20:59:47 +00:00
for (var i = 0; i < pidControllerList.length; i++) {
pidController_e.append('<option value="' + (i) + '">' + pidControllerList[i].name + '</option>');
}
2016-06-29 20:59:47 +00:00
2016-07-26 14:46:13 +00:00
if (semver.gte(CONFIG.apiVersion, CONFIGURATOR.pidControllerChangeMinApiVersion)) {
pidController_e.val(PID.controller);
} else {
GUI.log(chrome.i18n.getMessage('pidTuningUpgradeFirmwareToChangePidController', [CONFIG.apiVersion, CONFIGURATOR.pidControllerChangeMinApiVersion]));
pidController_e.empty();
pidController_e.append('<option value="">Unknown</option>');
pidController_e.prop('disabled', true);
}
2015-11-02 09:10:08 +00:00
if (semver.lt(CONFIG.apiVersion, "1.7.0")) {
$('.tpa .tpa-breakpoint').hide();
$('.pid_tuning .roll_rate').hide();
$('.pid_tuning .pitch_rate').hide();
} else {
$('.pid_tuning .roll_pitch_rate').hide();
}
if (useLegacyCurve) {
$('.new_rates').hide();
2016-07-03 15:02:15 +00:00
}
// Getting the DOM elements for curve display
2016-07-03 15:02:15 +00:00
var rcCurveElement = $('.rate_curve canvas').get(0);
var curveContext = rcCurveElement.getContext("2d");
rcCurveElement.width = 1000;
rcCurveElement.height = 1000;
var maxAngularVelRollElement = $('.rc_curve .maxAngularVelRoll');
var maxAngularVelPitchElement = $('.rc_curve .maxAngularVelPitch');
var maxAngularVelYawElement = $('.rc_curve .maxAngularVelYaw');
var updateNeeded = true;
function updateRates(event) {
setTimeout(function () { // let global validation trigger and adjust the values first
2016-07-06 23:55:15 +00:00
var targetElement = $(event.target),
targetValue = checkInput(targetElement);
if (self.currentRates.hasOwnProperty(targetElement.attr('name')) && targetValue) {
self.currentRates[targetElement.attr('name')] = targetValue;
updateNeeded = true;
2016-07-06 23:55:15 +00:00
}
if (targetElement.attr('name') === 'rc_rate' && CONFIG.flightControllerIdentifier !== "BTFL" || semver.lt(CONFIG.flightControllerVersion, "2.8.1")) {
self.currentRates.rc_rate_yaw = targetValue;
}
if (targetElement.attr('name') === 'roll_pitch_rate' && semver.lt(CONFIG.apiVersion, "1.7.0")) {
self.currentRates.roll_rate = targetValue;
self.currentRates.pitch_rate = targetValue;
updateNeeded = true;
}
if (targetElement.attr('name') === 'SUPEREXPO_RATES') {
self.currentRates.superexpo = targetElement.is(':checked');
updateNeeded = true;
}
if (updateNeeded) {
var curveHeight = rcCurveElement.height;
var curveWidth = rcCurveElement.width;
2016-07-06 22:13:07 +00:00
var maxAngularVel = Math.max(
printMaxAngularVel(self.currentRates.roll_rate, self.currentRates.rc_rate, self.currentRates.rc_expo, self.currentRates.superexpo, maxAngularVelRollElement),
printMaxAngularVel(self.currentRates.pitch_rate, self.currentRates.rc_rate, self.currentRates.rc_expo, self.currentRates.superexpo, maxAngularVelPitchElement),
printMaxAngularVel(self.currentRates.yaw_rate, self.currentRates.rc_rate_yaw, self.currentRates.rc_yaw_expo, self.currentRates.superexpo, maxAngularVelYawElement));
2016-07-03 15:02:15 +00:00
curveContext.clearRect(0, 0, curveWidth, curveHeight);
2016-07-03 15:02:15 +00:00
if (!useLegacyCurve) {
drawAxes(curveContext, curveWidth, curveHeight, (curveHeight / 2) / maxAngularVel * 360);
}
curveContext.lineWidth = 4;
drawCurve(self.currentRates.roll_rate, self.currentRates.rc_rate, self.currentRates.rc_expo, self.currentRates.superexpo, maxAngularVel, '#ff0000', 0, curveContext);
2016-07-03 15:02:15 +00:00
drawCurve(self.currentRates.pitch_rate, self.currentRates.rc_rate, self.currentRates.rc_expo, self.currentRates.superexpo, maxAngularVel, '#00ff00', -4, curveContext);
drawCurve(self.currentRates.yaw_rate, self.currentRates.rc_rate_yaw, self.currentRates.rc_yaw_expo, self.currentRates.superexpo, maxAngularVel, '#0000ff', 4, curveContext);
updateNeeded = false;
}
2016-06-28 13:17:33 +00:00
}, 0);
2016-07-03 15:02:15 +00:00
};
// UI Hooks
// curves
$('.pid_tuning').on('input change', updateRates);
$('input.feature').on('input change', updateRates).trigger('input');
2016-06-28 13:17:33 +00:00
$('.throttle input').on('input change', function () {
2016-07-03 15:02:15 +00:00
setTimeout(function () { // let global validation trigger and adjust the values first
2016-06-28 13:17:33 +00:00
var throttleMidE = $('.throttle input[name="mid"]'),
throttleExpoE = $('.throttle input[name="expo"]'),
mid = parseFloat(throttleMidE.val()),
expo = parseFloat(throttleExpoE.val()),
throttleCurve = $('.throttle .throttle_curve canvas').get(0),
context = throttleCurve.getContext("2d");
// local validation to deal with input event
if (mid >= parseFloat(throttleMidE.prop('min')) &&
mid <= parseFloat(throttleMidE.prop('max')) &&
expo >= parseFloat(throttleExpoE.prop('min')) &&
expo <= parseFloat(throttleExpoE.prop('max'))) {
// continue
} else {
return;
}
var canvasHeight = throttleCurve.height;
var canvasWidth = throttleCurve.width;
// math magic by englishman
var midx = canvasWidth * mid,
midxl = midx * 0.5,
midxr = (((canvasWidth - midx) * 0.5) + midx),
midy = canvasHeight - (midx * (canvasHeight / canvasWidth)),
midyl = canvasHeight - ((canvasHeight - midy) * 0.5 *(expo + 1)),
midyr = (midy / 2) * (expo + 1);
// draw
context.clearRect(0, 0, canvasWidth, canvasHeight);
context.beginPath();
context.moveTo(0, canvasHeight);
context.quadraticCurveTo(midxl, midyl, midx, midy);
context.moveTo(midx, midy);
context.quadraticCurveTo(midxr, midyr, canvasWidth, 0);
context.lineWidth = 2;
context.strokeStyle = '#ffbb00';
context.stroke();
}, 0);
}).trigger('input');
2014-03-08 05:25:15 +00:00
2014-08-12 14:20:26 +00:00
$('a.refresh').click(function () {
2016-07-26 14:46:13 +00:00
TABS.pid_tuning.refresh(function () {
2014-05-06 15:34:59 +00:00
GUI.log(chrome.i18n.getMessage('pidTuningDataRefreshed'));
});
});
2014-03-08 05:25:15 +00:00
2016-07-26 14:46:13 +00:00
$('#pid-tuning').find('input').each(function (k, item) {
$(item).change(function () {
2016-07-26 14:46:13 +00:00
TABS.pid_tuning.profileDirty = true;
})
});
pidController_e.change(function () {
2016-07-26 14:46:13 +00:00
TABS.pid_tuning.profileDirty = true;
});
2016-07-26 14:46:13 +00:00
if (semver.gte(CONFIG.flightControllerVersion, "2.8.2")) {
$('.delta select').change(function() {
TABS.pid_tuning.profileDirty = true;
});
} else {
2016-06-24 12:29:46 +00:00
$('.delta').hide();
2016-06-27 12:45:01 +00:00
$('.note').hide();
2016-06-24 12:29:46 +00:00
}
// update == save.
$('a.update').click(function () {
form_to_pid_and_rc();
2016-07-30 07:52:29 +00:00
Promise.resolve(true)
.then(function () {
var promise;
if (semver.gte(CONFIG.apiVersion, CONFIGURATOR.pidControllerChangeMinApiVersion)) {
PID.controller = pidController_e.val();
promise = MSP.promise(MSP_codes.MSP_SET_PID_CONTROLLER, MSP.crunch(MSP_codes.MSP_SET_PID_CONTROLLER));
}
return promise;
}).then(function () {
2016-07-26 14:46:13 +00:00
return MSP.promise(MSP_codes.MSP_SET_PID, MSP.crunch(MSP_codes.MSP_SET_PID));
}).then(function () {
2016-07-30 17:24:35 +00:00
if (semver.gte(CONFIG.flightControllerVersion, "2.9.0") && semver.lt(CONFIG.flightControllerVersion, "3.0.0")) {
return MSP.promise(MSP_codes.MSP_SET_SPECIAL_PARAMETERS, MSP.crunch(MSP_codes.MSP_SET_SPECIAL_PARAMETERS));
}
}).then(function () {
2016-07-30 17:24:35 +00:00
if (semver.gte(CONFIG.flightControllerVersion, "2.8.2")) {
return MSP.promise(MSP_codes.MSP_SET_PID_ADVANCED, MSP.crunch(MSP_codes.MSP_SET_PID_ADVANCED));
}
2016-07-26 14:46:13 +00:00
}).then(function () {
if (semver.gte(CONFIG.flightControllerVersion, "2.8.1")) {
return MSP.promise(MSP_codes.MSP_SET_FILTER_CONFIG, MSP.crunch(MSP_codes.MSP_SET_FILTER_CONFIG));
2016-07-26 14:46:13 +00:00
}
}).then(function () {
return MSP.promise(MSP_codes.MSP_SET_RC_TUNING, MSP.crunch(MSP_codes.MSP_SET_RC_TUNING));
}).then(function () {
if (semver.gte(CONFIG.flightControllerVersion, "2.8.0")) {
return MSP.promise(MSP_codes.MSP_SET_BF_CONFIG, MSP.crunch(MSP_codes.MSP_SET_BF_CONFIG));
2016-07-26 14:46:13 +00:00
}
}).then(function () {
return MSP.promise(MSP_codes.MSP_EEPROM_WRITE);
}).then(function () {
GUI.log(chrome.i18n.getMessage('pidTuningEepromSaved'));
});
2013-12-15 01:28:12 +00:00
});
2016-06-29 20:59:47 +00:00
// Setup model for rates preview
self.initRatesPreview();
self.renderModel();
// enable RC data pulling for rates preview
GUI.interval_add('receiver_pull', self.getRecieverData, true);
// status data pulled via separate timer with static speed
GUI.interval_add('status_pull', function status_pull() {
MSP.send_message(MSP_codes.MSP_STATUS);
}, 250, true);
2014-07-10 16:14:33 +00:00
2016-07-26 14:46:13 +00:00
TABS.pid_tuning.profileLoaded = true;
GUI.content_ready(callback);
}
2014-07-10 16:14:33 +00:00
};
2016-06-29 20:59:47 +00:00
TABS.pid_tuning.getRecieverData = function () {
MSP.send_message(MSP_codes.MSP_RC, false, false);
};
TABS.pid_tuning.initRatesPreview = function () {
this.keepRendering = true;
this.model = new Model($('.rates_preview'), $('.rates_preview canvas'));
$(window).on('resize', $.proxy(this.model.resize, this.model));
};
TABS.pid_tuning.renderModel = function () {
if (this.keepRendering) { requestAnimationFrame(this.renderModel.bind(this)); }
if (!this.clock) { this.clock = new THREE.Clock(); }
if (RC.channels[0] && RC.channels[1] && RC.channels[2]) {
2016-07-06 23:55:15 +00:00
var delta = this.clock.getDelta();
2016-07-06 22:13:07 +00:00
2016-07-06 23:55:15 +00:00
var roll = delta * this.rateCurve.rcCommandRawToDegreesPerSecond(RC.channels[0], this.currentRates.roll_rate, this.currentRates.rc_rate, this.currentRates.rc_expo, this.currentRates.super_expo),
pitch = delta * this.rateCurve.rcCommandRawToDegreesPerSecond(RC.channels[1], this.currentRates.pitch_rate, this.currentRates.rc_rate, this.currentRates.rc_expo, this.currentRates.super_expo),
yaw = delta * this.rateCurve.rcCommandRawToDegreesPerSecond(RC.channels[2], this.currentRates.yaw_rate, this.currentRates.rc_rate_yaw, this.currentRates.rc_yaw_expo, this.currentRates.super_expo);
2016-06-29 20:59:47 +00:00
2016-07-06 23:55:15 +00:00
this.model.rotateBy(-degToRad(pitch), -degToRad(yaw), -degToRad(roll));
2015-03-11 20:34:02 +00:00
}
};
2016-06-29 20:59:47 +00:00
TABS.pid_tuning.cleanup = function (callback) {
2016-07-26 14:46:13 +00:00
if (this.model) {
$(window).off('resize', $.proxy(this.model.resize, this.model));
}
2016-06-29 20:59:47 +00:00
this.keepRendering = false;
if (callback) callback();
};
2016-07-26 14:46:13 +00:00
TABS.pid_tuning.refresh = function (callback) {
GUI.tab_switch_cleanup(function () {
TABS.pid_tuning.initialize();
if (callback) {
callback();
}
});
}
TABS.pid_tuning.checkUpdateProfile = function () {
if (semver.gte(CONFIG.flightControllerVersion, "3.0.0")
&& CONFIG.numProfiles === 2) {
$('.tab-pid_tuning select[name="profilechange"] .profile3').hide();
}
if (!TABS.pid_tuning.loadingProfile && !TABS.pid_tuning.profileDirty) {
var profileElement = $('.tab-pid_tuning select[name="profilechange"]')
if (profileElement.length > 0 && parseInt(profileElement.val()) !== CONFIG.profile) {
profileElement.val(CONFIG.profile);
TABS.pid_tuning.refresh(function () {
GUI.log(chrome.i18n.getMessage('pidTuningReceivedProfile', [CONFIG.profile + 1]));
});
}
}
}