Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-13 03:20:00 +03:00
Code Issues Wiki Activity

add rpm_filter_weights to msp

Browse source
This commit is contained in:
mituritsyn 2025-06-29 11:05:25 +02:00
parent 9a1593b78e
commit bfff81889c
1 changed files with 15 additions and 3 deletions
Download patch file Download diff file Expand all files Collapse all files

14
src/main/msp/msp.c
View file

@ -1911,9 +1911,15 @@ case MSP_NAME:
sbufWriteU16(dst, 0); sbufWriteU16(dst, 0);
#endif #endif
#if defined(USE_RPM_FILTER) #if defined(USE_RPM_FILTER)
for (int i = 0; i < RPM_FILTER_HARMONICS_MAX; i++) {
// Added in MSP API 1.46
sbufWriteU8(dst, rpmFilterConfig()->rpm_filter_weights[i]);
}
sbufWriteU8(dst, rpmFilterConfig()->rpm_filter_min_hz); sbufWriteU8(dst, rpmFilterConfig()->rpm_filter_min_hz);
#else #else
for (int i = 0; i < RPM_FILTER_HARMONICS_MAX; i++) {
sbufWriteU8(dst, 0); sbufWriteU8(dst, 0);
}
sbufWriteU8(dst, 0); sbufWriteU8(dst, 0);
#endif #endif
#if defined(USE_DYN_NOTCH_FILTER) #if defined(USE_DYN_NOTCH_FILTER)
@ -3106,7 +3112,7 @@ static mspResult_e mspProcessInCommand(mspDescriptor_t srcDesc, int16_t cmdMSP,
sbufReadU16(src); sbufReadU16(src);
#endif #endif
} }
if (sbufBytesRemaining(src) >= 8) { if (sbufBytesRemaining(src) >= 10) {
// Added in MSP API 1.42 // Added in MSP API 1.42
#if defined(USE_DYN_NOTCH_FILTER) #if defined(USE_DYN_NOTCH_FILTER)
sbufReadU8(src); // DEPRECATED 1.43: dyn_notch_range sbufReadU8(src); // DEPRECATED 1.43: dyn_notch_range
@ -3120,9 +3126,15 @@ static mspResult_e mspProcessInCommand(mspDescriptor_t srcDesc, int16_t cmdMSP,
sbufReadU16(src); sbufReadU16(src);
#endif #endif
#if defined(USE_RPM_FILTER) #if defined(USE_RPM_FILTER)
for (int i = 0; i < RPM_FILTER_HARMONICS_MAX; i++) {
// Added in MSP API 1.46
rpmFilterConfigMutable()->rpm_filter_weights[i] = sbufReadU8(src);
}
rpmFilterConfigMutable()->rpm_filter_min_hz = sbufReadU8(src); rpmFilterConfigMutable()->rpm_filter_min_hz = sbufReadU8(src);
#else #else
for (int i = 0; i < RPM_FILTER_HARMONICS_MAX; i++) {
sbufReadU8(src); sbufReadU8(src);
}
sbufReadU8(src); sbufReadU8(src);
#endif #endif
} }