一种用于非结构化道路的轨迹队列管理方法
摘要:
本发明公开了一种用于非结构化道路的轨迹队列管理方法,属于无人驾驶自动控制技术领域。该方法包括如下步骤:预处理阶段,对全局规划模块下发的一系列顺序连接任务点的原始路径点进行平滑处理得到目标路径;读取定位模块的无人车辆自身GPS位置及航向角,进行局部增量式和全局相结合的混合式路网匹配确定最近关联线段;依据最近关联线段和行驶方向,存储和下发目标路段的一串路点;依据预瞄距离,最终计算得到车辆当前位姿与目标跟踪点的之间的方位角偏差和横向角偏差,并下发给底层路径跟踪控制模块。本发明提出的计算方法和流程能够有效实现无人车辆自主行驶任务下的轨迹队列管理,算法计算量小、实用性高。
公开/授权文献
0/0