一种无人驾驶车辆路径规划与轨迹跟踪方法
基本信息
申请号 | CN202110733880.3 | 申请日 | - |
公开(公告)号 | CN113359757B | 公开(公告)日 | 2022-07-01 |
申请公布号 | CN113359757B | 申请公布日 | 2022-07-01 |
分类号 | G05D1/02(2020.01)I | 分类 | 控制;调节; |
发明人 | 杨正才;杨俊;周奎;蔡林;姚胜华;张友宾;吕科;尹长城;冯樱 | 申请(专利权)人 | 湖北汽车工业学院 |
代理机构 | 济南泉城专利商标事务所 | 代理人 | - |
地址 | 442002湖北省十堰市张湾区车城西路167号 | ||
法律状态 | - |
摘要
摘要 | 本发明涉及一种无人驾驶车辆路径规划与轨迹跟踪方法,步骤如下:1、设置车辆的初始点目标点位置姿态,将数据预处理;2、以雷达检测的数据为基础,将周围环境栅格化;3、设计混合A*算法进行路径规划;4、路径搜索,将车辆运动学模型线性化,求解搜索末端的车辆状态;5、计算不同搜索末端的车辆状态代价,将代价最小车辆状态放入Close表,作为下次规划的起始节点;6、判断搜索末端车辆状态是否满足条件,如果不满足,持续上述路径搜索并计算代价函数,直至满足;7、采用自适应模型预测算法进行轨迹跟踪;8、设置一段时间内的轨迹误差阙值,若轨迹误差大于阙值,用轨迹曲率计算的纵向速度更新预测模型的输出量,保持在阙值范围内。 |
