mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-06-30 13:50:35 +08:00
TranslationControl: index fix
This commit is contained in:
committed by
Beat Küng
parent
840247251d
commit
adcb2b9ca8
@@ -141,6 +141,7 @@ void TranslationControl::_interfaceMapping()
|
||||
} else if (!PX4_ISFINITE(_yaw_sp)) {
|
||||
_yaw_sp = _yaw_sp_int;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/* generate desired velocity */
|
||||
@@ -226,9 +227,10 @@ void TranslationControl::_velocityController(const float &dt)
|
||||
}
|
||||
|
||||
if (!stop_I[1]) {
|
||||
_thr_int(2) += vel_err(3) * Iv(2) * dt;
|
||||
_thr_int(2) += vel_err(2) * Iv(2) * dt;
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
void TranslationControl::_yawController(const float &dt)
|
||||
|
||||
Reference in New Issue
Block a user