HAN Yanling,ZHANG Like,ZHOU Guofeng,et al.Path planning for oversized cargo vehicles considering three-dimensional collision risks[J].Chinese Journal of Intelligent Science and Technology,2025,07(04):454-467.
考虑大件物流车辆三维碰撞风险,为提高车辆行驶路径平滑度及路径跟踪精度,提出了一种大件物流车辆闭环迭代路径规划方法。首先,在混合A*算法中引入大件物流车辆运动学约束规划基础路径;其次,结合控制器和车辆运动学模型进行基础路径优化,提高路径平滑度,降低车辆路径跟踪误差;同时,在路径优化过程中,利用Delaunay三角剖分得到大件物流货物四面体网格,进行精细化三维碰撞风险识别;基于风险识别结果,重新定义二维障碍物地图,进行闭环迭代规划,确定大件物流车辆最优路径。在3种典型场景中进行仿真测试,结果显示,相对于4种对比方法,所提方法能有效识别三维碰撞风险,规划出大件物流车辆最优安全路径,规划路径平均曲率为0.013 7 m
-1
,铰接角均低于24.59 °,均方根误差降幅达49.51%以上。
Abstract
To address three-dimensional collision risks associated with oversized cargo vehicles and enhance path smoothness and tracking accuracy
a closed-loop iterative path planning method is proposed for oversized cargo vehicles. First
a basic path is planned by incorporating kinematic constraints for oversized cargo vehicles into the hybrid A* algorithm. Second
the basic path is optimized by integrating the controller and vehicle kinematic model to improve path smoothness and reduce path tracking error. Concurrently
during path optimization
a tetrahedral mesh of the ov
ersized cargo obtained via Delaunay triangulation is utilized for refined 3D collision risk identification. Based on the risk identification results
the 2D obstacle map is redefined to perform closed-loop iterative planning
determining the optimal path for the oversized cargo vehicle. Through simulation testing in three typical scenarios
the proposed method effectively identifies 3D collision risks and plans safe paths compared with four alternative approaches. The average curvature of the planned paths is 0.013 7 m
-1
with articulation angles consistently below 24.59 °
and the root mean square error reduction exceeds 49.51 %
thereby planning optimal safe paths for large-item logistics vehicles.
Ministry of Transport of the People's Republic of China. Decision of the Ministry of Transport on Amending the "Regulations on the administration of highway transportation by oversized and overweighted vehicles": No. 12, 2021, Ministry of Transport of the People's Republic of China[R]. Beijing: Ministry of Transport of the People's Republic of China, 2021.
LUO Y F, WANG S M. Data acquisition and application of airborne LiDAR system in road survey[J]. Bulletin of Surveying and Mapping, 2012(S1): 362-364, 371.
PETRU J, KRIVDA V. The transport of oversized cargoes from the perspective of sustainable transport infrastructure in cities[J]. Sustainability, 2021, 13(10): 5524.
TIAN Z D, LYU L, WANG Y Y, et al. Evaluation method for space accessibility of highway abnormal indivisible load transport[J]. Journal of Highway and Transportation Research and Development, 2024, 41(3): 179-189.
REDA M, ONSY A, HAIKAL A Y, et al. Path planning algorithms in the autonomous driving system: a comprehensive review[J]. Robotics and Autonomous Systems, 2024, 174: 104630.
GUAN J Y, LI B, ZHOU A, et al. Study on safe parking path planning algorithm for narrow environment[J]. Automotive Engineering, 2025, 47(5): 797-808.
BARLAKAS S, TSIAKAS K, ALEXIOU D, et al. Artificial potential field-based kinematic bidirectional-RRT for robot- trailer kinematics[C]//Proceedings of the 2024 IEEE International Conference on Imaging Systems and Techniques. Piscataway: IEEE Press, 2024: 1-6.
CHOI J W, HUHTALA K. Constrained global path optimization for articulated steering vehicles[J]. IEEE Transactions on Vehicular Technology, 2016, 65(4): 1868-1879.
EVESTEDT N, LJUNGQVIST O, AXEHILL D. Motion planning for a reversing general 2-trailer configuration using Closed-Loop RRT[C]//Proceedings of the 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway: IEEE Press, 2016: 3690-3697.
LI B, ACARMAN T, ZHANG Y M, et al. Tractor-trailer vehicle trajectory planning in narrow environments with a progressively constrained optimal control approach[J]. IEEE Transactions on Intelligent Vehicles, 2020, 5(3): 414-425.
ZHAO M Z, SHEN T, WANG F X, et al. APTEN-planner: autonomous parking of semi-trailer train in extremely narrow environments[J]. IEEE Transactions on Intelligent Transportation Systems, 2024, 25(5): 4116-4132.
HE S W, LIU B L. Review of bounding box algorithm based on 3D point cloud[J]. International Journal of Advanced Network, Monitoring and Controls, 2021, 6(1): 18-23.
PALMER I J, GRIMSDALE R L. Collision detection for animation using sphere-trees[J]. Computer Graphics Forum, 1995, 14(2): 105-116.
ZHANG R, YANG Z H, SUN G M, et al. Linear dynamic separating axis algorithm for continuous collision detection[J]. Journal of Computer-Aided Design and Computer Graphics, 2024, 36(10).
FAN Q, TAO B, GONG Z Y, et al. Fast global collision detection method based on feature-point-set for robotic machining of large complex components[J]. IEEE Transactions on Automation Science and Engineering, 2023, 20(1): 470-481.
GUO X Y, WANG R, ZHONG S S, et al. Boundary construction method of collision avoidance for conventional cutters[J]. The International Journal of Advanced Manufacturing Technology, 2023, 127(1): 65-80.
ZHU A M, ZHANG Z Q, PAN W. Developing a fast and accurate collision detection strategy for crane-lift path planning in high-rise modular integrated construction[J]. Advanced Engineering Informatics, 2024, 61: 102509.
Administration for Market Regulation of Hunan Province. Specification of escorting about highway over-limited transportation: DB43/T 2994—2024[S]. Changsha: Administration for Market Regulation of Hunan Province, 2024.
KONG J, PFEIFFER M, SCHILDBACH G, et al. Kinematic and dynamic vehicle models for autonomous driving control design[C]//Proceedings of the 2015 IEEE Intelligent Vehicles Symposium (Ⅳ). Piscataway: IEEE Press, 2015: 1094-1099.
ZIPS P, BÖCK M, KUGI A. An optimisation-based path planner for truck-trailer systems with driving direction changes[C]//Proceedings of the 2015 IEEE International Conference on Robotics and Automation. Piscataway: IEEE Press, 2015: 630-636.
FANG Z G, JIANG J X, XU J. Efficient collision detection using a dual K-DOP-sphere bounding volume hierarchy[C]//Proceedings of the 2010 International Forum on Information Technology and Applications-Volume 03. New York: ACM, 2010: 185-189.
BOISVERT R, BARBER C B, DOBKIN D P, et al. The quickhull algorithm for convex hulls[J]. ACM Transactions on Mathematical Software, 1996, 22(4): 469-483.
LEE D T, SCHACHTER B J. Two algorithms for constructing a Delaunay triangulation[J]. International Journal of Computer & Information Sciences, 1980, 9(3): 219-242.
FLOATER M S. Generalized barycentric coordinates and applications[J]. Acta Numerica, 2015, 24: 161-214.
CHEN X, XIANG L G, JIAO F W. Turning information enhancement of OpenStreetMap Road network based on crowdsourcing trajectory data[J]. Journal of Geo-Information Science, 2023, 25(10): 1954-1967.
Ministry of Transport of the People's Republic of China. Design pecifications for Highway Speed Limit Signs: JTG/T 3381-02—2020[S]. Beijing: China Communications Press, 2020.