mc_att_control: yaw feed-forward in manual control modes fixed

Fixed bug that appeared in mpc_rc.
Tested in flight by Hannes.