Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-06 06:43:21 +08:00
Code Issues Actions 29 Packages Projects Releases Wiki Activity

prevent double-precision promotion where its not required

Browse Source
This commit is contained in:
Lorenz Meier
2012-10-31 15:49:01 +01:00
parent 939fc83c4a
commit 8dcde7f8cd
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
apps/systemlib/pid/pid.c
+2 -2
View File
@@ -155,8 +155,8 @@ __EXPORT float pid_calculate(PID_t *pid, float sp, float val, float val_dot, flo
// Calculate the error integral and check for saturation // Calculate the error integral and check for saturation
i = pid->integral + (error * dt); i = pid->integral + (error * dt);
if (fabs((error * pid->kp) + (i * pid->ki) + (d * pid->kd)) > pid->limit || if (fabsf((error * pid->kp) + (i * pid->ki) + (d * pid->kd)) > pid->limit ||
fabs(i) > pid->intmax) { fabsf(i) > pid->intmax) {
i = pid->integral; // If saturated then do not update integral value i = pid->integral; // If saturated then do not update integral value
pid->saturated = 1; pid->saturated = 1;