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

Just in case the Min and Max functions are not playing nice with AP_Var

This commit is contained in:
jasonshort 2011-10-26 16:48:50 +00:00
parent 18e8bb3d6a
commit d8a0ce6933
1 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/APM_PI/APM_PI.cpp
View File

@ -11,8 +11,12 @@ long
APM_PI::get_pi(int32_t error, float dt) APM_PI::get_pi(int32_t error, float dt)
{ {
_integrator += ((float)error * _ki) * dt; _integrator += ((float)error * _ki) * dt;
_integrator = min(_integrator, (float)_imax);
_integrator = max(_integrator, (float)-_imax); if (_integrator < -_imax) {
_integrator = -_imax;
} else if (_integrator > _imax) {
_integrator = _imax;
}
return (float)error * _kp + _integrator; return (float)error * _kp + _integrator;
} }