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

技术特征：
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计算得到的旋转角度θ
ijse
，得到转角控制启发信息表达式：a)当θ
ijse
≠180
°
时，转角控制启发信息表达式为：b)当θ
ijse
＝180
°
时，转角控制启发信息表达式为：
g
ij
(t)＝0.01步骤4-3：计算备选栅格的障碍物安全距离启发信息步骤4-3-1：根据当前点i的坐标(x
i
，y
i
)与备选点j的坐标(x
j
，y
j
)得到当前点与备选点连线的直线表达式：(y
i-y
j
)x (x
j-x
i
)y x
i
y
j-x
j
y
i
＝0步骤4-3-2：分别求出障碍物栅格集合d
obsi
内各障碍物栅格中心点c对应的坐标值(x
obsi
，y
obsi
)；步骤4-3-3：根据点到直线的距离求出各障碍物栅格中心点k距离直线ij的最短直线距离：步骤4-3-4，：备选栅格的障碍物安全距离启发信息为l
ijobs
(t)＝min(l
ijobs
(c))；步骤4-4：计算状态转移概率；计算蚂蚁m从当前位置i向j点转移的概率为：步骤4-5：根据迭代次数动态调整轮盘赌参数q0的值：式中，δ0为常数；步骤4-6：根据轮盘赌方式选择节点；在得到每个备选节点j的状态转移概率后，根据轮盘赌策略进行节点选择：当随机数q≤q0时，蚂蚁选择备选节点中最大的点，反之，则随机选择一个备选节点，并且移动到下一节点j，节点路径长度路径总长度length
m
←
length
m
length
ij
；步骤4-7：修改禁忌表taboo
m
；蚂蚁每访问一个节点j就将其加入禁忌表taboo
m
中，禁忌表中的点不允许在该只蚂蚁后续选择路径点中出现；步骤4-8：计算路径占用栅格；计算当前点与备选点连线的斜率(a)若k
ij
＝0，占用栅格坐标求解公式为：
(b)若k
ij
不存在时，占用栅格坐标求解公式为：(c)若k
ij
＝1时，占用栅格坐标求解公式为：(d)若1＜k
ij
＜∞，按照当前点到备选点连线的顺序，计算出连线与各水平栅格的交点，连线占用栅格为与交点相接的两个栅格，若交点为栅格顶点则忽略；若0＜k
ij
＜1，则计算出连线与各垂直栅格的交点，连线占用栅格为与交点相接的两个栅格，若交点为栅格顶点则忽略；步骤4-9，坐标转换；在得到占用栅格的坐标点后，根据式(2)转换成对应的栅格地图索引值；步骤5：判断蚂蚁是否移动到目标点e：a)若当前蚂蚁未到达目标点e，则重复步骤3～步骤5；b)若当前位置栅格为目标点e，若length
m
＜min kl，令min kl＝length
m
，并顺序执行后续步骤；步骤6：判断当前蚂蚁序号m是否为最大蚂蚁数量；若m＜m
max
，令m
←
m 1，将禁忌表taboo
m
清零，重复步骤3～步骤6；若m＝m
max
，则顺序执行步骤7；步骤7：调整信息素挥发系数ρ；根据当前迭代次数和当代最佳路径长度调节信息素挥发系数；式中，ρ表示路径上信息素的挥发度，κ是常数；步骤7-1：更新全局信息素；经过h时刻后，整个蚁群完成一次迭代，各条路径上的信息素按照式(3)进行更新：τ
ij
(t h)＝(1-ρ)
·
τ
ij
(t) δτ
ij
(t)
ꢀꢀꢀꢀ
(3)式中，δτ
ij
(t)表示m只蚂蚁在此次循环中残留在各条路径上的信息素量的总和，计算
式为每只蚂蚁留在路径上每个占用栅格的信息素量的计算式为：步骤7-2：如果当代最优路径min kl＜min l，令全局最优路径min l＝min kl；步骤8：判断当前迭代次数是否达到最大迭代次数；若nc＜nc
max
，令迭代次数nc加1，重复步骤3～步骤8；若迭代次数nc＝nc
max
，则算法达到最大允许迭代次数，输出全局最优路径min l，算法终止。2.根据权利要求1所述的一种基于扩展视野自适应蚁群算法的移动机器人路径规划方法，其特征在于，所述最大迭代次数nc
max
＝100，蚂蚁数量m
max
＝50，信息素启发因子α＝2，目标距离启发因子β＝3，转角控制启发因子γ＝1，障碍物安全距离启发因子δ＝2。

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


技术研发人员：孙树栋 张红荣 李思 杜鑫 梅博文 刘战
受保护的技术使用者：西北工业大学
技术研发日：2021.12.23
技术公布日：2022/4/29