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

Merge pull request #10054 from fgiudice98/blackbox-fields-msp

Browse source
This commit is contained in:
J Blackman 2022-06-24 06:34:18 +10:00 • committed by GitHub
commit d8c79eb710
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
1 changed files with 9 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -1706,6 +1706,8 @@ static bool mspProcessOutCommand(int16_t cmdMSP, sbuf_t *dst)
sbufWriteU8(dst, blackboxGetRateDenom());
sbufWriteU16(dst, blackboxGetPRatio());
sbufWriteU8(dst, blackboxConfig()->sample_rate);
// Added in MSP API 1.45
sbufWriteU32(dst, blackboxConfig()->fields_disabled_mask);
#else
sbufWriteU8(dst, 0); // Blackbox not supported
sbufWriteU8(dst, 0);
@ -1713,6 +1715,8 @@ static bool mspProcessOutCommand(int16_t cmdMSP, sbuf_t *dst)
sbufWriteU8(dst, 0);
sbufWriteU16(dst, 0);
sbufWriteU8(dst, 0);
// Added in MSP API 1.45
sbufWriteU32(dst, 0);
#endif
break;
@ -3159,6 +3163,11 @@ static mspResult_e mspProcessInCommand(mspDescriptor_t srcDesc, int16_t cmdMSP,
// sample_rate not specified in MSP, so calculate it from old p_ratio
blackboxConfigMutable()->sample_rate = blackboxCalculateSampleRate(pRatio);
}
// Added in MSP API 1.45
if (sbufBytesRemaining(src) >= 4) {
blackboxConfigMutable()->fields_disabled_mask = sbufReadU32(src);
}
}
break;
#endif