Worked on initial autopilot tests