Work on yaw control, now that pitch and roll are good