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

Moved throttle percent calculation from MSP and OSD to Mixer

Browse source
This commit is contained in:
Daniel Arruda Ribeiro 2021-01-15 18:12:45 -03:00
parent 2277239215
commit 101799952e
4 changed files with 11 additions and 14 deletions
Download patch file Download diff file Expand all files Collapse all files

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

@ -830,16 +830,8 @@ static bool mspFcProcessOutCommand(uint16_t cmdMSP, sbuf_t *dst, mspPostProcessF
sbufWriteU32(dst, getFlightTime()); // Flight time (seconds)
// Throttle
int16_t thr = 0;
const int minThrottle = getThrottleIdleValue();
bool autoThrottle = navigationIsControllingThrottle();
if(autoThrottle)
thr = (constrain(rcCommand[THROTTLE], PWM_RANGE_MIN, PWM_RANGE_MAX) - PWM_RANGE_MIN) * 100 / (PWM_RANGE_MAX - PWM_RANGE_MIN);
else
thr = (constrain(rcCommand[THROTTLE], PWM_RANGE_MIN, PWM_RANGE_MAX ) - minThrottle) * 100 / (motorConfig()->maxthrottle - minThrottle);
sbufWriteU8(dst, thr); // Throttle Percent
sbufWriteU8(dst, autoThrottle ? 1 : 0); // Auto Throttle Flag (0 or 1)
sbufWriteU8(dst, throttlePercent); // Throttle Percent
sbufWriteU8(dst, navigationIsControllingThrottle() ? 1 : 0); // Auto Throttle Flag (0 or 1)
break;