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

摘要:

权利要求书:

1.一种基于改进PRM算法的无人驾驶路径规划方法,其特征在于,包括:S1,针对无人驾驶范围内的每个障碍物,将其划分为若干个规则的几何图形,并根据所有几何图形的最小外接圆的圆心构建kdtree搜索树;

S2,遍历路径规划范围内的每个坐标点,利用kdtree搜索树对其与外接圆之间进行碰撞检测,若存在碰撞则剔除该坐标点;最终将遍历完所有坐标点后未剔除的坐标点集合记为Cfree;

路径规划范围内的坐标点,是指:通过做辅助线法将外围禁止约束下的外围轮廓简化为多边形,进而将该多边形内的地图栅格坐标点定义为路径规划范围内的坐标点;

其中,对坐标点与外接圆之间进行碰撞检测,具体为:搜索kdtree上与坐标点最近邻的若干个最小外接圆,并按距离从小到大的顺序,依次对各最小外接圆与坐标点之间基于外接圆半径进行碰撞检测;记坐标点到kdtree上最近邻的最小外接圆圆心的距离为d;

S3,连接无人驾驶路径的起点和目标点得到直线 ,计算集合Cfree中所有坐标点到直线的距离h,再根据距离d与距离h的加权和确定集合Cfree中所有坐标点的采样概率;

根据距离确定集合Cfree中所有坐标点的采样概率计算式为:

,

式中, 是集合 中第 个坐标点 的采样概率; 是坐标点 到最近邻最小外接圆圆心 的欧式距离,表征坐标点 靠近障碍物程度; 是坐标点 到直线 的欧式距离,表征坐标点 靠近启发方向程度; 是坐标点 靠近障碍物距离程度 与靠近启发方向直线距离 的加权和; 、 是距离权重系数; 是集合 中所有坐标点的 中的最大值;N是集合 中的坐标点数;

S4,按照采样概率进行空间采样,并将每个采样点与其K个最近采样点连接,对连线上的Z个插值坐标点分别与外接圆之间进行碰撞检测,若存在碰撞则删除该连线;最终生成无向路图;

S5,借助A*搜索算法在无向路图上进行搜索,获得最短避障路径L。

2.根据权利要求1所述的基于改进PRM算法的无人驾驶路径规划方法,其特征在于,在碰撞检测搜索最小外接圆时,搜索范围为Rmax+M,Rmax表示障碍物划分所得所有几何图像的最小外接圆的最大半径,M表示车辆宽度。

3.根据权利要求1所述的基于改进PRM算法的无人驾驶路径规划方法,其特征在于,采用迭代法查找规则几何图形的最小外接圆;

从规则几何图形上任意取不在一条直线上的3个不同点,基于该3个不同点做圆,判断当前第i次迭代所得圆的半径Ri是否小于当前最小半径Rmin:若Ri

否则,重复上述步骤进行第i+1次迭代查找最小外接圆,直到完成设置的迭代次数,将当前最小外接圆确定为该规则几何图形的最小外接圆。

4.根据权利要求1所述的基于改进PRM算法的无人驾驶路径规划方法,其特征在于,对各最小外接圆与坐标点之间基于外接圆半径进行碰撞检测时,若γ n≤Rn+M,则判定坐标点与最小外接圆存在碰撞,否则判定不存在碰撞;其中,γ n为坐标点与最小外接圆圆心之间的距离,Rn为最小外接圆的半径,M为车辆宽度。

5.根据权利要求1所述的基于改进PRM算法的无人驾驶路径规划方法,其特征在于,在按计算式计算得到采样概率 后,进一步进行非线性和归一化处理,步骤S4再按归一化后的采样概率进行空间采样;其中,非线性和归一化处理表示为:,

式中, 是系数,表征对采样概率 的放大倍数;Pcj是归一化后的采样概率。