Control_roll, control_pitch now always hold the desired lean angle
whether it be from the pilot or autopilot.