mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-03 00:10:35 +08:00
Fix max-hagl restriction to position/altitude control (#23667)
* fix max-hagl restriction to position/altitude control * max hagl vel restriction in ManAcc position mode * use interpolate func, change naming * simplyfied vertical vel limitation * move velocity-constraint adjustment to StickAccelXY
This commit is contained in:
@@ -643,7 +643,8 @@ void BlockLocalPositionEstimator::publishLocalPos()
|
||||
_pub_lpos.get().vxy_max = INFINITY;
|
||||
_pub_lpos.get().vz_max = INFINITY;
|
||||
_pub_lpos.get().hagl_min = INFINITY;
|
||||
_pub_lpos.get().hagl_max = INFINITY;
|
||||
_pub_lpos.get().hagl_max_z = INFINITY;
|
||||
_pub_lpos.get().hagl_max_xy = INFINITY;
|
||||
_pub_lpos.get().timestamp = hrt_absolute_time();;
|
||||
_pub_lpos.update();
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user