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

Add debug mode and debug count to msp

Browse source
This commit is contained in:
IvoFPV 2019-08-08 09:53:59 +02:00
parent 09c98513b8
commit 0dd42ca9b1
1 changed files with 7 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -1420,6 +1420,9 @@ static bool mspProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst)
sbufWriteU16(dst, gyroConfig()->gyroCalibrationDuration); sbufWriteU16(dst, gyroConfig()->gyroCalibrationDuration);
sbufWriteU16(dst, gyroConfig()->gyro_offset_yaw); sbufWriteU16(dst, gyroConfig()->gyro_offset_yaw);
sbufWriteU8(dst, gyroConfig()->checkOverflow); sbufWriteU8(dst, gyroConfig()->checkOverflow);
//Added in MSP API 1.42
sbufWriteU8(dst, systemConfig()->debug_mode);
sbufWriteU8(dst, DEBUG_COUNT);
break; break;
case MSP_FILTER_CONFIG : case MSP_FILTER_CONFIG :
@ -2075,6 +2078,10 @@ static mspResult_e mspProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
gyroConfigMutable()->gyro_offset_yaw = sbufReadU16(src); gyroConfigMutable()->gyro_offset_yaw = sbufReadU16(src);
gyroConfigMutable()->checkOverflow = sbufReadU8(src); gyroConfigMutable()->checkOverflow = sbufReadU8(src);
} }
if (sbufBytesRemaining(src) >= 1) {
//Added in MSP API 1.42
systemConfigMutable()->debug_mode = sbufReadU8(src);
}
validateAndFixGyroConfig(); validateAndFixGyroConfig();