Real-Time Trajectory Planning for On-road Autonomous Tractor-Trailer Vehicles

doi:10.1007/s12204-021-2362-9

Abstract

Abstract: Tractor-trailer vehicles, which are composed of a car-like tractor towing a passive trailer, have been widely deployed in the transportation industry, and trajectory planning is a critical step in enabling such a system to drive autonomously. Owing to the properties of being highly nonlinear and nonholonomic with complex dynamics, the tractor-trailer system poses great challenges to the development of motion-planning algorithms. In this study, an indirect trajectory planning framework for a tractor-trailer vehicle under on-road driving is presented to deal with the problem that the traditional planning framework cannot consider the feasibility and quality simultaneously in real-time trajectory generation of the tractor-trailer vehicle. The indirect planning framework can easily handle complicated tractor-trailer dynamics and generate high-quality, obstacle-free trajectory using quintic polynomial spline, speed pro?le optimization, forward simulation, and properly designed cost functions. Simulations under di?erent driving scenarios and trajectories with di?erent driving requirements are conducted to validate the performance of the proposed framework.

Key words: trajectory planning, tractor-trailer vehicle, forward simulation, on-road driving

CLC Number:

TP 242

SHEN Qiyue (沈琦越), WANG Bing (王冰), WANG Chunxiang∗ (王春香). Real-Time Trajectory Planning for On-road Autonomous Tractor-Trailer Vehicles[J]. J Shanghai Jiaotong Univ Sci, 2021, 26(5): 722-730.

References 17

[1]	GONZ ′ALEZ-CANTOS A, OLLERO A. Backing-up maneuvers of autonomous tractor-trailer vehicles using the qualitative theory of nonlinear dynamical systems [J]. The International Journal of Robotics Research, 2009, 28(1): 49-65.
[2]	WANG Y J, CARTMELL M P. Trajectory generation for a four wheel steering tractor-trailer system: A two-step method [J]. Robotica, 1998, 16(4): 381-386.
[3]	SHAREEF Z, TR ¨ACHTLER A. Simultaneous path planning and trajectory optimization for robotic ma-nipulators using discrete mechanics and optimal con-trol [J]. Robotica, 2016, 34(6): 1322-1334.
[4]	ZHAO H C, CHEN W, ZHOU S B, et al. Online trajec-tory planning for an industrial tractor towing multiple full trailers [C]//2020 IEEE International Conference on Robotics and Automation (ICRA). Paris: IEEE, 2020: 6089-6095.
[5]	LI B, ACARMAN T, ZHANG Y M, et al. Tractor-trailer vehicle trajectory planning in narrow environ-ments with a progressively constrained optimal control approach [J]. IEEE Transactions on Intelligent Vehi-cles, 2020, 5(3): 414-425.
[6]	OLIVEIRA R, LJUNGQVIST O, LIMA P F, et al. A geometric approach to on-road motion planning for long and multi-body heavy-duty vehicles [C]// 2020 IEEE Intelligent Vehicles Symposium (IV ). [s.l.]: IEEE, 2020: 999-1006.
[7]	BOLZERN P, DESANTIS R M, LOCATELLI A, et al. Path-tracking for articulated vehicles with o?-axle hitching [J]. IEEE Transactions on Control Systems Technology, 1998, 6(4): 515-523.
[8]	BUSHNELL L, MIRTICH B, SAHAI A, et al. O?-tracking bounds for a car pulling trailers with kingpin hitching [C]//Proceedings of 1994 33rd IEEE Confer-ence on Decision and Control. Lake Buena Vista, FL: IEEE, 1994: 2944-2949. [9] LAMIRAUX F, BONNAFOUS D, VAN GEEM C. Path optimization for nonholonomic systems: Appli-cation to reactive obstacle avoidance and path plan-ning [M]//Control problems in robotics. Heidelberg: Springer, 2003: 1-18.
[10]	EVESTEDT N, LJUNGQVIST O, AXEHILL D. Mo-tion planning for a reversing general 2-trailer con?gu-ration using Closed-Loop RRT [C]//2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS ). Daejeon: IEEE, 2016: 3690-3697.
[11]	LIMA P F. Optimization-based motion planning and model predictive control for autonomous driving: With experimental evaluation on a heavy-duty construction truck [D]. Stockholm: KTH Royal Institute of Tech-nology, 2018.
[12]	ALTAFINI C. Some properties of the general n-trailer [J]. International Journal of Control, 2001, 74(4): 409-424.
[13]	ALTAFINI C. Following a path of varying curvature as an output regulation problem [J]. IEEE Transactions on Automatic Control, 2002, 47(9): 1551-1556.
[14]	FAN H Y, ZHU F, LIU C C, et al. Baidu Apollo EM motion planner [EB/OL]. [2020-12-20]. https://arxiv.org/pdf/1807.08048.pdf.
[15]	TAKAHASHI A, HONGO T, NINOMIYA Y, et al. Lo-cal path planning and motion control for AGV in po-sitioning [C]//IEEE/RSJ International Workshop on Intelligent Robots and Systems. Tsukuba: IEEE, 1989:
39	2- 397.
[16]	WERLING M, ZIEGLER J, KAMMEL S, et al. Opti-mal trajectory generation for dynamic street scenarios in a Fren′et Frame [C]//2010 IEEE International Con-ference on Robotics and Automation. Anchorage, AK: IEEE, 2010: 987-993.
[17]	STELLATO B, BANJAC G, GOULART P, et al. OSQP: An operator splitting solver for quadratic pro-grams [C]//2018 UKACC 12th International Confer-ence on Control (CONTROL). She?eld: IEEE, 2018:339.