【路径规划】基于matlab改进的蚁群算法机器人避障路径规划【含Matlab源码 905期】

本文主要是介绍【路径规划】基于matlab改进的蚁群算法机器人避障路径规划【含Matlab源码 905期】，对大家解决编程问题具有一定的参考价值，需要的程序猿们随着小编来一起学习吧！

一、简介

1 蚁群算法(ant colony algorithm,ACA)起源和发展历程
Marco Dorigo等人在研究新型算法的过程中，发现蚁群在寻找食物时，通过分泌一种称为信息素的生物激素交流觅食信息从而能快速的找到目标，于是在1991年在其博士论文中首次系统地提出一种基于蚂蚁种群的新型智能优化算法“蚂蚁系统（Ant system,简称AS）”，后来，提出者及许多研究者对该算法作了各种改进，将其应用于更为广泛的领域，如图着色问题、二次分配问题、工件排序问题、车辆路径问题、车间作业调度问题、网络路由问题、大规模集成电路设计等。近些年来，M.Dorigo等人把蚂蚁算法进一步发展成一种通用的优化技术“蚁群优化（Ant Colony Optimization,简称ACO）”，并将所有符合ACO框架的算法称为“蚁群优化算法（ACO algorithm）”。

具体来说，各个蚂蚁在没有事先告知食物在什么地方的前提下开始寻找食物。当一只找到食物以后，它会向环境释放一种挥发性分泌物pheromone (称为信息素,该物质随着时间的推移会逐渐挥发消失，信息素浓度的大小表征路径的远近)信息素能够让其他蚂蚁感知从而起到一个引导的作用。通常多个路径上均有信息素时，蚂蚁会优先选择信息素浓度高的路径，从而使浓度高的路径信息素浓度更高，形成一个正反馈。有些蚂蚁并没有像其它蚂蚁一样总重复同样的路，他们会另辟蹊径，如果另开辟的道路比原来的其他道路更短，那么，渐渐地，更多的蚂蚁被吸引到这条较短的路上来。最后，经过一段时间运行，可能会出现一条最短的路径被大多数蚂蚁重复着。最终，信息素浓度最高的路径即是最终被蚂蚁选中的最优路径。
与其他算法相比，蚁群算法是一种比较年轻的算法，具有分布式计算、无中心控制、个体之间异步间接通信等特点，并且易于与其他优化算法相结合，经过不少仁人志士的不断探索，到今天已经发展出了各式各样的改进蚁群算法，不过蚁群算法的原理仍是主干。

2 蚁群算法的求解原理
基于上述对蚁群觅食行为的描述，该算法主要对觅食行为进行以下几个方面模拟：
（1）模拟的图场景中包含了两种信息素，一种表示家，一种表示食物的地点，并且这两种信息素都在以一定的速率进行挥发。
（2）每个蚂蚁只能感知它周围的小部分地方的信息。蚂蚁在寻找食物的时候，如果在感知范围内，就可以直接过去，如果不在感知范围内，就要朝着信息素多的地方走，蚂蚁可以有一个小概率不往信息素多的地方走，而另辟蹊径，这个小概率事件很重要，代表了一种找路的创新，对于找到更优的解很重要。
（3）蚂蚁回窝的规则与找食物的规则相同。
（4）蚂蚁在移动时候首先会根据信息素的指引，如果没有信息素的指引，会按照自己的移动方向惯性走下去，但也有一定的机率改变方向，蚂蚁还可以记住已经走过的路，避免重复走一个地方。
（5）蚂蚁在找到食物时留下的信息素最多，然后距离食物越远的地方留下的信息素越少。找到窝的信息素留下的量的规则跟食物相同。蚁群算法有以下几个特点:正反馈算法、并发性算法、较强的鲁棒性、概率型全局搜索、不依赖严格的数学性质、搜索时间长，易出现停止现象。
蚂蚁转移概率公式：

公式中：是蚂蚁k从城市i转移到j的概率；α，β分别为信息素和启发式因子的相对重要程度；为边（i，j）上的信息素量；为启发式因子；为蚂蚁k下步允许选择的城市。上述公式即为蚂蚁系统中的信息素更新公式，是边（i,j)上的信息素量；ρ是信息素蒸发系数，0<ρ<1;为第k只蚂蚁在本次迭代中留在边（i,j）上的信息素量；Q为一正常系数；为第k只蚂蚁在本次周游中的路径长度。
在蚂蚁系统中，信息素更新公式为：

3 蚁群算法的求解步骤：
（1）初始化参数在计算之初，需要对相关参数进行初始化，如蚁群规模（蚂蚁数量）m、信息素重要程度因子α、启发函数重要程度因子β、信息素会发银子ρ、信息素释放总量Q、最大迭代次数iter_max、迭代次数初值iter=1。
（2）构建解空间将各个蚂蚁随机地置于不同的出发点，对每个蚂蚁k（k=1,2,3…m），按照（2-1）计算其下一个待访问城市，直到所有蚂蚁访问完所有城市。
（3）更新信息苏计算每个蚂蚁经过路径长度Lk(k=1,2,…，m），记录当前迭代次数中的最优解（最短路径）。同时，根据式（2-2）和（2-3）对各个城市连接路径上信息素浓度进行更新。
（4） 判断是否终止若iter<iter_max，则令iter=iter+1,清空蚂蚁经过路径的记录表，并返回步骤2；否则，终止计算，输出最优解。
（5）判断是否终止若iter<iter_max，则令iter=iter+1,清空蚂蚁经过路径的记录表，并返回步骤2；否则，终止计算，输出最优解。3. 判断是否终止若iter<iter_max，则令iter=iter+1,清空蚂蚁经过路径的记录表，并返回步骤2；否则，终止计算，输出最优解。

二、源代码

function [R_best,L_best,L_ave,Shortest_Route,Shortest_Length]=pathplan
%%=========================================================================
%% ACATSP.m
%% Ant Colony Algorithm for Traveling Salesman Problem
%%
%% 
%% All rights reserved
%%-------------------------------------------------------------------------
%% 主要符号说明
%% G 地图，n×n的矩阵
%% NC_max 最大迭代次数
%% m 蚂蚁个数
%% Alpha 表征信息素重要程度的参数
%% Beta 表征启发式因子重要程度的参数
%% Rho 信息素蒸发系数
%% Q 信息素增加强度系数
%% R_best 各代最佳路线
%% L_best 各代最佳路线的长度
%%=========================================================================
m=30;Alpha=1;Beta=6;Rho=0.1;NC_max=50;Q=14;
n=10;                %n表示问题的规模（n×n个节点）
G=[0 0 0 1 0 0 0 0 0 1;
   1 0 1 1 0 0 1 0 0 0;
   0 0 0 0 0 0 1 0 0 0;
   0 1 1 1 0 0 1 0 0 0;
   0 1 1 0 0 0 1 0 1 0;
   0 0 0 0 0 1 1 0 0 0;
   0 0 1 1 0 0 0 0 0 1;
   0 0 0 0 0 0 1 1 0 0;
   0 1 0 0 0 0 1 0 0 0;
   0 1 0 0 1 0 0 0 0 0];
obstacle =find(G');
%obstacle
start = 1;           %起点
dest = 100;          %终点 
%%第一步：变量初始化
D=caldistmat(n);     %D表示完全图的赋权邻接矩阵，图中任意两点的距离
Eta=1./D;            %Eta为启发因子，这里设为距离的倒数    
Tau=ones(n*n,n*n);   %Tau为信息素矩阵
Tabu=zeros(m,n*n);   %存储并记录路径的生成
NC=1;                %迭代计数器
for iter=1:NC_max
    R_best(iter).path=[];         %记录各代最佳路线
end
L_best=inf.*ones(NC_max,1);       %记录各代最佳路线的长度
L_ave=zeros(NC_max,1);            %记录各代路线的平均长度

while NC<=NC_max                              %停止条件之一：达到最大迭代次数
    %%第二步：将m只蚂蚁放到起点上
    Randpos=ones(1,m);
    Tabu(:,1)=(Randpos(1,1:m))';
    for i=1:m
        ant(i).visited = 1;
    end
    %%第三步：m只蚂蚁按概率函数选择下一个节点，完成各自的周游
    for i=1:m     
        step = 1;
        to_visit=1;
        while(1)
            visited = ant(i).visited;               %已走过的节点
            J = neibpot(visited(step),n);           %当前节点的所有相邻节点
            for j=1:length(obstacle)                %判断相邻节点中是否有障碍物节点，有则去除
                index = find(J==obstacle(j));
             
                end
            end
           
            if(find(J==dest))                       %判断相邻节点中是否有终点，有则停止
                ant(i).visited= [ant(i).visited dest];
                break;
            end

                
            P=zeros(1,length(J));                   %待访问节点的选择概率分布
            %下面计算待选节点的概率分布
            for k=1:length(J)
                P(k)=(Tau(to_visit,J(k))^Alpha)*(Eta(J(k),dest)^Beta);
            end
            P=P/(sum(P));
           
            Pcum=cumsum(P);
            Select=find(Pcum>=rand);
            to_visit=J(Select(1));

            ant(i).visited= [ant(i).visited to_visit];            
            step = step + 1;
        end
    end

    %%第四步：记录本次迭代最佳路线
    L=zeros(m,1);
    for i=1:m
        R=ant(i).visited;
        
        L(i)=L(i)+D(R(j+1),dest);
    end
    L_best(NC)=min(L);
    pos=find(L==L_best(NC));
    R_best(NC).path=ant(pos(1)).visited';
    L_ave(NC)=mean(L);
    
    %%第五步：更新信息素
    Delta_Tau=zeros(n*n,n*n);
    for i=1:m
        %ant(i).visited
        %L(i)
        for j=1:length(ant(i).visited)-1
            Delta_Tau(ant(i).visited(j),ant(i).visited(j+1))=Delta_Tau(ant(i).visited(j),ant(i).visited(j+1))+Q/L(i);
        end
        Delta_Tau(ant(i).visited(j+1),dest)=Delta_Tau(ant(i).visited(j+1),dest)+Q/L(i);
    end

%     如果5代最好的结果相等，则提前停止
%     if NC>=10
%         if isempty(find(L_best(NC-6:NC-1)-mean(L_best(NC-6:NC-1))>1e-10))
%             break;
%         end
%     end
% 
%     if isempty(find(L_best(1:NC-1)-mean(L_best(1:NC-1))))
%         if rand(1)<=0.4
%             Rho = 1.05*Rho;
%         else  Rho = 0.4 ;
%         end
%     end

三、运行结果

四、备注

版本：2014a
完整代码或代写加1564658423

这篇关于【路径规划】基于matlab改进的蚁群算法机器人避障路径规划【含Matlab源码 905期】的文章就介绍到这儿，希望我们推荐的文章对大家有所帮助，也希望大家多多支持为之网！