Selective Velocity Obstacle method for Autonomous Collision Avoidance