Hierarchical Control of Trajectory Planning and Trajectory Tracking for Autonomous Parallel Parking
Open Access
- 1 July 2021
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Access
- Vol. 9, 94845-94861
Abstract
For the parallel parking problem in narrow space, this paper proposes a trajectory tracking control method with a novel trajectory planning layer for autonomous parallel parking based on a numerical optimization algorithm and model predictive control. In the trajectory planning layer, the vehicle kinematics model suitable for the low-velocity parking scene is established. Considering the vehicle physical constraints, boundary condition constraints, and obstacle avoidance constraints during the parking process, the parking trajectory planning task is described as an optimal control problem, further transformed into a nonlinear programming problem by Gauss pseudo-spectral method. Taking the shortest parking completion time as the optimization objective function, the parking trajectories of the large, medium and small parking spaces are obtained, respectively. A parking trajectory tracking controller based on the model predictive control algorithm is designed in the trajectory tracking control layer. The linear error model is used as the prediction model, and the quadratic programming is adopted as the rolling optimization algorithm in the tracking controller. The velocity and front-wheel swing angle are obtained as control signals for parking trajectory tracking. Through CarSim and Simulink's co-simulation, the feasibility and effectiveness of the proposed parallel parking trajectory planning and tracking control method are verified. The co-simulation results show that the maximum tracking errors of horizontal and longitudinal positions are less than 0.15m. The maximum tracking errors of heading angle are less than 2° under three different parking spaces. Real vehicle tests are carried out to verify the effectiveness of the proposed hierarchical control method. The test results show that the vehicle can park in the parking space safely, quickly and accurately when the actual parking space is detected. The proposed method can plan the parking trajectory with the constraints and the shortest time and control the vehicle to complete the parking operation accurately along the planned trajectory.Keywords
Funding Information
- Major Special Science and Technology Project of Anhui Province, China (201903a05020033)
- Key Projects of University Natural Science Foundation of Anhui Province, China (KJ2019A0959, KJ2020A1065)
- Key Project of Hefei University, China (20ZR02ZDB)
This publication has 29 references indexed in Scilit:
- Integrated real-time task and motion planning for multiple robots under path and communication uncertaintiesRobotica, 2017
- Model-Free Adaptive Discrete-Time Integral Sliding-Mode-Constrained-Control for Autonomous 4WMV Parking SystemsIEEE Transactions on Industrial Electronics, 2017
- Accurate and Efficient Approximation of Clothoids Using Bézier Curves for Path PlanningIEEE Transactions on Robotics, 2017
- Parking Like a Human: A Direct Trajectory Planning SolutionIEEE Transactions on Intelligent Transportation Systems, 2017
- Study on Path Following Control Method for Automatic Parking System Based on LQRSAE International Journal of Passenger Cars - Electronic and Electrical Systems, 2016
- Parallel parking of a car‐like mobile robot based on the P‐domain path tracking controllersIET Control Theory & Applications, 2016
- Mutual Information-Based Multi-AUV Path Planning for Scalar Field Sampling Using Multidimensional RRT*IEEE Transactions on Systems, Man, and Cybernetics: Systems, 2015
- Efficient Sampling-Based Motion Planning for On-Road Autonomous DrivingIEEE Transactions on Intelligent Transportation Systems, 2015
- Automatic Parallel Parking in Tiny Spots: Path Planning and ControlIEEE Transactions on Intelligent Transportation Systems, 2014
- Predictive Control of Autonomous Ground Vehicles With Obstacle Avoidance on Slippery Roads2010