Abstract:Semi-trailer trucks often face difficulty during manual parking owing to their complex structure and large blind areas. Thus, in order to resolve these issues, we propose a path planning and motion control method suitable for single-step perpendicular parking of semi-trailer trucks. In the planning stage, we consider the articulation angle as the maximum virtual steering angle of the semi-trailer truck to calculate its minimum turning radius. Then, we select a feasible starting point area by considering the collision constraint of the truck during the parking process and use the B-spline curve to plan a collision-free reference path. In the motion control stage, we consider the center of the rear axle of the semi-trailer truck as the research object so as to design a model predictive controller based on the established kinematic model. We then propose a reference information selection principle for the controller. Finally, we use Matlab and TruckSim to simulate and analyze different parking starting points and different parking space sizes. Our simulation results show that the parking starting point of the trailer is an arbitrary value in the feasible starting area and that the optional range of parking starting points can be expanded. Our proposed method enables the truck to be parked in a perpendicular parking space without collision and with less tracking error. This observation confirms the good control effect of the designed controller.
[1] 邵俊恺, 赵翾, 杨珏, 等. 无人驾驶铰接式车辆强化学习路径跟踪控制算法[J]. 农业机械学报, 2017, 48(3):376-382. SHAO J K, ZHAO X, YANG Y, at el. Reinforcement learning algorithm for path following control of articulated vehicle[J]. Transactions of the Chinese Society for Agricultural Machinery, 2017, 48(3):376-382. [2] 丁庆国. 牵引-半挂车右转弯后视盲区研究[J]. 林业机械与木工设备, 2021, 49(2):58-61. DING Q G. Study on rear visual blind area of tractor-semitrailer during right turn[J]. Forestry Machinery & Woodworking Equipment, 2021, 49(2):58-61. [3] 郭康正. 现代汽车列车设计与使用[M]. 北京:北京理工大学出版社, 2006. GUO K Z. Design and application of modern automobile train[M]. Beijing:Beijing Institute of Technology Press, 2006. [4] FAN Z S, Chen H. Study on path following control method for automatic parking system based on LQR[J]. SAE International Journal of Passenger Cars-Electronic and Electrical Systems, 2017, 10(1):41-49. [5] XU T, XU Y, WANG D, at el. Path planning for autonomous articulated vehicle based on improved goal-directed rapid-exploring random tree[J/OL]. Mathematical Problems in Engineering, 2020[2022-02-05]. https://www.hindawi.com/journals/mpe/2020/7123164/. DOI:10.1155/2020/7123164. [6] FANG W P, YANG X J, LI Y. Simulation research on the driving stability of articulated vehicle based on ADAMS[C/OL]//IOP Conference Series:Earth and Environmental Science. IOP Publishing, 2020, 587(1)[2022-01-15]. https://iopscience.iop.org/article/10.1088/1755-1315/587/1/012035. DOI:10.1088/1755-1315/587/1/012035. [7] DOU F Q, HUANG Y J, LIU L, at el. Path planning and tracking for autonomous mining articulated vehicles[J]. International Journal of Heavy Vehicle Systems, 2019, 26(3/4):315-333. [8] SUN H, YANG L W, CHEN Y H, at el. Controlling tractor-semitrailer vehicles in automated highway systems:Adaptive robust and Lyapunov minimax approach[J]. Asian Journal of Control, 2020, 23(6):2642-2656. [9] 孟宇, 汪钰, 顾青, 等. 基于预见位姿信息的铰接式车辆LQR-GA路径跟踪控制[J]. 农业机械学报, 2018, 49(6):375-384. MENG Y, WANG Y, GU Q, et al. LQR-GA path tracking control of articulated vehicle based on predictive information[J]. Transactions of the Chinese Society for Agricultural Machinery, 2018, 49(6):375-384. [10] 聂庆灿. 铰接式车辆自动泊车路径规划及跟踪控制策略研究[D]. 长春:吉林大学, 2020. NIE Q C. Research on automatic parking path planning and tracking control strategy for articulated vehicles[D]. Changchun:Jilin University, 2020. [11] 夏光, 赵名卓, 唐希雯, 等. 基于铰接角度稳定域与可行域的半挂汽车列车直线倒车控制研究[J]. 机械工程学报, 2020, 56(24):156-172. XIA G, ZHAO M Z, TANG X W, et al. Research on linear reversing control of semi-trailer based on hitch angle stable domain and feasible domain[J]. Journal of Mechanical Engineering, 2020, 56(24):156-172. [12] JENS R, MARTIN T. Optimised reverse parking of a semi-trailer truck[D]. Gothenburg:Chalmers University of Technology, 2020. [13] 郭丹丹. 半挂汽车列车倒车控制研究[D]. 长春:吉林大学, 2016. GUO D D. Research on control of reversing for tractor-semitrailer combination[D]. Changchun:Jilin University, 2016. [14] 范明磊. 半挂牵引车动力学与轨迹跟踪控制方法研究[D]. 大连:大连理工大学, 2019. FAN M L. Dynamic model and trajectory tracking control method for tractor-semitrailer vehicles[D]. Dalian:Dalian University of Technology, 2019. [15] 尹刚. 车辆垂直泊车系统路径规划与跟踪研究[D]. 西安:长安大学, 2019. YIN G. Research on path planning and tracking of vehicle vertical parking system[D]. Xi'an:Changan University, 2019. [16] 中华人民共和国建设部. 汽车库建筑设计规范:JGJ 100-1998[S]. 北京:中国建筑工业出版社, 1998. Ministry of Construction of the People's Republic of China. Design code for garage:JGJ 100-1998[S]. Beijing:China Architecture & Building Press, 1998. [17] 高强, 陆洲, 段晨东, 等. 汽车垂直泊车路径规划与路径跟踪研究[J]. 汽车工程, 2021, 43(7):987-994, 1012. GAO Q, LU Z, DUAN C D, at el. Research on vehicle vertical parking path planning and path tracking[J]. Automotive Engineering, 2021, 43(7):987-994, 1012. [18] 李红, 王文军, 李克强. 基于B样条理论的平行泊车路径规划[J]. 中国公路学报, 2016, 29(9):143-151. LI H, WANG W J, LI K Q. Path planning for parallel parking based on B spline theory[J]. China Journal of Highway and Transport, 2016, 29(9):143-151. [19] BAI G X, LIU L, MENG Y, at el. Path tracking of mining vehicles based on nonlinear model predictive control[J]. Applied Sciences, 2019, 9(7)[2022-01-05]. http://www.mdpi.com/2076-3417/9/7/1370. DOI:10.3390/app907/1372. [20] 龚建伟, 刘凯, 袁静妮. 无人驾驶汽车模型预测控制[M]. 北京:北京理工大学出版社, 2020. GONG J W, LIU K, YUAN J N, Model predictive control for self-driving vehicles[M]. Beijing:Beijing Institute of Technology Press, 2020. [21] XU Q, WANG J, ZHAO W, et al. Vehicle path tracking maneuver based on model predictive control theory[C/OL]//Journal of Physics:Conference Series. IOP Publishing, 2020, 1650(3)[2022-01-10]. https://iopscience.iop.org/article/10.1088/1742-6596/1650/3/032028. [22] HU J J, XIONG S S, FU C Y. Lane detection and trajectory tracking control of autonomous vehicle based on model predictive control[J]. International Journal of Automotive Technology, 2020, 21(2):285-295.