Vehicle Trajectory Planning for Collision Avoidance with Mobile Obstacles