Run mc_pos_control for acceleration control mode flag

This commit is contained in:
Matthias Grob 2021-03-11 14:16:58 +01:00 committed by Daniel Agar
parent 6a6352577c
commit ceb445caa0
2 changed files with 1 additions and 3 deletions

View File

@ -3336,8 +3336,6 @@ Commander::update_control_mode()
_vehicle_control_mode.flag_control_climb_rate_enabled = true;
_vehicle_control_mode.flag_control_position_enabled = !_status.in_transition_mode;
_vehicle_control_mode.flag_control_velocity_enabled = !_status.in_transition_mode;
_vehicle_control_mode.flag_control_acceleration_enabled = false;
_vehicle_control_mode.flag_control_termination_enabled = false;
break;
default:

View File

@ -292,7 +292,7 @@ void MulticopterPositionControl::Run()
PositionControlStates states{set_vehicle_states(local_pos)};
if (_control_mode.flag_control_climb_rate_enabled) {
if (_control_mode.flag_control_acceleration_enabled || _control_mode.flag_control_climb_rate_enabled) {
_trajectory_setpoint_sub.update(&_setpoint);