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

摘要:

权利要求书:

1.一种基于Informed‑RRT*融合约束采样空间和人工势场的路径规划方法,其特征在于,包括以下步骤:步骤一:采集目标物体的环境信息,并基于所述环境信息构建栅格地图;

步骤二:将所述栅格地图中每个栅格标记为障碍空间或自由空间,并在标记后的栅格地图中选择一起始点和目标点;

步骤三:利用约束采样空间策略和目标偏置策略并融合Informed RRT*算法,以得到融合算法,并通过所述融合算法在栅格地图的自由空间中进行采样,以获得初始路径;

步骤四:获得所述初始路径后,利用所述融合算法和所述初始路径计算出椭圆采样空间,并采用人工势场算法在所述椭圆采样空间中进行采样,以得到第一路径;

步骤五:将所述人工势场算法结合所述融合算法对所述第一路径进行优化,以得到与障碍物保持安全距离的渐近最优性路线;

步骤六:根据所述渐近最优性路线更新所述椭圆采样空间,并在更新后的椭圆采样空间中进行采样,以得到渐近最优性路径;

步骤七:将所述渐近最优性路径重复上述步骤六,直到达到迭代次数,以得到所述目标物体的最终规划路径。

2.根据权利要求1所述的路径规划方法,其特征在于,所述步骤一包括:利用移动机器人自带的图像传感器或雷达传感器采集目标物体的前方预设视野范围内的障碍物大小、障碍物位置、障碍物数量以及障碍物分布情况;

获取所述目标物体的当前位置信息,并基于所述当前位置信息、所述障碍物大小、所述障碍物位置、所述障碍物数量以及所述障碍物分布情况构建所述目标物体的栅格地图。

3.根据权利要求1所述的路径规划方法,其特征在于,所述步骤三包括:使用约束采样空间策略加快所述Informed RRT*算法的初始解的迭代,得到均匀的圆形采样空间,并在所述圆形采样空间中进行采样;

利用所述目标偏置策略加快所述Informed RRT*算法的迭代,以得到所述初始路径。

4.根据权利要求3所述的路径规划方法,其特征在于,利用约束采样空间策略加快初始解的迭代,得到均匀的圆形采样空间,并在所述圆形采样空间中进行采样的步骤包括:计算出所述起始点和所述目标点的直线距离的中点,并以所述中点为圆心、所述直线距离为直径规划出均匀的圆形采样空间;

定义随机树,并利用所述随机树在所述圆形采样空间内进行采样。

5.根据权利要求4所述的路径规划方法,其特征在于,利用所述目标偏置策略加快所述Informed RRT*算法的迭代,以得到所述初始路径的步骤包括:设置以所述目标点采样的目标概率;

在当前随机采样获取采样点时,随机生成一个从第一区间内均布采样的当前概率,并判断所述当前概率是否大于所述目标概率;

若所述当前概率大于所述目标概率,则在所述圆形采样空间中随机产生一个当前采样点;

若所述当前概率不大于所述目标概率,则以所述目标点作为当前采样点;

在得到所述当前采样点后,进行下一次采样,并判断两次采样的采样点能否进行连接;

若两次采样的采样点能进行连接,将第二次采样的采样点与所述目标点进行连接,以得到所述初始路径;

若两次采样的采样点不能进行连接,则继续进行下一次采样,直到两次相邻的采样的采样点之间能进行连接,将所述两次相邻的采样中后一次的采样点与所述目标点进行连接,以得到所述初始路径。

6.根据权利要求5所述的路径规划方法,其特征在于,判断两次采样的采样点能否进行连接的步骤包括:计算第二次采样的采样点与所述目标点的距离,并判断所述距离是否小于采样步长;

若所述距离小于采样步长,判定两次采样的采样点不能进行连接;

若所述距离不小于采样步长,判定两次采样的采样点能进行连接。

7.根据权利要求1所述的路径规划方法,其特征在于,所述步骤四包括:将所述初始路径的长度作为椭圆的两个顶点之间的距离、并以所述起始点与所述目标点距离为椭圆的两焦点之间的距离;

根据所述椭圆的两个顶点之间的距离和所述椭圆的两焦点之间的距离构建椭圆采样空间。

8.根据权利要求4所述的路径规划方法,其特征在于,所述中点的计算公式为:式中,mid表示中点,x1,y1表示已知的起始点坐标,x2,y2表示目标点的坐标,xmid,ymid表示所求圆心。

9.根据权利要求5所述的路径规划方法,其特征在于,所述当前采样点的表达式为:式中,xrand表示当前采样点,P表示当前概率,Pgoal表示目标概率,xgoal表示目标点。