Browse Source

fixed optimal recovery condition

sbg
Andreas Antener 9 years ago
parent
commit
5eaf104318
  1. 2
      src/modules/mc_pos_control/mc_pos_control_main.cpp

2
src/modules/mc_pos_control/mc_pos_control_main.cpp

@ -2022,7 +2022,7 @@ MulticopterPositionControl::task_main() @@ -2022,7 +2022,7 @@ MulticopterPositionControl::task_main()
/* control roll and pitch directly if no aiding velocity controller is active
* and only if optimal recovery is not used */
if (!_control_mode.flag_control_velocity_enabled
&& !_params.opt_recover > 0) {
&& _params.opt_recover <= 0) {
math::Matrix<3, 3> R_sp;
_att_sp.roll_body = _manual.y * _params.man_roll_max;
_att_sp.pitch_body = -_manual.x * _params.man_pitch_max;

Loading…
Cancel
Save