pid library fix
mc_att_control_vector: independent thrust vector and attitude control
mc_att_control_vector: fixes
mc_att_control_vector: code style fixed