Browse Source

mc_att_control: poll vehicle_rates_setpoint if attitude controller disabled

sbg
Anton Babushkin 11 years ago
parent
commit
2b4af66357
  1. 10
      src/modules/mc_att_control/mc_att_control_main.cpp

10
src/modules/mc_att_control/mc_att_control_main.cpp

@ -761,10 +761,12 @@ MulticopterAttitudeControl::task_main()
} }
} else { } else {
/* attitude controller disabled */ /* attitude controller disabled, poll rates setpoint topic */
// TODO poll 'attitude_rates_setpoint' topic vehicle_rates_setpoint_poll();
_rates_sp.zero(); _rates_sp(0) = _v_rates_sp.roll;
_thrust_sp = 0.0f; _rates_sp(1) = _v_rates_sp.pitch;
_rates_sp(2) = _v_rates_sp.yaw;
_thrust_sp = _v_rates_sp.thrust;
} }
if (_v_control_mode.flag_control_rates_enabled) { if (_v_control_mode.flag_control_rates_enabled) {

Loading…
Cancel
Save