mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-25 16:56:25 +08:00
Use current_sp for publishing orbit status
This commit is contained in:
committed by
Daniel Agar
parent
dec5e7e9c8
commit
0dea56f88b
@@ -884,12 +884,12 @@ FixedwingPositionControl::control_auto(const hrt_abstime &now, const Vector2d &c
|
||||
break;
|
||||
|
||||
case position_setpoint_s::SETPOINT_TYPE_VELOCITY:
|
||||
control_auto_velocity(now, dt, curr_pos, ground_speed, pos_sp_prev, pos_sp_curr);
|
||||
control_auto_velocity(now, dt, curr_pos, ground_speed, pos_sp_prev, current_sp);
|
||||
break;
|
||||
|
||||
case position_setpoint_s::SETPOINT_TYPE_LOITER:
|
||||
control_auto_loiter(now, dt, curr_pos, ground_speed, pos_sp_prev, current_sp, pos_sp_next);
|
||||
publishOrbitStatus(pos_sp_curr);
|
||||
publishOrbitStatus(current_sp);
|
||||
|
||||
break;
|
||||
|
||||
|
||||
Reference in New Issue
Block a user