1
0
Fork 0
mirror of https://github.com/betaflight/betaflight-configurator.git synced 2025-07-18 13:55:14 +03:00

Merge pull request #215 from mikeller/added_filters_to_msp

Added new filters to MSP.
This commit is contained in:
borisbstyle 2016-08-15 23:29:44 +02:00 committed by GitHub
commit 23b321401b
2 changed files with 22 additions and 1 deletions

View file

@ -259,7 +259,11 @@ var FC = {
FILTER_CONFIG = { FILTER_CONFIG = {
gyro_soft_lpf_hz: 0, gyro_soft_lpf_hz: 0,
dterm_lpf_hz: 0, dterm_lpf_hz: 0,
yaw_lpf_hz: 0 yaw_lpf_hz: 0,
gyro_soft_notch_hz: 0,
gyro_soft_notch_cutoff: 0,
dterm_notch_hz: 0,
dterm_notch_cutoff: 0
}; };
ADVANCED_TUNING = { ADVANCED_TUNING = {

View file

@ -681,6 +681,17 @@ MspHelper.prototype.process_data = function(dataHandler) {
FILTER_CONFIG.dterm_lpf_hz = data.getUint16(offset, 1); FILTER_CONFIG.dterm_lpf_hz = data.getUint16(offset, 1);
offset += 2; offset += 2;
FILTER_CONFIG.yaw_lpf_hz = data.getUint16(offset, 1); FILTER_CONFIG.yaw_lpf_hz = data.getUint16(offset, 1);
offset += 2;
if (semver.gte(CONFIG.apiVersion, "1.20.0")) {
FILTER_CONFIG.gyro_soft_notch_hz = data.getUint16(offset, 1);
offset += 2;
FILTER_CONFIG.gyro_soft_notch_cutoff = data.getUint16(offset, 1);
offset += 2;
FILTER_CONFIG.dterm_notch_hz = data.getUint16(offset, 1);
offset += 2;
FILTER_CONFIG.dterm_notch_cutoff = data.getUint16(offset, 1);
offset += 2;
}
break; break;
case MSPCodes.MSP_SET_PID_ADVANCED: case MSPCodes.MSP_SET_PID_ADVANCED:
@ -1316,6 +1327,12 @@ MspHelper.prototype.crunch = function(code) {
buffer.push8(FILTER_CONFIG.gyro_soft_lpf_hz) buffer.push8(FILTER_CONFIG.gyro_soft_lpf_hz)
.push16(FILTER_CONFIG.dterm_lpf_hz) .push16(FILTER_CONFIG.dterm_lpf_hz)
.push16(FILTER_CONFIG.yaw_lpf_hz); .push16(FILTER_CONFIG.yaw_lpf_hz);
if (semver.gte(CONFIG.apiVersion, "1.20.0")) {
buffer.push16(FILTER_CONFIG.gyro_soft_notch_hz)
.push16(FILTER_CONFIG.gyro_soft_notch_cutoff)
.push16(FILTER_CONFIG.dterm_notch_hz)
.push16(FILTER_CONFIG.dterm_notch_cutoff);
}
break; break;
case MSPCodes.MSP_SET_PID_ADVANCED: case MSPCodes.MSP_SET_PID_ADVANCED:
if (semver.gte(CONFIG.flightControllerVersion, "3.0.0")) { if (semver.gte(CONFIG.flightControllerVersion, "3.0.0")) {