基于栅格地图——遗传算法的机器人最优路径规划

   采用栅格对机器人的工作空间进行划分，再利用优化算法对机器人路径优化，是采用智能算法求最优路径的一个经典问题。

       利用遗传算法处理栅格地图的机器人路径规划的难点主要包括：1保证路径不间断，2保证路径不穿过障碍。用遗传算法解决优化问题时的步骤是固定的，就是种群初始化，选择，交叉，变异，适应度计算这样，那么下面我就说一下遗传算法求栅格地图中机器人路径规划在每个步骤的问题、难点以及解决办法。

1、种群初始化

首先要知道遗传算法种群初始化的定义。遗传算法种群初始化是生成一定种群数量的个体，每个个体是一个可行解。这里要注意是可行解，对于该问题也就是说是一个可行路径，也就是说应该是一个从路径起点到路径终点的，且不经过障碍的路径。怎样进行初始化种群得到可行路径是遗传算法求栅格路径的第一个难点也是最大难点。

1.方法

 路径初始化可以分为两步：第一步生成必经节点路径，什么是必经节点路径？举个例子，比如对于10*10的栅格，从左下角编号1到右上角编号100的路径必经过第2行的一个点，第3行一个点……第9行的一个点，这是很显然的，那么我们在第二行的自由栅格中随机取一个节点、第3行的自由栅格中取一个节点……第9行自由栅格取一个节点，那么这就行程了一个必经点路径，当然这个路径也是间断的。所以需要第二步，第二步就是连接这些间断节点，而这个问题是该算法中最难的问题，因为在连接路径中，太难绕开障碍了，而且如果你绕开了障碍物，会发现失去了方向连不回来了。因此，在连接节点中采用中点连接法，但是中点，要取得有技巧，可在中点处取4或3个栅格，然后在这些栅格中找到自由栅格，等概率选择，如果有最坏得情形，这些中点处栅格全都是障碍，则在这些栅格中等概率选择一个作为路径一点，因此该方法保证了路径的连续性，但也有可能存在经过障碍的路径，而这种障碍的路径可以在适应度函数中进行惩罚。上述初始化路径的两步结束后，进行简化路径操作，即如果路径中有两个相同的节点，则去掉相同节点之间的一段，这个很容易理解。

2.选择

 选择和遗传算法的选择是一样的，无需特殊改动，就是根据适应度进行选择。

扫描二维码关注公众号，回复： 10799740 查看本文章

3.交叉

交叉采用重复点交叉，这个也比较好理解，比如一条路径为[1 12 13 24 25 36 45 56 ]，另一条路径为[ 1 14 25 35 46 56]，这两条路径有一个公共节点25，进行交叉变成[1 12 13 24 25 35 46 56]和[1 14 25 36 45 56].

4.变异

 变异的方法使用随机生成选择两个节点，并去掉这两个节点之间的路径，之后采用上述的中带你插入方法生成连续路径。

5.应度计算

适应度计算路径长度和穿过障碍的个数，求和即可，这个比较间断不多说，下面展示一下我写的程序的效果。

clc;clear all;clear all;close all;t=23;       %过程点个数=t－1s=500;      %种群规模pc=0.90;    %交叉概率pm=0.20;    %变异概率pop=zeros(s,t);for i=1:s    pop(i,1:t-1)=randperm(t-1);endfor k=1:1:2000   %进化代次数k    if mod(k,10)==1        k    end    pop=qiujuli(pop);    c=15;%选择淘汰个数    pop=select(pop,c);    p=rand;    if p>=pc        pop=cross(pop);    end    if p>=pm        pop=mutate(pop);    end    endpop​min(pop(:,t))J=pop(:,t);fi=1./J;[Oderfi,Indexfi]=sort(fi);   %安排fi从小到大BestS=pop(Indexfi(s),:);    %使BestS=E(m),m即是属于max(fi)的IndexfiI=BestS;x=[2 3 6 10 14 17 22 20 23 25 30 28 25 21 29 16 18 15 9 11 6 5 ];y=[5 26 14 29 27 24 28 22 26 30 30 17 13 15 4 13 3 1 6 2 2 7];for i=1:1:t-1    x1(i)=x(I(i));    y1(i)=y(I(i));endx(t)=x(I(1));y(t)=y(I(1));a = [1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 0 1 1 1 1 1 1 1 0 1 1 1 1 1 1 0 1 1 1 1 0 1 1 1 1 1 1 1    1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 0 0 0 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1    1 1 1 1 1 1 0 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1    1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 0    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0    1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1    1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1    1 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 0 1 1    1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1 1    0 1 1 1 1 1 1 1 1 0 1 1 1 1 1 1 0 1 1 1 1 1 1 1 1 1 1 1 1 1];%31*31栅格b = a;b(end+1,end+1) = 0;colormap([0 0 0;1 1 1]),pcolor(b)axis image xy;%绘制栅格图hold on;figure(1);plot(x,y,'-or');​

​