一种基于混合算法的移动机器人路径规划方法

文档序号:24656042发布日期:2021-04-13 21:03阅读:来源:国知局

技术特征:
1.一种基于混合算法的移动机器人路径规划方法,其特征在于它具体包括如下步骤:(1)通过移动机器人配置传感器对全局环境信息进行采集,得到能够描述作业环境信息的环境图像信号;(2)利用栅格法,根据步骤(1)采集到的环境图像信号创建移动机器人的作业环境模型;(3)基于步骤(2)创建的移动机器人的作业环境模型,利用a

star算法规划出每两个目标点的路径;(4)在步骤(3)的基础上,利用融合蚁群算法确定所有目标点的遍历顺序,由此遍历顺序构成的路径是一条能遍历所有目标点的最短距离:(5)移动机器人从起点开始沿着由步骤(4)找到的能够遍历所有目标点的最短距离的路径移动,并利用基于融合动态窗口算法的局部动态规划预测移动机器人的运动轨迹,对行进过程中遇到的移动障碍物进行实时的避障,选择最优路径,使移动机器人能够避开障碍物,并在避障后仍按着原先的路径移动,最终返回起点。2.根据权利要求1所述一种基于混合算法的移动机器人路径规划方法,其特征在于所述步骤(1)中的移动机器人可以是陆地机器人、水下机器人或空中机器人;所述通过移动机器人配置传感器对全局环境信息进行采集是指利用移动机器人自身携带的环境信息采集装置及数据采集方法获得,用于构建能够描述作业环境信息的环境图像信号。3.根据权利要求1所述一种基于混合算法的移动机器人路径规划方法,其特征在于所述步骤(3)中采用a

star算法规划每两个目标点间的规划路径,由以下步骤构成:(3

1)选择待规划路径的起点,由a

star算法原理确定待考察节点,并建立存放待考察节点的open列表;并从open列表中选出“考察到的且评价函数最低”的节点放入到closed列表;(3

2)确定起始栅格节点s,把起始栅格节点s归入open列表中;(3

3)在open列表中进行选择,根据式(1)所示的评价函数,计算open列表中的每个待考察节点的评价函数,并从中选择评价函数最低的节点放入到closed列表中;f(i)=g(i)+h(i)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)其中,i表示第i个节点,g(i)表示从起始栅格节点s到第i个节点的付出代价值,h(i)表示从第i个节点到目标点t的预测代价值;(3

4)若此时open列表为空,也就是指以当前节点为中心,open列表中的待考查的节点分为两大类,一类是障碍物栅格不能通过,另一类则是已经放入到了closed列表中,以导致待考察的节点都不能选择,此时,两种情况都会使open列表表现为空,将意味着路径规划失败;若此时open列表为非空,则查找open列表中评价函数f(i)最小的节点,将其作为当前节点a,并将该节点a放入到closed列表中;(3

5)判断步骤(3

4)中选取的节点a是否为目标点,如果是,则流程结束;反之,则以该节点a为父节点在其周围进行子节点扩展,并进行扩展后处理;(3

6)根据(3

5)步骤继续进行子节点扩展,直到当目标节点被放入到closed列表时,则停止搜索,表明找到从起点到目标点通行的路径;当open列表为空且目标节点未被找到时,也要停止搜索,标明此时没有能通行的路径。4.根据权利要求3所述一种基于混合算法的移动机器人路径规划方法,其特征在于所
述步骤(3

1)中的待考察节点包括两种情况,一是从起点开始,以起点为中心,周围与之相邻的节点,二是从待考察节点中选出的其评价函数最低的节点,再以评价函数最低的节点为中心,周围与之相邻的节点;待考察节点包括已经考察过的节点或者含有障碍物的节点。5.根据权利要求3所述一种基于混合算法的移动机器人路径规划方法,其特征在于所述步骤(3

5)中对子节点进行扩展后处理具体是指:(3
‑5‑
1)若待扩展的子节点即不在closed列表中,也不在open列表中,同时也不在障碍栅格中,则把该节点加入到open表中;(3
‑5‑
2)若待扩展的子节点在closed列表中或者是障碍栅格中,则跳过该子节点;(3
‑5‑
3)若在open列表中已经有该子节点,判断该子节点的评价函数f(i)值是否小于open列表中的评价函数f(i)值,如果是,则更新open列表中的评价函数f(i)值,依此将待扩展的子节点遍历,并找到评价函数f(i)值最小的子节点。6.根据权利要求1所述一种基于混合算法的移动机器人路径规划方法,其特征在于所述步骤(4)中利用融合蚁群算法确定所有目标点的遍历顺序,由此遍历顺序构成的路径是一条能遍历所有目标点的最短距离,其具体包括以下步骤:(4

1)初始化蚁群参数各路径的信息素,蚂蚁数量为m,n为目标点的数量,每一只蚂蚁随机选择n个目标点的某一个目标点为出发点;(4

2)每只蚂蚁按照如式(4)所示的状态转移概率,计算下一个待访问的目标点,即从第i个目标点移到下一个顶点j,直到所有蚂蚁完成一次周游,即所有目标点被所有蚂蚁遍历;式中,s为起始栅格节点;allowed
k
为蚂蚁下一步可走的目标点集合;为t时刻路径上的信息素,为路径长度的倒数,α为信息素重要程度因子,β为启发函数重要程度因子;(4

3)当所有蚂蚁执行完一次循环以后,记录每只蚂蚁经过的路径总长度l以及当前迭代的最短路径,并按式(5)

(7)的信息素更新公式,更新目标点之间的信息素浓度:(7)的信息素更新公式,更新目标点之间的信息素浓度:(7)的信息素更新公式,更新目标点之间的信息素浓度:其中,ρ0为信息素挥发系数;n
c
为当前蚂蚁迭代次数;n
max
为蚂蚁最大的迭代次数,δτ
i,j
为目标点i,j之间来自所有蚂蚁的信息素浓度值和,l为第k只蚂蚁在当前搜索中行走距离之和,q表示信息素的强度;(4

4)若当迭代次数达到最大,则输出最优遍历顺序,将其作为移动机器人在路径规划
过程中所遍历目标点的顺序,此遍历目标点的顺序与原点构成的路径则为最短距离,否则,迭代次数加1,并清空蚂蚁路径记录表,返回步骤(4

2)继续执行,直到完成移动机器人的多目标点全局静态路径规划。7.根据权利要求1所述一种基于混合算法的移动机器人路径规划方法,其特征在于所述步骤(5)中利用基于融合动态窗口算法的局部动态规划预测移动机器人的运动轨迹具体由以下步骤构成:(5

1)当移动机器人得到开始移动的指令,以步骤(4)全局规划好的路径为基础,将移动机器人放置原点,并将初始位置到第一个目标点的中间转折点设置为第一个动态的子目标点,若没有转折点则将第一个目标点设置为第一个动态的子目标点;(5

2)建立移动机器人的运动模型:设移动机器人的线速度为v
t
和角速度为w
t
;当前移动机器人的位姿表示为(x0,y0,θ0),记下一时刻位姿为(x
t
,y
t

t
),则其运动模型如式(8)所示:其中,x0代表移动机器人当前位置的横坐标,y0代表移动机器人当前位置的纵坐标,θ0代表移动机器人当前位置的航向角,x
t
为移动机器人下一时刻的横坐标,y
t
为移动机器人下一时刻的纵坐标,θ
t
代表移动机器人下一时刻的航向角;(5

3)在式(8)所示的移动机器人的运动模型的基础上,对移动机器人的运行速度进行采样,并根据采样速度推算出该移动机器人的运动轨迹,并对该轨迹进行评价;其中,对移动机器人的运行速度进行采样受移动机器人自身条件和环境因素影响的限制:(5
‑3‑
1)移动机器人受自身最大最小速度的限制如式(9)所示:v
m
∈{v∈[v
min
,v
max
],w∈[w
min
,w
max
]}
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(9)式中,v
min
为最小线速度,v
max
为最大线速度,w
min
为最小旋转角速度,w
max
为最大旋转角速度;(5
‑3‑
2)移动机器人受自身的电机性能的影响:由于电机力矩有限,存在最大的加减速限制,因此移动机器人轨迹前向模拟的周期内,存在一个动态窗口,在该窗口内的速度是移动机器人能够实际达到的速度,即:式中,v
c
,w
c
是移动机器人的当前速度和旋转角速度,表示瞬时减速度,表示瞬时旋转减速度,表示瞬时加速度,表示瞬时旋转加速度;(5
‑3‑
3)从移动机器人安全的考虑,为了使移动机器人能够在碰到障碍物前停下来,则在其最大减速度的条件下,移动机器人的行驶应满足式(11)所示的速度范围:其中,dist(v,w)为速度(v,w)对应轨迹上离障碍物最近的距离;(5

4)将步骤(5

3)中根据式(9)

(11)得到的每一种条件下的采样速度取交集,即可得到至少一组速度;并将其代入式(8)所示的运动学模型中,从而得到该移动机器人的运动轨
迹;且不同的速度将得到不同的运动轨迹;(5

5)由于在步骤(5

4)中根据采样速度组,能够得到不少于1条的可行运动轨迹,因此采用如式(12)所示评价函数的方式对每条轨迹进行评价:g(v,w)=σ(α
·
heading(v,w)+β
·
dist(v,w)+γ
·
velocity(v,w))
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(12)其中,heading(v,w)是用来评价移动机器人在当前设定的采样速度下,达到模拟轨迹末端时的朝向和目标之间的角度差距;dist(v,w)代表移动机器人在当前轨迹上与最近的障碍物之间的距离;如果在这条轨迹上没有障碍物,那就将dist(v,w)设定为一个常数;velocity(v,w)用来评价当前轨迹的速度大小;(5

6)将式(12)中的heading(v,w)、dist(v,w)及velocity(v,w)三个部分分别按照式(13)

(15)进行归一化处理:化处理:化处理:(5

7)将步骤(5

6)中归一化处理后的heading(v,w),dist(v,w),dist(v,w)带入式(12)中,选取评价函数最高的轨迹为最终的移动机器人的运动轨迹,并按照该条轨迹所对应的速度来驱动机器人运动;(5

8)移动机器人按照步骤(5

7)中得到的最终运动轨迹所对应的速度前行,直到遇到目标点,并判断当前目标点的位置是否为起点的位置,若是则为最终目标点,运动结束,否则要准备移动到下一个目标点,重复步骤(5

1)

步骤(5

8),直到机器人运动到起点则结束。8.根据权利要求7所述一种基于混合算法的移动机器人路径规划方法,其特征在于所述移动机器人是球形两栖移动机器人。
当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1