On campus, the complexity of the environment and the lack of regulatory constraints make it difficult to model the environment, resulting in less efficient motion planning algorithms. To solve this problem, HD-Map-guided sampling-based motion planning is a feasible research direction. We proposed a motion planning algorithm for autonomous vehicles on campus, called HD-Map-guided rapidly-exploring random tree (HDM-RRT). In our algorithm, A collision risk map (CR-Map) that quantifies the collision risk coefficient on the road is combined with the Gaussian distribution for sampling to improve the efficiency of algorithm. Then, the node optimization strategy of the algorithm is deeply optimized through the prior information of the CR-Map to improve the convergence rate and solve the problem of poor stability in campus environments. Three experiments were designed to verify the efficiency and stability of our approach. The results show that the sampling efficiency of our algorithm is four times higher than that of the Gaussian distribution method. The average convergence rate of the proposed algorithm outperforms the RRT* algorithm and DT-RRT* algorithm. In terms of algorithm efficiency, the average computation time of the proposed algorithm is only 15.98 ms, which is much better than that of the three compared algorithms.

Trajectory planning in tight spaces presents a significant challenge due to the complex maneuvering required under kinematic and obstacle avoidance constraints. When obstacles are densely distributed near the target state, the limited connectivity between the feasible states and terminal state can further decrease the efficiency and success rate of trajectory planning. To address this challenge, we propose a novel Dual-Stage Motion Pattern Tree (DS-MPT) algorithm. DS-MPT decomposes the trajectory generation process into two stages: merging and posture adjustment. Each stage utilizes specific heuristic information to guide the construction of the trajectory tree. Our experimental results demonstrate the high robustness and computational efficiency of the proposed method in various parallel parking scenarios. Additionally, we introduce an enhanced driving corridor generation strategy for trajectory optimization, reducing computation time by 54% to 84% compared to traditional methods. Further experiments validate the improved stability and success rate of our approach.