1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-23 08:15:30 +03:00

Add debug modes to MSP (#8681)

Add debug modes to MSP
This commit is contained in:
Michael Keller 2019-08-13 00:12:51 +12:00 committed by GitHub
commit e09f418430
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23

View file

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