Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

SRV_Channel: prevent FPE with SERVOn_MIN==SERVOn_MAX

This commit is contained in:
Andrew Tridgell 2021-01-03 16:48:55 +11:00
parent 4a7f663cad
commit a74d087fd8
1 changed files with 3 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
libraries/SRV_Channel/SRV_Channel_aux.cpp
View File

@ -616,6 +616,9 @@ void SRV_Channels::adjust_trim(SRV_Channel::Aux_servo_function_t function, float
}
float change = c.reversed?-v:v;
uint16_t new_trim = c.servo_trim;
if (c.servo_max <= c.servo_min) {
continue;
}
float trim_scaled = float(c.servo_trim - c.servo_min) / (c.servo_max - c.servo_min);
if (change > 0 && trim_scaled < 0.6f) {
new_trim++;