Merge pull request #45 from thomasgubler/master_origin

re-adding pid limitation & mavlink waypoint handling fix
This commit is contained in:
Lorenz Meier
2012-11-05 13:15:35 -08:00
2 changed files with 5 additions and 6 deletions
+2 -2
View File
@@ -172,9 +172,9 @@ __EXPORT float pid_calculate(PID_t *pid, float sp, float val, float val_dot, flo
// Calculate the output. Limit output magnitude to pid->limit
float output = (pid->error_previous * pid->kp) + (i * pid->ki) + (d * pid->kd);
//if (output > pid->limit) output = pid->limit;
if (output > pid->limit) output = pid->limit;
//if (output < -pid->limit) output = -pid->limit;
if (output < -pid->limit) output = -pid->limit;
if (isfinite(output)) {
pid->last_output = output;