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

Merge pull request #1235 from iNavFlight/failsafe-msp-api

Browse source 
Add new failsafe parameters to MSP
This commit is contained in:
Konstantin Sharlaimov 2017-03-14 19:48:09 +10:00 • committed by GitHub
commit 1be0bc6618
1 changed files with 10 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

10
src/main/fc/fc_msp.c
View file

@ -905,6 +905,10 @@ static bool mspFcProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, mspPostProcessFn
sbufWriteU16(dst, failsafeConfig()->failsafe_throttle_low_delay);
sbufWriteU8(dst, failsafeConfig()->failsafe_procedure);
sbufWriteU8(dst, failsafeConfig()->failsafe_recovery_delay);
sbufWriteU16(dst, failsafeConfig()->failsafe_fw_roll_angle);
sbufWriteU16(dst, failsafeConfig()->failsafe_fw_pitch_angle);
sbufWriteU16(dst, failsafeConfig()->failsafe_fw_yaw_rate);
sbufWriteU16(dst, failsafeConfig()->failsafe_stick_motion_threshold);
break;
case MSP_RSSI_CONFIG:
@ -1889,6 +1893,12 @@ static mspResult_e mspFcProcessInCommand(uint8_t cmdMSP, sbuf_t *src)
if (dataSize > 8) {
failsafeConfigMutable()->failsafe_recovery_delay = sbufReadU8(src);
}
if (dataSize > 9) {
failsafeConfigMutable()->failsafe_fw_roll_angle = sbufReadU16(src);
failsafeConfigMutable()->failsafe_fw_pitch_angle = sbufReadU16(src);
failsafeConfigMutable()->failsafe_fw_yaw_rate = sbufReadU16(src);
failsafeConfigMutable()->failsafe_stick_motion_threshold = sbufReadU16(src);
}
break;
case MSP_SET_RSSI_CONFIG: