Skip to content
Snippets Groups Projects
Commit 0c58588a authored by Anton Babushkin's avatar Anton Babushkin
Browse files

mc_att_control: yaw feed-forward in manual control modes fixed

parent 2ee02e5e
No related branches found
No related tags found
No related merge requests found
......@@ -496,7 +496,8 @@ MulticopterAttitudeControl::control_attitude(float dt)
//}
} else {
/* move yaw setpoint */
_v_att_sp.yaw_body = _wrap_pi(_v_att_sp.yaw_body + _manual_control_sp.yaw * _params.man_yaw_max * dt);
yaw_sp_move_rate = _manual_control_sp.yaw * _params.man_yaw_max;
_v_att_sp.yaw_body = _wrap_pi(_v_att_sp.yaw_body + yaw_sp_move_rate * dt);
_v_att_sp.R_valid = false;
publish_att_sp = true;
}
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment