Motion Planning and Collision Avoidance