- 专利标题: 一种非完整约束条件下的连续曲率路径优化方法
-
申请号: CN202010797068.2申请日: 2020-08-10
-
公开(公告)号: CN112269965A公开(公告)日: 2021-01-26
- 发明人: 汪洋 , 李胜飞 , 程文 , 赵熙俊 , 崔星 , 高建锋
- 申请人: 中国北方车辆研究所
- 申请人地址: 北京市丰台区槐树岭四号院
- 专利权人: 中国北方车辆研究所
- 当前专利权人: 中国北方车辆研究所
- 当前专利权人地址: 北京市丰台区槐树岭四号院
- 代理机构: 北京理工大学专利中心
- 代理商 许姣
- 主分类号: G06F17/11
- IPC分类号: G06F17/11 ; G06F30/20 ; G06F111/04
摘要:
本发明提供一种非完整约束条件下的连续曲率路径优化方法,该方法构造出来的平滑曲线满足非完整约束条件、曲率连续、存在解析解便于实时计算,有助于提高路径跟踪控制的精度。具体步骤包括:依据车辆转向能力约束确定可行驶的最大曲率;从原始路径上起始点开始按序选取三个路径点;构造两段参数化的三阶Bezier曲线,确定参数值以满足曲率连续和最大值受限双重约束条件;依据参数化方程计算平滑曲线上各点的曲率;对平滑曲线进行非均匀离散化,获取平滑后的目标路径点;重复上述步骤完成对全局路径点的平滑处理;检查平滑曲线与原路径点的拟合匹配情况,并与障碍地图进行碰撞检测。由此,最终得到的优化路径兼顾了无人车辆行驶控制的可通过性和平顺性。
公开/授权文献
- CN112269965B 一种非完整约束条件下的连续曲率路径优化方法 公开/授权日:2024-04-05