mc_pos_control: takeoff fixes, ignore position and yaw, takeoff vertically
mc_pos_control, mc_att_control_vector: code style fixed