Path Planning and Robust Path Tracking Control of an Automated Parallel Parking Maneuver 2024-01-2558
Driver’s license examinations require the driver to perform either a parallel parking or a similar maneuver as part of the on-road evaluation of the driver’s skills. Self-driving vehicles that are allowed to operate on public roads without a driver should also be able to perform such tasks successfully. With this motivation, the S-shaped maneuverability test of the Ohio driver’s license examination is chosen here for automatic execution by a self-driving vehicle with drive-by-wire capability and longitudinal and lateral controls. The Ohio maneuverability test requires the driver to start within an area enclosed by four pylons and the driver is asked to go to the left of the fifth pylon directly in front of the vehicle in a smooth and continuous manner while ending in a parallel direction to the initial one. The driver is then asked to go backwards to the starting location of the vehicle without stopping the vehicle or hitting the pylons. As a self-driving vehicle should do a much better job repeatably than a driver, a high order polynomial path model is built along with speed profiling to start and stop smoothly at the ends of the path without large longitudinal and lateral accelerations. In contrast to the long horizon, higher speed path planning and path tracking control applications in the literature, this paper treats low speed and very short horizon path planning and path tracking control with stopping and direction reversal. The path is constructed using a segmented polynomial fit optimization routine that guarantees path curvature smoothness. A linear path-tracking model is utilized as the basis of the designed control system consisting of a disturbance observer based curvature rejection filter and a speed-scheduled, parameter-space robust PID controller. Simulation studies are conducted to analyze the tracking performance of the combined control system, and results indicate that it has better performance compared to other common control systems such as standalone PID controller and combined PID and feedforward control.