mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-01 14:00:34 +08:00
ekf2: publish estimator position control limits
This commit is contained in:
committed by
ChristophTobler
parent
0ed78f259e
commit
b117fddb21
@@ -1022,6 +1022,14 @@ void Ekf2::run()
|
||||
_ekf.get_posNE_reset(&lpos.delta_xy[0], &lpos.xy_reset_counter);
|
||||
_ekf.get_velNE_reset(&lpos.delta_vxy[0], &lpos.vxy_reset_counter);
|
||||
|
||||
// get control limit information
|
||||
_ekf.get_ekf_ctrl_limits(&lpos.vxy_max, &lpos.limit_hagl);
|
||||
|
||||
// convert NaN to zero
|
||||
if (!PX4_ISFINITE(lpos.vxy_max)) {
|
||||
lpos.vxy_max = 0.0f;
|
||||
}
|
||||
|
||||
// publish vehicle local position data
|
||||
_vehicle_local_position_pub.update();
|
||||
|
||||
|
||||
Reference in New Issue
Block a user