基于扩展视野自适应蚁群算法的移动机器人路径规划方法技术

本发明专利技术公开了一种基于扩展视野自适应蚁群算法的移动机器人路径规划方法，该方法通过将蚂蚁当前视野从四个方向进行扩展，扩展后的蚂蚁视野更加广阔，可加快蚂蚁移动速度。同时在计算状态转移概率时，兼顾转角和安全距离两个因素，多因素共同控制算法中的状态转移概率。在轮盘赌选择策略中，采用参数自适应伪随机转移策略，在迭代过程中通过在不同阶段改变概率参数的值可使算法在前期提高收敛速度，在后期提高全局搜索能力。自适应信息素挥发系数在前期值较小可加快算法的全局搜索范围，随着寻找到的路径越来越短，信息素挥发系数变大，可使路径上浓度差变大，增强了蚁群的引导功能，提高了蚁群的搜索速度，使算法快速收敛。使算法快速收敛。使算法快速收敛。

【技术实现步骤摘要】
基于扩展视野自适应蚁群算法的移动机器人路径规划方法


[0001]本专利技术属于机器人
，具体涉及一种移动机器人路径规划方法。

技术介绍

[0002]移动机器人是实现智能制造的重要驱动力，已经成为学术界和企业界关注的焦点。其中，路径规划是移动机器人的核心组成部分，其目标是找到从起始点到目标点的无碰撞最优或者近似最优路径。快速、高效、安全的路径规划算法是寻找到最优路径的关键，同时也是实现移动机器人成功应用的理论基础。
[0003]文献“Miao C,Chen G,Yan C.Path planning optimization of indoor mobile robot based on adaptive ant colony algorithm[J].Computers&Industrial Engineering,2021:107230.”提供了一种改进的自适应蚁群算法来克服现有室内移动机器人路径规划算法存在的部分缺点，如路径规划时间长、最优路径收敛速度慢和易陷入局部最优。但是该方法由于搜索范围局限于围绕当前位置的八个备选栅格、自适应信息素后期变化不明显，从而存在蚂蚁短视和信息素挥发系数后期调节乏力的问题，导致算法搜索效率降低，收敛速度慢。

技术实现思路

[0004]为了克服现有技术的不足，本专利技术提供了一种基于扩展视野自适应蚁群算法的移动机器人路径规划方法，该方法通过将蚂蚁当前视野从四个方向进行扩展，扩展后的蚂蚁视野更加广阔，可加快蚂蚁移动速度。同时在计算状态转移概率时，兼顾转角和安全距离两个因素，多因素共同控制算法中的状态转移概率。在轮盘赌选择策略中，采用参数自适应伪随机转移策略，在迭代过程中通过在不同阶段改变概率参数的值可使算法在前期提高收敛速度，在后期提高全局搜索能力。自适应信息素挥发系数在前期值较小可加快算法的全局搜索范围，随着寻找到的路径越来越短，信息素挥发系数变大，可使路径上浓度差变大，增强了蚁群的引导功能，提高了蚁群的搜索速度，使算法快速收敛。
[0005]本专利技术解决其技术问题所采用的技术方案包括如下步骤：
[0006]步骤1：环境建模；
[0007]构建二维工作空间W，其中障碍物集合所占据的空间为O
obs
＝{o1,o2,o3....o
k
}，满足1<r<R，W表示障碍物所在的工作空间，R表示工作空间中的障碍物数量；移动机器人的自由空间且给定移动机器人的起始位置S＝(x
S
,y
S
)，目标点位置E＝(x
E
,y
E
)；设移动机器人的路径工作点P由工作空间中的点序列P
path
＝(P1,P2,...P
L
)组成，其中P
l
＝(x
l
,y
l
)，P
l
表示栅格中每一个栅格的索引值，x
l
,y
l
表示栅格P
l
的中心点在栅格坐标系的坐标值，l＝1,2,...L，P1＝S，P
L
＝E，L表示移动机器人在工作空间路径工作点的总点数；
[0008]移动机器人在工作空间中两点间的距离为
[0009][0010]其中，x
l+1
、y
l+1
表示栅格P
l+1
的中心点在栅格坐标系的坐标值；
[0011]在地图中对每个栅格编序号，取栅格中心位置作为栅格在坐标系中的坐标，第w个栅格在坐标系中的坐标如下：
[0012][0013]其中，mod为取余运算符，ceil表示向后取整符，N
w
是对应栅格的标号，N表示每一列的栅格数量；栅格的坐标值均采用栅格中心位置的坐标表示，称为栅格的坐标；
[0014]步骤2：初始化算法参数；
[0015]定义最大迭代次数Nc
max
，蚂蚁数量M
max
；
[0016]信息素启发因子α、目标距离启发因子β、转角控制启发因子γ和障碍物安全距离启发因子δ分别表示节点路径信息素含量τ
ij
(t)、目标距离启发信息η
ij
(t)、转角控制启发信息G
ij
(t)和障碍物安全距离启发信息L
ij
(t)对当前蚂蚁选择下一路径点的影响程度，且均为常数；
[0017]起始点设为S，目标点设为E，初始化信息素矩阵Tau，当代最短路径长度min k l＝∞，当前全局最短路径长度min l＝∞，每只蚂蚁的路径长度length
m
＝0，蚂蚁携带信息素总量Q＝1；
[0018]在算法进行初始迭代时，取迭代次数Nc＝1，蚂蚁个数m＝1，依次开始迭代；在初始时刻，蚂蚁位于起始点S开始进行路径寻优，当前点位置i＝S，并将起始点S加入禁忌表T aboo
m
，禁忌表中的点不允许在该只蚂蚁后续选择路径点中出现；
[0019]步骤3：扩展视野；
[0020]以第i个栅格作为当前位置，以当前位置为中心，从上下左右四个方向开始扩展，直到四个方向都首次与障碍物或者边界接触时停止，形成十字形；扩展出来的十字形上边界、下边界、左边界、右边界距离当前位置的距离分别表示为：d1,d2,d3,d4；令a＝d1+d2,b＝d3+d4，从而得到横向和纵向扩展后的总宽度；
[0021](a)若a<b，纵向宽度小，则以纵向宽度为基准进行扩展；当以纵向为基准时，纵向宽度以边界为准保持不变，横向左边界和右边界之间的所有栅格分别向左右两个方向进行扩展，当左右两边分别有任一个栅格扩展后首次与障碍物相接触或者到达边界时停止各自的扩展；扩展完成后，左右两边以扩展到达的栅格条作为边界，上下两边以十字形的上边界和下边界作为边界，形成矩形框，称为视野栅格；
[0022](b)若a≥b，横向宽度较小，则以横向宽度为基准进行扩展；当以横向宽度为基准时，横向宽度以边界为准保持不变，纵向上边界和下边界的所有栅格分别向上下两个方向进行扩展，当上下两边分别有任一个栅格扩展后首次与障碍物相接触或者到达边界时停止各自的扩展；扩展完成后，上下两边以扩展到达的栅格条作为边界，左右两边以十字形的左边界和右边界作为边界，形成矩形框，称为视野栅格；
[0023]步骤3
‑
1：删除视野栅格中含有的障碍物栅格，剩余栅格作为备选栅格；将删除的障碍物后的视野栅格集合定义为D
obsi
；
[0024]步骤3.2，筛选栅格；
[0025]将当前位置与每个备选栅格分别连接，如果连线段经过障碍物栅格，则删掉此备选栅格，得到最终蚂蚁在栅格i处进行状态转移的备选栅格集合D
i
；
[0026]步骤3.3，条件判断，若在栅格i处的可选择栅格Allowed
i...

【技术保护点】

【技术特征摘要】
1.一种基于扩展视野自适应蚁群算法的移动机器人路径规划方法，其特征在于，包括如下步骤：步骤1：环境建模；构建二维工作空间W，其中障碍物集合所占据的空间为O
obs
＝{o1，o2，o3....o
k
}，满足W表示障碍物所在的工作空间，R表示工作空间中的障碍物数量；移动机器人的自由空间且给定移动机器人的起始位置S＝(x
S
，y
S
)，目标点位置E＝(x
E
，y
E
)；设移动机器人的路径工作点P由工作空间中的点序列P
path
＝(P1，P2，...P
L
)组成，其中P
l
＝(x
l
，y
l
)，P
l
表示栅格中每一个栅格的索引值，x
l
，y
l
表示栅格P
l
的中心点在栅格坐标系的坐标值，l＝1，2，...L，P1＝S，P
L
＝E，L表示移动机器人在工作空间路径工作点的总点数；移动机器人在工作空间中两点间的距离为其中，x
l+1
、y
l+1
表示栅格P
l+1
的中心点在栅格坐标系的坐标值；在地图中对每个栅格编序号，取栅格中心位置作为栅格在坐标系中的坐标，第w个栅格在坐标系中的坐标如下：其中，mod为取余运算符，ceil表示向后取整符，N
w
是对应栅格的标号，N表示每一列的栅格数量；栅格的坐标值均采用栅格中心位置的坐标表示，称为栅格的坐标；步骤2：初始化算法参数；定义最大迭代次数Nc
max
，蚂蚁数量M
max
；信息素启发因子α、目标距离启发因子β、转角控制启发因子γ和障碍物安全距离启发因子δ分别表示节点路径信息素含量τ
ij
(t)、目标距离启发信息η
ij
(t)、转角控制启发信息G
ij
(t)和障碍物安全距离启发信息L
ij
(t)对当前蚂蚁选择下一路径点的影响程度，且均为常数；起始点设为S，目标点设为E，初始化信息素矩阵Tau，当代最短路径长度min kl＝∞，当前全局最短路径长度min l＝∞，每只蚂蚁的路径长度length
m
＝0，蚂蚁携带信息素总量Q＝1；在算法进行初始迭代时，取迭代次数Nc＝1，蚂蚁个数m＝1，依次开始迭代；在初始时刻，蚂蚁位于起始点S开始进行路径寻优，当前点位置i＝S，并将起始点S加入禁忌表Taboo
m
，禁忌表中的点不允许在该只蚂蚁后续选择路径点中出现；步骤3：扩展视野；以第i个栅格作为当前位置，以当前位置为中心，从上下左右四个方向开始扩展，直到四个方向都首次与障碍物或者边界接触时停止，形成十字形；扩展出来的十字形上边界、下边界、左边界、右边界距离当前位置的距离分别表示为：d1，d2，d3，d4；令a＝d1+d2，b＝d3+d4，从而得到横向和纵向扩展后的总宽度；(a)若a＜b，纵向宽度小，则以纵向宽度为基准进行扩展；当以纵向为基准时，纵向宽度以边界为准保持不变，横向左边界和右边界之间的所有栅格分别向左右两个方向进行扩
展，当左右两边分别有任一个栅格扩展后首次与障碍物相接触或者到达边界时停止各自的扩展；扩展完成后，左右两边以扩展到达的栅格条作为边界，上下两边以十字形的上边界和下边界作为边界，形成矩形框，称为视野栅格；(b)若a≥b，横向宽度较小，则以横向宽度为基准进行扩展；当以横向宽度为基准时，横向宽度以边界为准保持不变，纵向上边界和下边界的所有栅格分别向上下两个方向进行扩展，当上下两边分别有任一个栅格扩展后首次与障碍物相接触或者到达边界时停止各自的扩展；扩展完成后，上下两边以扩展到达的栅格条作为边界，左右两边以十字形的左边界和右边界作为边界，形成矩形框，称为视野栅格；步骤3
‑
1：删除视野栅格中含有的障碍物栅格，剩余栅格作为备选栅格；将删除的障碍物后的视野栅格集合定义为D
obsi
；步骤3.2，筛选栅格；将当前位置与每个备选栅格分别连接，如果连线段经过障碍物栅格，则删掉此备选栅格，得到最终蚂蚁在栅格i处进行状态转移的备选栅格集合D
i
；步骤3.3，条件判断，若在栅格i处的可选择栅格Allowed
i
＝D
i
‑
Taboo
m
为则转到步骤6；反之，顺序执行后续步骤；步骤4：状态转移参数自适应调整；当前栅格在栅格坐标系中的坐标为(x
i
，y
i
)，各备选栅格坐标为(x
j
，y
j
)，j∈Allowed
i
；由式(1)计算当前位置到每一个备选节点的距离d
ij
以及备选点到目标点的距离d
jE
：由此得到当前备选点j的目标距离启发信息η
ij
为：步骤4
‑
1：计算从当前点到各备选点的旋转角度；起始点与目标点的距离d
SE
为：以当前点与备选点连线为以起始点与目标点连线为根据余弦定理依次计算每一个向量与之间的夹角θ
ijSE
：步骤4
‑
2：计算转角控制启发信息；根据步骤4
‑
1计算得到的旋转...

【专利技术属性】
技术研发人员：孙树栋，张红荣，李思，杜鑫，梅博文，刘战，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：