forked from Archive/PX4-Autopilot
mc_position_control: Fix divide by zero in scale_control
This commit is contained in:
parent
3f9d79c768
commit
2428ff9f3a
|
@ -805,7 +805,11 @@ MulticopterPositionControl::scale_control(float ctl, float end, float dz, float
|
|||
return -dy + (ctl + dz) * (1.0f - dy) / (end - dz);
|
||||
|
||||
} else {
|
||||
return ctl * (dy / dz);
|
||||
if (dz < FLT_EPSILON) {
|
||||
return 0;
|
||||
} else {
|
||||
return ctl * (dy / dz);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue