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

摘要:

权利要求书:

1.一种复杂环境下快速自适应采样优化路径规划方法,其特征在于,包括路径规划器,所述路径规划器通过改进批采样算法,快速找到一条从起点到终点的无碰撞路径,具体步骤如下:

11)建立空间采样点集合Qv,将起点和终点加入Qv中;

12)空间批采样,首先在地图空间进行均匀批采样,均匀批采样保证采样点在地图空间随机均匀分布,每次生成s个采样点;

对于s中的任一采样点p,定义点p与地图空间障碍物位置关系函数O(p),以O(p)=1表示点p在障碍物内,O(p)=0表示点p在非障碍物区域;

对于O(p)=0的采样点,直接加入采样点集合Qv;

对于O(p)=1的采样点,查找Qv中距离p点最近的采样点q,计算pq之间的欧氏距离d;在以p为圆心,d为半径生成的圆上生成s'个采样点;

对于s'内任一采样点p',如果O(p')=0,则将p'加入进采样点集合Qv,否则舍弃该点;

13)遍历计算每个点到最近障碍物的距离r,以r为半径,建立各点的邻域圆空间,如果地图环境是三维空间,则建立各点邻域球空间,如果地图环境是高维空间,则建立超邻域球空间;r的计算公式如下:r=vstart-vgoal*ln(n)/n

其中,vstart-vgoal是起点到终点的空间欧氏距离,n=length(Qv),是集合Qv的元素个数;

14)遍历每个邻域圆,将每个圆内的采样点互相连接;

15)从起点出发,遍历Qv中每个点的邻接矩阵,查找是否有到终点的路径,如果有则继续,没有则转到步骤12);

16)找到路径后,判断路径上节点和边是否与障碍物有碰撞,如果有,则删除碰撞点及其所在边;继续查找是否有到终点的路径,如果没有则转到步骤15),如果有则路径规划器完成工作。

2.根据权利要求1所述一种复杂环境下快速自适应采样优化路径规划方法,其特征在于,步骤12)中的s可根据具体环境变化生成,可以为50。

3.根据权利要求1所述一种复杂环境下快速自适应采样优化路径规划方法,其特征在于,步骤12)中的s'根据跟随半径d大小在区间[5,30]中变化,d越大s'越大。

4.根据权利要求1所述一种复杂环境下快速自适应采样优化路径规划方法,其特征在于,步骤12)中的s'值为15。

5.根据权利要求1至4任一项所述一种复杂环境下快速自适应采样优化路径规划方法,其特征在于,所述规划方法还包括路径优化器,在路径规划器基础上,在隐式圆空间区域重点采样,进行路径优化,得到一条无碰撞渐进最优的路径,具体步骤如下:

21)依据路径上各点到起点的路径距离大小,建立路径节点优先队列U;

22)判断算法是否收敛或是否到达最大步数,此最大步数根据U的长度计算,默认值为length(U)*s,是则算法结束,否则算法继续;

23)判断树节点优先队列是否为空,是则转到步骤7),否则算法继续;

24)从队列中取出代价最小元素v,并从队列U中删除该元素;代价最小意指到起点的树上距离最近;

25)以节点v为圆心,到最近树节点距离为半径,建立该节点隐式圆空间;如果地图环境是三维空间,则为节点隐式球空间,如果地图环境是高维空间,则为节点隐式超球空间;

26)在v的隐式圆空间内,根据经过v的路径夹角小于180度的一侧进行采样,用采样点替代路径上的v点,完成操作算法转到步骤3);

27)依据路径树边的长度累加和,判断新路径是否优于原路径,如果长度大于原路径,算法转到步骤22),否则新路径更优,算法继续;

28)更新路径,算法转到步骤21)。