fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-25 14:53:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

landing target estimator: initialize landing target velocity with negative of vehicle velocity

Browse Source
This commit is contained in:
Nicolas de Palezieux
2018-01-24 19:39:30 +01:00
committed by Lorenz Meier
parent b7dff95782
commit ae52f74e78
2 changed files with 5 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/landing_target_estimator/LandingTargetEstimator.cpp
+4 -2
View File
@@ -162,8 +162,10 @@ void LandingTargetEstimator::update()
if (!_estimator_initialized) {
PX4_INFO("Init");
_kalman_filter_x.init(_rel_pos(0), 0, _params.pos_unc_init, _params.vel_unc_init);
_kalman_filter_y.init(_rel_pos(1), 0, _params.pos_unc_init, _params.vel_unc_init);
float vx_init = _vehicleLocalPosition.v_xy_valid ? -_vehicleLocalPosition.vx : 0.f;
float vy_init = _vehicleLocalPosition.v_xy_valid ? -_vehicleLocalPosition.vy : 0.f;
_kalman_filter_x.init(_rel_pos(0), vx_init, _params.pos_unc_init, _params.vel_unc_init);
_kalman_filter_y.init(_rel_pos(1), vy_init, _params.pos_unc_init, _params.vel_unc_init);
_estimator_initialized = true;
_last_update = hrt_absolute_time();