300字范文,内容丰富有趣,生活中的好帮手!
300字范文 > 【路径规划】基于matlab多元宇宙算法栅格地图机器人最短路径规划【含Matlab源码 2996期】

【路径规划】基于matlab多元宇宙算法栅格地图机器人最短路径规划【含Matlab源码 2996期】

时间:2022-10-02 07:26:49

相关推荐

【路径规划】基于matlab多元宇宙算法栅格地图机器人最短路径规划【含Matlab源码 2996期】

✅博主简介:热爱科研的Matlab仿真开发者,修心和技术同步精进,Matlab项目合作可私信。

🍎个人主页:海神之光

🏆代码获取方式:

海神之光Matlab王者学习之路—代码获取方式

⛳️座右铭:行百里者,半于九十。

更多Matlab仿真内容点击👇

Matlab图像处理(进阶版)

路径规划(Matlab)

神经网络预测与分类(Matlab)

优化求解(Matlab)

语音处理(Matlab)

信号处理(Matlab)

车间调度(Matlab)

⛄一、多元宇宙算法及栅格地图简介

1 多元宇宙算法

多元宇宙算法是一种启发式优化算法,用于解决复杂的优化问题。它的灵感来源于多元宇宙理论,即存在许多并行的宇宙,每个宇宙都有自己的参数取值和适应度值。

在多元宇宙算法中,个体被看作一个宇宙,在每个宇宙中,个体的参数取值决定了其适应度值。通过在不同的宇宙中搜索最优解,并不断进行交叉、变异等操作,多元宇宙算法能够在每个宇宙中寻找到局部最优解,并通过不同宇宙之间的信息交流来找到全局最优解。

多元宇宙算法具有以下特点:

并行搜索:在多个宇宙中同时搜索,提高搜索效率。

信息交流:通过不同宇宙之间的信息交流,使得每个宇宙可以借鉴其他宇宙的经验,加速优化过程。

多样性保持:由于多个宇宙之间的参数取值不同,能够保持种群的多样性,避免陷入局部最优解。

多元宇宙算法在解决复杂优化问题、参数优化、机器学习模型调参等方面具有应用潜力,并且在一些实际问题中取得了良好的效果。

2 栅格地图

2.1 栅格法应用背景

路径规划时首先要获取环境信息, 建立环境地图, 合理的环境表示有利于建立规划方法和选择合适的搜索算法,最终实现较少的时间开销而规划出较为满意的路径。一般使用栅格法在静态环境下建立环境地图。

2.2 栅格法实质

将AGV的工作环境进行单元分割, 将其用大小相等的方块表示出来,这样栅格大小的选取是影响规划算法性能的一个很重要的因素。栅格较小的话,由栅格地图所表示的环境信息将会非常清晰,但由于需要存储较多的信息,会增大存储开销,同时干扰信号也会随之增加,规划速度会相应降低,实时性得不到保证;反之,由于信息存储量少,抗干扰能力有所增强,规划速随之增快,但环境信息划分会变得较为模糊,不利于有效路径的规划。在描述环境信息时障碍物所在区域在栅格地图中呈现为黑色,地图矩阵中标为1,可自由通行区域在栅格地图中呈现为白色,地图矩阵中标为0。路径规划的目的就是在建立好的环境地图中找到一条最优的可通行路径,所以使用栅格法建立环境地图时,栅格大小的合理设定非常关键。

2.3 10乘10的静态环境地图

10乘10的静态环境地图代码

%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%建立环境地图%%%%%%%%%%%%%%%%%%%%%%%%%%%%function DrawMap(map)n = size(map);step = 1;a = 0 : step :n(1);b = 0 : step :n(2);figure(1)axis([0 n(2) 0 n(1)]); %设置地图横纵尺寸set(gca,'xtick',b,'ytick',a,'GridLineStyle','-',...'xGrid','on','yGrid','on');hold onr = 1;for(i=1:n(1)) %设置障碍物的左下角点的x,y坐标for(j=1:n(2))if(map(i,j)==1)p(r,1)=j-1;p(r,2)=i-1;fill([p(r,1) p(r,1) + step p(r,1) + step p(r,1)],...[p(r,2) p(r,2) p(r,2) + step p(r,2) + step ],'k');r=r+1;hold onendendend%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%栅格数字标识%%%%%%%%%%%%%%%%%%%%%%%%%%%%x_text = 1:1:n(1)*n(2); %产生所需数值.for i = 1:1:n(1)*n(2)[row,col] = ind2sub([n(2),n(1)],i);text(row-0.9,col-0.5,num2str(x_text(i)),'FontSize',8,'Color','0.7 0.7 0.7');endhold onaxis square

建立环境矩阵,1代表黑色栅格,0代表白色栅格,调用以上程序,即可得到上述环境地图。

map=[0 0 0 1 0 0 1 0 0 0;1 0 0 0 0 1 1 0 0 0;0 0 1 0 0 0 1 1 0 0;0 0 0 0 0 0 0 0 0 0;0 0 0 0 0 1 0 0 1 0;1 0 0 0 0 1 1 0 0 0;0 0 0 1 0 0 0 0 0 0;1 1 1 0 0 0 1 0 0 0;0 0 0 0 0 1 1 0 0 0;0 0 0 0 0 1 1 0 0 0;];DrawMap(map); %得到环境地图

2.4 栅格地图中障碍栅格处路径约束

移动体栅格环境中多采用八方向的移动方式,此移动方式在完全可通行区域不存在运行安全问题,当

移动体周围存在障碍栅格时此移动方式可能会发生与障碍物栅格的碰撞问题,为解决此问题加入约束

条件,当在分别与障碍物栅格水平方向和垂直方向的可行栅格两栅格之间通行时,禁止移动体采用对

角式移动方式。

约束条件的加入,实质是改变栅格地图的邻接矩阵,将障碍栅格(数字为“1”的矩阵元素)的对角栅格

设为不可达, 即将对角栅格的距离值改为无穷大。其实现MATLAB代码如下:

代码:

%约束移动体在障碍栅格对角运动%通过优化邻接矩阵实现%%%%%%%%%%%%%%%%%% 约束移动体移动方式 %%%%%%%%%%%%%%%%%function W=OPW(map,W)% map 地图矩阵 % W 邻接矩阵n = size(map);num = n(1)*n(2);for(j=1:n(1))for(z=1:n(2))if(map(j,z)==1)if(j==1) %若障碍物在第一行if(z==1)%若障碍物为第一行的第一个W(j+1,j+n(2)*j)=Inf;W(j+n(2)*j,j+1)=Inf;elseif(z==n(2)) %若障碍物为第一行的最后一个W(n(2)-1,n(2)+n(1)*j)=Inf;W(n(2)+n(1)*j,n(2)-1)=Inf;else%若障碍物为第一行的其他W(z-1,z+j*n(2))=Inf;W(z+j*n(2),z-1)=Inf;W(z+1,z+j*n(2))=Inf;W(z+j*n(2),z+1)=Inf;endendendif(j==n(1))%若障碍物在最后一行if(z==1)%若障碍物为最后一行的第一个W(z+n(2)*(j-2),z+n(2)*(j-1)+1)=Inf;W(z+n(2)*(j-1)+1,z+n(2)*(j-2))=Inf;elseif(z==n(2)) %若障碍物为最后一行的最后一个W(n(1)*n(2)-1,(n(1)-1)*n(2))=Inf;W((n(1)-1)*n(2),n(1)*n(2)-1)=Inf;else %若障碍物为最后一行的其他W((j-2)*n(2)+z,(j-1)*n(2)+z-1)=Inf;W((j-1)*n(2)+z-1,(j-2)*n(2)+z)=Inf;W((j-2)*n(2)+z,(j-1)*n(2)+z+1)=Inf;W((j-1)*n(2)+z+1,(j-2)*n(2)+z)=Inf;endendendif(z==1) if(j~=1&&j~=n(1)) %若障碍物在第一列非边缘位置 W(z+(j-2)*n(2),z+1+(j-1)*n(2))=Inf;W(z+1+(j-1)*n(2),z+(j-2)*n(2))=Inf;W(z+1+(j-1)*n(2),z+j*n(2))=Inf;W(z+j*n(2),z+1+(j-1)*n(2))=Inf;endendif(z==n(2))if(j~=1&&j~=n(1)) %若障碍物在最后一列非边缘位置 W((j+1)*n(2),j*n(2)-1)=Inf;W(j*n(2)-1,(j+1)*n(2))=Inf;W(j*n(2)-1,(j-1)*n(2))=Inf;W((j-1)*n(2),j*n(2)-1)=Inf;endendif(j~=1&&j~=n(1)&&z~=1&&z~=n(2)) %若障碍物在非边缘位置W(z+(j-1)*n(2)-1,z+j*n(2))=Inf;W(z+j*n(2),z+(j-1)*n(2)-1)=Inf;W(z+j*n(2),z+(j-1)*n(2)+1)=Inf;W(z+(j-1)*n(2)+1,z+j*n(2))=Inf;W(z+(j-1)*n(2)-1,z+(j-2)*n(2))=Inf;W(z+(j-2)*n(2),z+(j-1)*n(2)-1)=Inf;W(z+(j-2)*n(2),z+(j-1)*n(2)+1)=Inf;W(z+(j-1)*n(2)+1,z+(j-2)*n(2))=Inf;endendendendend

2.5 栅格法案例

下面以Djkstra算法为例, 其实现如下:

map=[0 0 0 1 0 0 1 0 0 0;1 0 0 0 0 1 1 0 0 0;0 0 1 0 0 0 1 1 0 0;0 0 0 0 0 0 0 0 0 0;0 0 0 0 0 1 0 0 1 0;1 0 0 0 0 1 1 0 0 0;0 0 0 1 0 0 0 0 0 0;1 1 1 0 0 0 1 0 0 0;0 0 0 0 0 1 1 0 0 0;0 0 0 0 0 1 1 0 0 0;];%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%建立环境矩阵map%%%%%%%%%%%%%%%%%%%%%%%%%%%%%DrawMap(map); %得到环境地图W=G2D(map); %得到环境地图的邻接矩阵W(W==0)=Inf; %邻接矩阵数值处理W=OPW(map,W); %优化邻接矩阵[distance,path]=dijkstra(W,1,100);%设置起始栅格,得到最短路径距离以及栅格路径[x,y]=Get_xy(distance,path,map); %得到栅格相应的x,y坐标Plot(distance,x,y); %画出路径

运行结果如下:

其中函数程序:

DrawMap(map) 详见建立栅格地图

W=G2D(map) ; 详见建立邻接矩阵

[distance, path] =dijkstra(W, 1, 100) 详见Djk stra算法

[x, y] =Get_xy(distance, path, map) ;

Plot(distance, x, y) ;

⛄二、部分源代码

clc

clear

close all

tic

%% 地图

G=[0 0 0 0 0 0 1 1 1 0 0 0 0 0 0 0 0 0 0 0;

0 0 0 0 0 0 1 1 1 0 0 0 0 0 0 0 0 0 0 0;

0 0 0 0 0 0 1 1 1 0 0 0 0 0 0 0 0 0 0 0;

0 0 0 0 0 0 1 1 1 0 0 0 0 0 0 0 0 0 0 0;

0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0;

0 1 1 1 0 0 1 1 1 0 0 0 0 0 0 0 0 0 0 0;

0 1 1 1 0 0 1 1 1 0 0 0 0 0 0 0 0 0 0 0;

0 1 1 1 0 0 1 1 1 0 1 1 1 1 0 0 0 0 0 0;

0 1 1 1 0 0 0 0 0 0 1 1 1 1 0 0 0 0 0 0;

0 0 0 0 0 0 0 0 0 0 1 1 1 1 0 0 0 0 0 0;

0 0 0 0 1 1 0 1 1 0 1 1 1 1 0 0 0 0 0 0;

0 0 0 0 1 0 0 1 1 0 1 1 1 1 0 0 0 0 0 0;

0 0 0 0 0 0 0 0 0 0 0 0 1 1 0 1 1 1 1 0;

0 0 0 0 0 0 0 0 0 0 0 0 1 1 0 1 1 1 1 0;

1 1 1 1 0 0 0 0 0 0 0 0 1 1 0 1 1 1 1 0;

1 1 1 1 0 0 1 1 0 0 0 1 0 0 0 0 0 0 0 0;

0 0 0 0 0 0 1 1 0 1 1 1 0 0 0 0 0 1 1 0;

0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 1 1 0;

0 0 1 1 0 0 0 0 0 0 1 1 0 0 1 0 0 0 0 0;

0 0 0 0 0 0 0 0 0 0 1 1 0 0 0 0 0 0 0 0;];

for i=1:20/2

for j=1:20

m=G(i,j);

n=G(21-i,j);

G(i,j)=n;

G(21-i,j)=m;

end

end

%%

S = [1 1];

E = [20 20];

G0 = G;

G = G0(S(1):E(1),S(2):E(2));

[Xmax,dimensions] = size(G);

dimensions = dimensions - 2;

X_min = 1;

%% 参数设置

max_gen = 200; % 最大迭代次数

num_polution = 50; % 种群数量

fboj=@(x)fitness(x,G,X_min,Xmax);

[fit_global_best,global_best,final_goal]=MVO(num_polution,max_gen, X_min,Xmax,dimensions,fboj);

toc

%% 结果分析

global_best1 = round(global_best);

fit_global_best

figure(1)

plot(final_goal,‘b-’);

xlabel(‘迭代次数’)

ylabel(‘适应度值’)

title(‘多元宇宙优化迭代曲线’)

route = [S(1) global_best1 E(1)];

path=generateContinuousRoute(route,G);

% path=shortenRoute(path);

path=GenerateSmoothPath(path,G);

path=GenerateSmoothPath(path,G);

figure(2)

for i=1:20/2

for j=1:20

m=G(i,j);

n=G(21-i,j);

G(i,j)=n;

G(21-i,j)=m;

end

end

n=20;

for i=1:20

for j=1:20

if G(i,j)==1

x1=j-1;y1=n-i;

x2=j;y2=n-i;

x3=j;y3=n-i+1;

x4=j-1;y4=n-i+1;

fill([x1,x2,x3,x4],[y1,y2,y3,y4],‘r’);

hold on

else

x1=j-1;y1=n-i;

x2=j;y2=n-i;

x3=j;y3=n-i+1;

x4=j-1;y4=n-i+1;

fill([x1,x2,x3,x4],[y1,y2,y3,y4],[1,1,1]);

hold on

end

end

end

hold on

xlabel(‘Environment 1’)

drawPath(path,G)

title(‘基于多元宇宙优化算法实现栅格地图机器人路径规划’)

⛄三、运行结果

⛄四、matlab版本及参考文献

1 matlab版本

a

2 参考文献

[1]吕颖婷, 梁文钦, 黄凯华. 多元宇宙算法在栅格地图机器人最短路径规划中的应用[J]. 计算机应用与软件, , 36(4): 64-68.

[2]郭兆君, 郝鑫, 彭祖彦. 基于多元宇宙算法的栅格地图机器人路径规划[J]. 电子技术与软件工程, , 17(11): 147-149.

[3]严圣, 邓正荣, 黄敏. 基于多元宇宙算法的地图机器人路径规划研究[J]. 计算机工程与设计, , 38(3): 776-781.

3 备注

简介此部分摘自互联网,仅供参考,若侵权,联系删除

🍅 仿真咨询

1 各类智能优化算法改进及应用

生产调度、经济调度、装配线调度、充电优化、车间调度、发车优化、水库调度、三维装箱、物流选址、货位优化、公交排班优化、充电桩布局优化、车间布局优化、集装箱船配载优化、水泵组合优化、解医疗资源分配优化、设施布局优化、可视域基站和无人机选址优化

2 机器学习和深度学习方面

卷积神经网络(CNN)、LSTM、支持向量机(SVM)、最小二乘支持向量机(LSSVM)、极限学习机(ELM)、核极限学习机(KELM)、BP、RBF、宽度学习、DBN、RF、RBF、DELM、XGBOOST、TCN实现风电预测、光伏预测、电池寿命预测、辐射源识别、交通流预测、负荷预测、股价预测、PM2.5浓度预测、电池健康状态预测、水体光学参数反演、NLOS信号识别、地铁停车精准预测、变压器故障诊断

3 图像处理方面

图像识别、图像分割、图像检测、图像隐藏、图像配准、图像拼接、图像融合、图像增强、图像压缩感知

4 路径规划方面

旅行商问题(TSP)、车辆路径问题(VRP、MVRP、CVRP、VRPTW等)、无人机三维路径规划、无人机协同、无人机编队、机器人路径规划、栅格地图路径规划、多式联运运输问题、车辆协同无人机路径规划、天线线性阵列分布优化、车间布局优化

5 无人机应用方面

无人机路径规划、无人机控制、无人机编队、无人机协同、无人机任务分配

6 无线传感器定位及布局方面

传感器部署优化、通信协议优化、路由优化、目标定位优化、Dv-Hop定位优化、Leach协议优化、WSN覆盖优化、组播优化、RSSI定位优化

7 信号处理方面

信号识别、信号加密、信号去噪、信号增强、雷达信号处理、信号水印嵌入提取、肌电信号、脑电信号、信号配时优化

8 电力系统方面

微电网优化、无功优化、配电网重构、储能配置

9 元胞自动机方面

交通流 人群疏散 病毒扩散 晶体生长

10 雷达方面

卡尔曼滤波跟踪、航迹关联、航迹融合

本内容不代表本网观点和政治立场,如有侵犯你的权益请联系我们处理。
网友评论
网友评论仅供其表达个人看法,并不表明网站立场。