基于拓扑地图与改进A*算法的路径规划及跟踪控制
DOI:
作者:
作者单位:

重庆理工大学 车辆工程学院

作者简介:

通讯作者:

中图分类号:

U461

基金项目:

国家自然科学基金项目(面上项目,重点项目,重大项目)


Path Planning and Tracking Control Based on Topological Map and Improved A* Algorithm
Author:
Affiliation:

School of Vehicle Engineering,Chongqing University of Technology

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

    针对传统A*算法依赖栅格地图正交节点布局导致复杂环境适配性不足,且节点遍历冗余、搜索时间长及路径平滑性差等问题,提出一种基于拓扑地图与改进A*算法的路径规划与跟踪控制方法。首先,融合障碍物点云地图与OpenDrive地图构建拓扑地图,提取道路中心点与边界点生成核心点集,解决栅格地图冗余存储问题;其次,优化搜索邻域以适配非正交节点场景,并在评估函数中引入自适应权重的动态方向启发式函数,抑制背离目标的无效探索,提升搜索效率;再次,通过曲率约束的三次样条曲线优化路径平滑性,同时基于优化后路径的曲率分布进行速度规划;最后,采用预瞄控制跟踪策略验证所提算法的有效性。仿真结果显示,路径平滑性大幅提升,验证了所提算法在效率、平滑性与安全性上的协同优化效果。

    Abstract:

    To address the issues of the traditional A* algorithm, such as insufficient adaptability to complex environments due to its reliance on the orthogonal node layout of grid maps, as well as redundant node traversal, long search time, and poor path smoothness, a path planning and speed collaborative optimization method based on topological maps and an improved A* algorithm is proposed. Firstly, the obstacle point cloud map and OpenDrive map are fused to construct a topological map, and road center points and boundary points are extracted to generate a core point set, which solves the problem of redundant storage in grid maps. Secondly, the search neighborhood is optimized to adapt to non-orthogonal node scenarios, and a dynamic direction heuristic function with adaptive weights is introduced into the evaluation function to suppress invalid exploration that deviates from the target and improve search efficiency. Thirdly, the path smoothness is optimized using cubic spline curves with curvature constraints, and speed planning is conducted based on the curvature distribution of the optimized path. Finally, a preview tracking strategy is adopted to verify the effectiveness of the path and speed planning. Simulation results show that the path smoothness is significantly improved, verifying the collaborative optimization effect of the method in terms of efficiency, smoothness, and safety.

    参考文献
    相似文献
    引证文献
引用本文

来飞,刘涛. 基于拓扑地图与改进A*算法的路径规划及跟踪控制[J]. 科学技术与工程, , ():

复制
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:2025-11-07
  • 最后修改日期:2026-04-07
  • 录用日期:2026-04-21
  • 在线发布日期:
  • 出版日期:
×
2026年会通知 | “技术经济学驱动智能经济生态构建与治理变革”——中国技术经济学会第三十三届学术年会(2026)会议通知暨征文启事(第一轮)
亟待确认版面费归属稿件,敬请作者关注