mirror of https://github.com/ArduPilot/ardupilot
Added simple constrain for Alt d term
This commit is contained in:
parent
b0810e054e
commit
ee7c948781
|
@ -190,7 +190,7 @@ get_nav_throttle(int32_t z_error)
|
||||||
rate_d = ((rate_d + climb_rate)>>1) * 1; // replace with gain
|
rate_d = ((rate_d + climb_rate)>>1) * 1; // replace with gain
|
||||||
|
|
||||||
// slight adjustment to alt hold output
|
// slight adjustment to alt hold output
|
||||||
output -= rate_d;
|
output -= constrain(rate_d, -25, 25);
|
||||||
|
|
||||||
// light filter of output
|
// light filter of output
|
||||||
output = (old_output * 3 + output) / 4;
|
output = (old_output * 3 + output) / 4;
|
||||||
|
|
Loading…
Reference in New Issue