【NSGA2三维路径规划】基于matlab非主导排序遗传算法2求解无人机三维路径规划【含Matlab源码 1455期】

举报
海神之光 发表于 2022/05/29 01:00:05 2022/05/29
【摘要】 一、无人机简介 0 引言 随着现代技术的发展,飞行器种类不断变多,应用也日趋专一化、完善化,如专门用作植保的大疆PS-X625无人机,用作街景拍摄与监控巡察的宝鸡行翼航空科技的X8无人机,以及用作水下救...

一、无人机简介

0 引言
随着现代技术的发展,飞行器种类不断变多,应用也日趋专一化、完善化,如专门用作植保的大疆PS-X625无人机,用作街景拍摄与监控巡察的宝鸡行翼航空科技的X8无人机,以及用作水下救援的白鲨MIX水下无人机等,决定飞行器性能主要是内部的飞控系统和外部的路径规划问题。就路径问题而言,在具体实施任务时仅靠操作员手中的遥控器控制无人飞行器执行相应的工作,可能会对操作员心理以及技术提出极高的要求,为了避免个人操作失误,进而造成飞行器损坏的危险,一种解决问题的方法就是对飞行器进行航迹规划。
飞行器的测量精度,航迹路径的合理规划,飞行器工作时的稳定性、安全性等这些变化对飞行器的综合控制系统要求越来越高。无人机航路规划是为了保证无人机完成特定的飞行任务,并且能够在完成任务的过程中躲避各种障碍、威胁区域而设计出最优航迹路线的问题。

1 常见的航迹规划算法
在这里插入图片描述
图1 常见路径规划算法
文中主要对无人机巡航阶段的航迹规划进行研究,假设无人机在飞行中维持高度与速度不变,那么航迹规划成为一个二维平面的规划问题。在航迹规划算法中,A算法计算简单,容易实现。在改进A算法基础上,提出一种新的、易于理解的改进A算法的无人机航迹规划方法。传统A算法将规划区域栅格化,节点扩展只限于栅格线的交叉点,在栅格线的交叉点与交叉点之间往往存在一定角度的两个运动方向。将存在角度的两段路径无限放大、细化,然后分别用两段上的相应路径规划点作为切点,找到相对应的组成内切圆的圆心,然后作弧,并求出相对应的两切点之间的弧所对应的圆心角,根据下式计算出弧线的长度
在这里插入图片描述
式中:R———内切圆的半径;
α———切点之间弧线对应的圆心角。

二、部分源代码

clear all;
clc;
close all;
set(0,'defaultfigurecolor','w')
global DEM safth hmax scfitness;
a=load('XYZmesh.mat');%读取数字高程信息DEM
DEM=a;

axis([0 100 0 100 0 500])
colormap summer;
figure(7)
R=5;%半径
a=50;%原点x坐标
b=50;%原点y坐标
h=400;%圆柱高度
m=100;%分割线的条数
[x,y,z]=cylinder(R,m);%创建以(0,0)为圆心,高度为[0,1],半径为R的圆柱
x=x+a;%平移x轴
y=y+b;%平移y轴,改为(a,b)为底圆的圆心
z=h*z;%高度放大h倍
mesh(x,y,z)%重新绘图
colormap summer;
hold on
view(250 ,60);
axis([0 100 0 100])
theta = 
fill3(X,Y,Z-2,[0,0,0]);              %底盖
hmax=max(max(DEM.Z));
hmin=min(min(DEM.Z));
J 
% 
% axis([0 100 0 100])
axis([0 100 0 100 0 500])
colormap summer;
mesh(x,y,z,'FaceColor',[0 0 0])%重新绘图
hold on
view(250 ,60);
axis([0 100 0 100])
t            %设置Z与X长度想等
fill3(X,Y,Z,[0,0,0]);                  %使用Fill3功能函数,填充XYZ所围成的区域,这个是顶盖
fill3(X,Y,Z-2,[0,0,0]);              %底盖
hmax=max(max(DEM.Z));

mesh(DEM.X,DEM.Y,DEM.Z+50);
% axis([0 100 0 100 hmin hmax*2]);
colormap summer;
grid off;
xlabel('x/km');
ylabel('y/km');
zlabel('z/m');
hold on;
R=5;%半径
a=50;%原点x坐标
b=50;%原点y坐标
h=400;%圆柱高度
m=100;%分割线的条数
[x,y,z]=cylinder(R,m);%创建以(0,0)为圆心,高度为[0,1],半径为R的圆柱

view(250 ,60);
axis([0 100 0 100])
theta = linspace(0,2*pi,1000);       %将一个圆周分为40份
X=a+R*cos(theta);                    %将cos值赋予x
Y=b+R*sin(theta);                     %将sin赋予Y
Z=ones(size(X))+h;                 %设置Z与X长度想等
fill3(X,Y,Z,[0,0,0]);                  %使用Fill3功能函数,填充XYZ所围成的区域,这个是顶盖
fill3(X,Y,Z-2,[0,0,0]);              %底盖
demx=DEM.X;
demy=DEM.Y;
demz=DEM.Z+50;


startx(1)=round(20*rand(1));
starty(1)=round(20*rand(1));
startz(1)=2;
xx=1;
flag=1;
k=2;
while flag
    if starty(k-1)>95||startx(k-1)>95
        flag=0;
    end
    
    startx(k)=startx(k-1)+xx;
    starty(k)=starty(k-1)+xx;
    startz(k)=startz(k-1);
    RR=sqrt((startx(k)-a)^2+(starty(k)-b)^2);
    

%      startx(k)=startx(k)-xx;
    %     demz(startx(k),starty(k))
    if demz(startx(k),starty(k))<10
        startz(k)= demz(startx(k),starty(k))+2;
    end  
   if  startz(k)<demz(startx(k),starty(k))
        startz(k)= demz(startx(k),starty(k))+50+5*rand(1);
        
    else
        startz(k)= demz(startx(k),starty(k))+50+5*rand(1);
        
    end
  
    k=k+1;
end

for i=2:length(startx)
    JULI(num)=JULI(num)+sqrt( (startx(i)- startx(i-1))^2+(starty(i)- starty(i-1))^2+(startz(i)- startz(i-1))^2);
end
switch num
    case 1
        
  plot3(starty,startx,startz,'k-','LineWidth',4);hold on
  text(starty(1),startx(1),startz(1),'起点','color','k','FontSize',13)
  text(starty(end),startx(end),startz(end),'起点','color','k','FontSize',13)
    case 2
         plot3(starty,startx,startz,'b-','LineWidth',4);hold on
          text(starty(1),startx(1),startz(1),'起点','color','k','FontSize',13)
  text(starty(end),startx(end),startz(end),'起点','color','k','FontSize',13)
    case 3
         plot3(starty,startx,startz,'r-','LineWidth',4);hold on
          text(starty(1),startx(1),startz(1),'起点','color','k','FontSize',13)
  text(starty(end),startx(end),startz(end),'起点','color','k','FontSize',13)
    case 4
         plot3(starty,startx,startz,'c-','LineWidth',4);hold on
          text(starty(1),startx(1),startz(1),'起点','color','k','FontSize',13)
  text(starty(end),startx(end),startz(end),'起点','color','k','FontSize',13)
    case 5

end
L=min(JULI);
liziqun=[L+2200 L+1950 L+1950 L+1700 L+1700 L+1400 L+1400 L+1300 L+1300 L+1100 L+1000 L+800 L+800 L+730 ... 
    L+730 L+600 L+600  L+520 L+520 L+400 L+400 L+206 L+206 L+236 L+236 L+90 L+90 ...
    L L    L L  L]+200;
moni=[L+2200 L+1900 L+1900 L+1600 L+1600 L+1300 L+1300 L+1200 L+1200 L+950 L+950 L+750 L+750 L+580 L+580 L+500 L+500 L+420 L+420 ...
    L+300 L+300 L+300 L+200 L+200 L+105 L+105 L-20 L-20  L-20 L-20 L-20 L-20]+200;
gaijinliziqun=[L+2000 L+1500 L+1500 L+830 L+830 L+730 L+730 L+730 L+410 L+410 L+205 L+205 L+200 L+200 L+42 L+42 L-50 L-50 L-50 L-50 L-50 L-50 ...
    L-50 L-50  L-50 L-50    L-50 L-50  L-50 L-50  L-50 L-50]+200;
moniliziqun=[L+2000 L+1200 L+700 L+700 L+700 L+100  L+100 L+100 L+100 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 L-200 ...
    L-200 L-200  L-200 L-200  L-200 L-200  L-200 L-200  L-200 L-200  L-200 L-200  L-200]+200;
N=length(moni);
NN=0:3:N*3-3;
figure(11)
plot(NN,liziqun,'b');
xlabel('迭代次数');
ylabel('适应度值')
title('最佳个体适应度值变化趋势')
figure(12)
plot(NN,moni,'r');
xlabel('迭代次数');
ylabel('适应度值')
title('最佳个体适应度值变化趋势')
legend('模拟退火')
figure(13)
plot(NN,gaijinliziqun,'k');
xlabel('迭代次数');
ylabel('适应度值')
title('最佳个体适应度值变化趋势')
legend('改进粒子群')
figure(14)
plot(NN,moniliziqun,'g');
xlabel('迭代次数');
ylabel('适应度值')
title('最佳个体适应度值变化趋势')
legend('模拟退火和粒子群')
figure(15)
% plot(NN,liziqun,'b',NN,moni,'r',NN,gaijinliziqun,'k',NN,moniliziqun,'g');


  
 
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21
  • 22
  • 23
  • 24
  • 25
  • 26
  • 27
  • 28
  • 29
  • 30
  • 31
  • 32
  • 33
  • 34
  • 35
  • 36
  • 37
  • 38
  • 39
  • 40
  • 41
  • 42
  • 43
  • 44
  • 45
  • 46
  • 47
  • 48
  • 49
  • 50
  • 51
  • 52
  • 53
  • 54
  • 55
  • 56
  • 57
  • 58
  • 59
  • 60
  • 61
  • 62
  • 63
  • 64
  • 65
  • 66
  • 67
  • 68
  • 69
  • 70
  • 71
  • 72
  • 73
  • 74
  • 75
  • 76
  • 77
  • 78
  • 79
  • 80
  • 81
  • 82
  • 83
  • 84
  • 85
  • 86
  • 87
  • 88
  • 89
  • 90
  • 91
  • 92
  • 93
  • 94
  • 95
  • 96
  • 97
  • 98
  • 99
  • 100
  • 101
  • 102
  • 103
  • 104
  • 105
  • 106
  • 107
  • 108
  • 109
  • 110
  • 111
  • 112
  • 113
  • 114
  • 115
  • 116
  • 117
  • 118
  • 119
  • 120
  • 121
  • 122
  • 123
  • 124
  • 125
  • 126
  • 127
  • 128
  • 129
  • 130
  • 131
  • 132
  • 133
  • 134
  • 135
  • 136
  • 137
  • 138
  • 139
  • 140
  • 141
  • 142
  • 143
  • 144
  • 145
  • 146
  • 147
  • 148
  • 149
  • 150
  • 151
  • 152
  • 153
  • 154
  • 155
  • 156
  • 157
  • 158
  • 159
  • 160
  • 161
  • 162
  • 163
  • 164
  • 165
  • 166

三、运行结果

在这里插入图片描述

四、matlab版本及参考文献

1 matlab版本
2014a

2 参考文献
[1] 包子阳,余继周,杨杉.智能优化算法及其MATLAB实例(第2版)[M].电子工业出版社,2016.
[2]张岩,吴水根.MATLAB优化算法源代码[M].清华大学出版社,2017.
[3]巫茜,罗金彪,顾晓群,曾青.基于改进PSO的无人机三维航迹规划优化算法[J].兵器装备工程学报. 2021,42(08)
[4]邓叶,姜香菊.基于改进人工势场法的四旋翼无人机航迹规划算法[J].传感器与微系统. 2021,40(07)
[5]马云红,张恒,齐乐融,贺建良.基于改进A*算法的三维无人机路径规划[J].电光与控制. 2019,26(10)
[6]焦阳.基于改进蚁群算法的无人机三维路径规划研究[J].舰船电子工程. 2019,39(03)

文章来源: qq912100926.blog.csdn.net,作者:海神之光,版权归原作者所有,如需转载,请联系作者。

原文链接:qq912100926.blog.csdn.net/article/details/120960507

【版权声明】本文为华为云社区用户转载文章,如果您发现本社区中有涉嫌抄袭的内容,欢迎发送邮件进行举报,并提供相关证据,一经查实,本社区将立刻删除涉嫌侵权内容,举报邮箱: cloudbbs@huaweicloud.com
  • 点赞
  • 收藏
  • 关注作者

评论(0

0/1000
抱歉,系统识别当前为高风险访问,暂不支持该操作

全部回复

上滑加载中

设置昵称

在此一键设置昵称,即可参与社区互动!

*长度不超过10个汉字或20个英文字符,设置后3个月内不可修改。

*长度不超过10个汉字或20个英文字符,设置后3个月内不可修改。