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