From 9fd158412ad69751060160b9259628a090a48295 Mon Sep 17 00:00:00 2001 From: ianrmurphy Date: Sat, 13 Apr 2019 14:14:06 +0100 Subject: [PATCH] Added rate limit settings to MSP API 1.42 for configurator. --- src/main/msp/msp.c | 14 +++++++++++++- 1 file changed, 13 insertions(+), 1 deletion(-) diff --git a/src/main/msp/msp.c b/src/main/msp/msp.c index 04353d0f64..d298920e4e 100644 --- a/src/main/msp/msp.c +++ b/src/main/msp/msp.c @@ -1007,7 +1007,12 @@ static bool mspProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst) // added in 1.41 sbufWriteU8(dst, currentControlRateProfile->throttle_limit_type); sbufWriteU8(dst, currentControlRateProfile->throttle_limit_percent); - + + // added in 1.42 + sbufWriteU16(dst, currentControlRateProfile->rate_limit[FD_ROLL]); + sbufWriteU16(dst, currentControlRateProfile->rate_limit[FD_PITCH]); + sbufWriteU16(dst, currentControlRateProfile->rate_limit[FD_YAW]); + break; case MSP_PID: @@ -1858,6 +1863,13 @@ static mspResult_e mspProcessInCommand(uint8_t cmdMSP, sbuf_t *src) currentControlRateProfile->throttle_limit_percent = sbufReadU8(src); } + // version 1.42 + if (sbufBytesRemaining(src) >= 6) { + currentControlRateProfile->rate_limit[FD_ROLL] = sbufReadU16(src); + currentControlRateProfile->rate_limit[FD_PITCH] = sbufReadU16(src); + currentControlRateProfile->rate_limit[FD_YAW] = sbufReadU16(src); + } + initRcProcessing(); } else { return MSP_RESULT_ERROR;