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

MSP_INAV_PID MSP frame

Browse source
This commit is contained in:
Pawel Spychalski (DzikuVx) 2016-11-03 20:35:01 +01:00
parent 376df9d396
commit 9562275f51
4 changed files with 31 additions and 2 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -1064,6 +1064,32 @@ static bool mspFcProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst, sbuf_t *src, msp
sbufWriteU16(dst, constrain(currentProfile->pidProfile.axisAccelerationLimitYaw / 1000, 0, 65535));
break;
case MSP_INAV_PID:
#ifdef ASYNC_GYRO_PROCESSING
sbufWriteU8(dst, masterConfig.asyncMode);
sbufWriteU16(dst, masterConfig.accTaskFrequency);
sbufWriteU16(dst, masterConfig.attitudeTaskFrequency);
#else
sbufWriteU8(dst, 0);
sbufWriteU16(dst, 0);
sbufWriteU16(dst, 0);
#endif
#ifdef MAG
sbufWriteU8(dst, currentProfile->pidProfile.mag_hold_rate_limit);
sbufWriteU8(dst, MAG_HOLD_ERROR_LPF_FREQ);
#else
sbufWriteU8(dst, 0);
sbufWriteU8(dst, 0);
#endif
sbufWriteU16(dst, masterConfig.mixerConfig.yaw_jump_prevention_limit);
sbufWriteU8(dst, masterConfig.gyro_lpf);
sbufWriteU8(dst, 0); //reserved
sbufWriteU8(dst, 0); //reserved
sbufWriteU8(dst, 0); //reserved
sbufWriteU8(dst, 0); //reserved
sbufWriteU8(dst, 0); //reserved
break;
case MSP_REBOOT:
if (mspPostProcessFn) {
*mspPostProcessFn = mspRebootFn;