diff --git a/src/modules/mc_pos_control/mc_pos_control_main.cpp b/src/modules/mc_pos_control/mc_pos_control_main.cpp index 08526fb3d8..ee2efbc88b 100644 --- a/src/modules/mc_pos_control/mc_pos_control_main.cpp +++ b/src/modules/mc_pos_control/mc_pos_control_main.cpp @@ -1040,14 +1040,6 @@ MulticopterPositionControl::control_manual(float dt) _att_sp.timestamp = hrt_absolute_time(); - /* publish attitude setpoint */ - if (_att_sp_pub != nullptr) { - orb_publish(_attitude_setpoint_id, _att_sp_pub, &_att_sp); - - } else if (_attitude_setpoint_id) { - _att_sp_pub = orb_advertise(_attitude_setpoint_id, &_att_sp); - } - } else { control_position(dt); } @@ -1182,14 +1174,6 @@ MulticopterPositionControl::control_non_manual(float dt) _att_sp.timestamp = hrt_absolute_time(); - /* publish attitude setpoint */ - if (_att_sp_pub != nullptr) { - orb_publish(_attitude_setpoint_id, _att_sp_pub, &_att_sp); - - } else if (_attitude_setpoint_id) { - _att_sp_pub = orb_advertise(_attitude_setpoint_id, &_att_sp); - } - } else { control_position(dt); }