Basic autopilot, needs refining for lumpy buildings