欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2023105626612
申请人: 河南工业大学
专利类型:发明专利
专利状态:已下证
专利领域: 测量;测试
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种用于固定场景的路径规划方法,其特征在于,包括:获取固定场景的地图,基于地图中的障碍物构建KD树,并且通过路径搜索算法规划移动对象的移动路径;路径搜索算法采用混合A*算法;

基于KD树计算当前路径节点与障碍物之间的最短距离记为风险距离,并且根据风险距离判断移动对象的风险程度;在计算出风险距离后,将风险距离加入到混合A*算法的代价函数中;

根据风险距离判断移动对象的风险程度时,基于移动对象的最大自身尺寸数据确定多个面积不同的扩展区域,不同的扩展区域对应不同的风险程度,并且基于风险距离与扩展区域的拟合关系确定移动对象的风险程度;

根据移动对象的风险程度扩展路径节点;当风险程度达到第一界限时,将混合A*算法的步长调整为预设的最小值、曲率调整为预设的最大值,当风险程度达到第二界限时,基于风险距离对混合A*算法的步长和曲率进行动态调整;

基于风险距离对混合A*算法的步长进行动态调整的方法为:其中,D(x)为风险距离,max_l和min_l分别代表预设的最大步长和最小步长,ε为移动对象的最大自身尺寸数据;

基于风险距离对混合A*算法的曲率进行动态调整的方法为:其中,max_c和min_c分别代表预设的最大曲率和最小曲率;

当扩展到能够直接利用RS曲线连接终点的路径节点时,对该路径节点的角度信息进行规整;

对RS曲线进行平滑处理。

2.如权利要求1所述的一种用于固定场景的路径规划方法,其特征在于,当扩展到能够直接利用RS曲线连接终点的路径节点时,将该路径节点的角度信息规整到

3.如权利要求1所述的一种用于固定场景的路径规划方法,其特征在于,对RS曲线进行平滑处理的方法包括:确定角度发生跳变的路径节点记为角度跳变点;

计算角度跳变点与障碍物之间的最短距离记为修正距离;

基于修正距离计算RS曲线的长度修正数据和曲率修正数据;

根据长度修正数据和曲率修正数据对RS曲线进行修正。

4.如权利要求3所述的一种用于固定场景的路径规划方法,其特征在于,确定角度跳变点的方法为:遍历移动路径上每个路径节点的角度;

计算路径节点的角度与前一个路径节点的角度之间的差值;

当差值大于预设的阈值时确定路径节点的角度发生跳变,该路径节点记为角度跳变点。