autopilot improvements
Anti collision