1.一种基于改进A STAR-MMAS的机器人导航方法,其特征在于,该方法包括如下步骤:将机器人所处的环境表示成栅格地图,并确定障碍物与安全区的位置;
设置所述机器人初始位置信息以及多种参数信息;
利用A*算法生成一条从起点到终点的初始路径;
通过斜率法判断三点是否共线,从而提取出初始路径中所有拐点以及拐点前后的两个点,组成新的点集;
利用改进的MMAS算法对新点集进行二次路径规划,得到最终规划完成的路径,具体包括:计算获取的所述新点集P中各点之间的距离,组成距离矩阵D,计算所述新点集P中各个点到终点的距离,组成向量E,并计算当代最大信息素τmax和最小信息素τmin,最后初始化初始信息素矩阵以及设定MMAS算法中的固定参数;
将m只蚂蚁置于起点S,开始本次迭代;
通过矩阵D可得到蚂蚁当前位置i与下个待选位置j的距离为Dij,通过向量E可得到当前位置i与终点G之间的距离为Ei,并通过计算得到期望启发式信息;
进一步利用节点反向学习公式计算获得选择策略中的信息素值,并计算转移概率;
根据计算得到的所述转移概率,随机选择一下待选栅格j;
判断m只蚂蚁是否全部完成遍历,若是,则结束本次迭代,并继续下一步骤,根据预设的自适应更新策略更新信息素矩阵;否则继续本次迭代;
判断是否完成全部循环次数,若是,则输出最终路径;否则继续下次循环。
2.根据权利要求1所述的基于改进A STAR-MMAS的机器人导航方法,其特征在于,通过斜率法判断三点是否共线,从而提取出初始路径中所有拐点以及拐点前后的两个点,组成新的点集,具体包括:选取通过A*算法生成的初始路径中的任意三个节点用于通过斜率法判断三点是否共线,三点分别记为A(x1,y1)、B(x2,y2)和C(x3,y3);
利用斜率公式计算AB两点以及BC两点的斜率K;
若kAB=kBC,则A、B、C三点共线,去掉点B;若kAB!=kBC,则说明B点为拐点,将B点前一个路径点与后一个路径点加入新的点集P当中;
进一步遍历路径中所有节点,剔除位于同一直线上的点,获取由起点、终点、拐点以及其前路径点和后路径点的新点集P;
其中,斜率K计算公式如下:
3.根据权利要求2所述的基于改进A STAR-MMAS的机器人导航方法,其特征在于,当代最大信息素τmax和最小信息素τmin的计算公式如下:其中,ρ表示信息素蒸发的速率;Lgb为当前最优路径长度;avg=M/2,M为预设蚂蚁总数;pdec表示在选择点选择相应解分量的概率;pbest表示为当MMAS收敛时,找到最佳解的概率。
4.根据权利要求3所述的基于改进A STAR-MMAS的机器人导航方法,其特征在于,计算得到期望启发式信息的公式如下:
5.根据权利要求4所述的基于改进A STAR-MMAS的机器人导航方法,其特征在于,计算获得选择策略中的信息素值的公式如下:计算转移概率的公式如下:
其中,τ是当前循环的信息素矩阵;是蚂蚁k在节点i周围的可行节点的集合;λ0和λ分别表示预先设定的反向学习速率和随机数。
6.根据权利要求5所述的基于改进A STAR-MMAS的机器人导航方法,其特征在于,预设的自适应更新策略更新信息素的计算公式如下:τij(t+1)=(1-ρ)τij(t)+Δτij(t)其中,Δτij(t)表示在第t次迭代中点i到点j之间路径上的信息素沉积量,由和所组成,如下所示:其中,和分别表示迭代t时,在节点i和节点j之间路径上的精英蚂蚁和普通蚂蚁累积的信息素量;Q表示蚁群算法中的固定常量;mbest和N(Lib)表示本次迭代中精英蚂蚁的数量和最佳长度连续出现的次数;是一个均匀随机数,通过Metropolis准则进行计算:Lk和Lib代表了第k只蚂蚁路径的长度以及当前的最优长度。
7.一种基于改进A STAR-MMAS的机器人导航装置,其特征在于,基于权利要求1至6任意一项所述的方法,该装置具体包括:栅格地图模块,用于将机器人所处的环境表示成栅格地图,并确定障碍物与安全区的位置;
设置模块,用于设置所述机器人初始位置信息以及多种参数信息;
A*算法模块,用于利用A*算法生成一条从起点到终点的初始路径;
判断模块,用于通过斜率法判断三点是否共线,从而提取出初始路径中所有拐点以及拐点前后的两个点,组成新的点集;
MMAS算法模块,用于利用改进的MMAS算法对新点集进行二次路径规划,得到最终规划完成的路径,具体包括:计算获取的所述新点集P中各点之间的距离,组成距离矩阵D,计算所述新点集P中各个点到终点的距离,组成向量E,并计算当代最大信息素τmax和最小信息素τmin,最后初始化初始信息素矩阵以及设定MMAS算法中的固定参数;
将m只蚂蚁置于起点S,开始本次迭代;
通过矩阵D可得到蚂蚁当前位置i与下个待选位置j的距离为Dij,通过向量E可得到当前位置i与终点G之间的距离为Ei,并通过计算得到期望启发式信息;
进一步利用节点反向学习公式计算获得选择策略中的信息素值,并计算转移概率;
根据计算得到的所述转移概率,随机选择一下待选栅格j;
判断m只蚂蚁是否全部完成遍历,若是,则结束本次迭代,并继续下一步骤,根据预设的自适应更新策略更新信息素矩阵;否则继续本次迭代;
判断是否完成全部循环次数,若是,则输出最终路径;否则继续下次循环。
8.一种电子设备,包括:
一个或多个处理器;
存储装置,用于存储一个或多个程序;
当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现如权利要求1至6中任一所述的方法。
9.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1至6中任一所述的方法。