Abstract: | To address the challenge of multi-waypoint delivery by unmanned vehicles in scenarios such as industrial parks, the paper proposes a lane-level global path planning, generation and tracking control method based on vectorized high-definition maps. Considering the influence of delivery point sequencing on the total path length, the A* algorithm is used based on high-definition maps to calculate the optimal path between each delivery point. And then, the dynamic programming algorithm is employed to obtain the globally optimal path that passes through multiple delivery points. The planned path is smoothed using Bezier curves,and the reference driving speed is set according to the road curvature at different points along the path,thereby creating a lane-level target trajectory suitable for tracking. Subsequently, a model predictive controller based on a two-degree-of-freedom vehicle model is designed for trajectory tracking to achieve autonomous control of low-speed logistics delivery vehicles. The proposed planning and control method is tested on a joint simulation platform of CarSim,Prescan and Simulink, as well as on a real vehicle platform.The results show, compared with the traditional path determined based on the nearest delivery point strategy,that the path length determined by the proposed method is reduced by an average of 6.15%. The developed trajectory tracking controller ensures that the lateral deviation of the experimental delivery vehicle from the target trajectory is maintained within 0.25 m and the yaw angle deviation is kept within 5°. |