mc_att_control_vector: attitude rate D component implemented