Title: Path Planning and Tracking for Vehicle Collision Avoidance in Lateral and Longitudinal Motion Directions