无人机集群路径规划MATLAB：孔雀优化算法POA求解无人机集群三维路径规划
一、无人机模型简介
单个无人机三维路径规划问题及其建模_IT猿手的博客-CSDN博客
二、孔雀优化算法POA介绍
孔雀优化算法( Peafowl Optimization Algorithm, POA), 是由 Jingbo Wang 等于2022 年提出的一种群体智能优化算法。其灵感来源于孔雀的群体行为。
智能优化算法：孔雀优化算法
三、孔雀优化算法POA求解无人机集群路径规划
MATLAB无人机集群路径规划（一）：孔雀优化算法POA
MATLAB无人机集群路径规划（二）：孔雀优化算法( Peafowl Optimization Algorithm, POA)
MATLAB无人机集群路径规划（三）：孔雀优化算法( Peafowl Optimization Algorithm, POA)
MATLAB无人机集群路径规划（四）：孔雀优化算法( Peafowl Optimization Algorithm, POA)
MATLAB无人机集群路径规划（五）：孔雀优化算法( Peafowl Optimization Algorithm, POA)
MATLAB无人机集群路径规划（六）：孔雀优化算法( Peafowl Optimization Algorithm, POA)
MATLAB无人机集群路径规划（七）：孔雀优化算法( Peafowl Optimization Algorithm, POA)
MATLAB无人机集群路径规划（八）：孔雀优化算法( Peafowl Optimization Algorithm, POA)
（1）部分代码：可以修改无人机的个数，自动生成地图和采用同一种地图可以按照自己需求随意切换，可以修改无人机的起始点。以6个无人机为例：
close all clear clc %% 三维路径规划模型定义 global startPos goalPos N num num=6;%无人机的数量 N=1;%待优化点的个数(可以修改) goalPos = [80, 90, 170]; %终点(可以修改) startPos = [10, 10, 90]; %起点(可以修改) SearchAgents_no=50; % 种群大小(可以修改) Function_name='F2'; %F1:随机产生地图 F2：导入固定地图 Max_iteration=100; %最大迭代次数(可以修改) [lb,ub,dim,fobj]=Get_Functions_details(Function_name); [Best_score,Best_pos,curve]=POA(SearchAgents_no,Max_iteration,lb,ub,dim,fobj);
（2）部分结果：以6个无人机为例
第一个无人机飞行轨迹坐标：
10 10 90
11.8041765903043 10.8430847307858 95.7094504901538
13.6518972172617 11.8229934586336 101.208127423129
15.5431618808723 12.9397261835436 106.496030798926
17.4779705811360 14.1932829055156 111.573160617544
19.4563233180529 15.5836636245498 116.439516878984
21.4782200916229 17.1108683406461 121.095099583246
23.5436609018460 18.7748970538044 125.539908730329
25.6526457487223 20.5757497640249 129.773944320233
27.8051746322518 22.5134264713075 133.797206352959
30.0012475524343 24.5879271756521 137.609694828507
32.2408645092700 26.7992518770589 141.211409746876
34.5240255027589 29.1474005755278 144.602351108066
36.8507305329009 31.6323732710587 147.782518912079
39.2209795996960 34.2541699636518 150.751913158912
41.6347727031443 37.0127906533070 153.510533848567
44.0921098432457 39.9082353400243 156.058380981044
46.5929910200003 42.9405040238036 158.395454556342
49.1374162334080 46.1095967046451 160.521754574462
51.7253854834688 49.4155133825487 162.437281035403
54.3568987701828 52.8582540575144 164.142033939166
57.0319560935499 56.4378187295421 165.636013285751
59.7505574535702 60.1542073986320 166.919219075156
62.5127028502436 64.0074200647840 167.991651307384
65.3183922835702 67.9974567279981 168.853309982433
68.1676257535498 72.1243173882743 169.504195100303
71.0604032601827 76.3880020456125 169.944306660995
73.9967248034686 80.7885107000129 170.173644664508
76.9765903834078 85.3258433514754 170.192209110843
80 90 170
第二个无人机飞行轨迹坐标：
10 10 90
12.0164256252108 11.2964364814622 95.5218575772176
14.0612346417243 12.6973146920810 100.846341091038
16.1344270495404 14.2026346318564 105.973450541461
18.2360028486592 15.8123963007885 110.903185928487
20.3659620390807 17.5265996988772 115.635547252115
22.5243046208049 19.3452448261226 120.170534512346
24.7110305938318 21.2683316825246 124.508147709180
26.9261399581613 23.2958602680833 128.648386842616
29.1696327137935 25.4278305827986 132.591251912655
31.4415088607284 27.6642426266706 136.336742919297
33.7417683989660 30.0050963996992 139.884859862541
36.0704113285062 32.4503919018844 143.235602742389
38.4274376493491 35.0001291332263 146.388971558838
40.8128473614947 37.6543080937248 149.344966311891
43.2266404649430 40.4129287833800 152.103587001546
45.6688169596939 43.2759912021918 154.664833627804
48.1393768457476 46.2434953501603 157.028706190664
50.6383201231039 49.3154412272854 159.195204690128
53.1656467917629 52.4918288335671 161.164329126194
55.7213568517245 55.7726581690055 162.936079498862
58.3054503029889 59.1579292336006 164.510455808133
60.9179271455559 62.6476420273522 165.887458054007
63.5587873794256 66.2417965502606 167.067086236484
66.2280310045980 69.9403928023255 168.049340355563
68.9256580210730 73.7434307835471 168.834220411245
71.6516684288508 77.6509104939254 169.421726403530
74.4060622279311 81.6628319334603 169.811858332417
77.1888394183143 85.7791951021518 170.004616197907
80 90 170
第三个无人机飞行轨迹坐标：
10 10 90
14.0041851596044 12.7662036810019 92.7865356556672
17.8947708866262 15.5318657197647 95.5710773851906
21.6717571810654 18.2969861162885 98.3536251885704
25.3351440429220 21.0615648705732 101.134179065806
28.8849314721961 23.8256019826189 103.912739016899
32.3211194688876 26.5890974524256 106.689305041847
35.6437080329965 29.3520512799931 109.463877140652
38.8526971645228 32.1144634653217 112.236455313313
41.9480868634666 34.8763340084112 115.007039559831
44.9298771298277 37.6376629092616 117.775629880205
47.7980679636063 40.3984501678730 120.542226274435
50.5526593648023 43.1586957842453 123.306828742521
53.1936513334158 45.9183997583786 126.069437284463
55.7210438694466 48.6775620902728 128.830051900262
58.1348369728949 51.4361827799280 131.588672589918
60.4350306437606 54.1942618273441 134.345299353429
62.6216248820437 56.9517992325211 137.099932190797
64.6946196877443 59.7087949954592 139.852571102021
66.6540150608622 62.4652491161581 142.603216087101
68.4998110013976 65.2211615946181 145.351867146038
70.2320075093504 67.9765324308389 148.098524278831
71.8506045847206 70.7313616248207 150.843187485480
73.3556022275083 73.4856491765635 153.585856765985
74.7470004377133 76.2393950860672 156.326532120347
76.0247992153358 78.9925993533319 159.065213548565
77.1889985603757 81.7452619783575 161.801901050639
78.2395984728331 84.4973829611440 164.536594626570
79.1765989527078 87.2489623016916 167.269294276357
80 90 170
第四个无人机飞行轨迹坐标：
10 10 90
13.1574222653453 11.9968655692661 93.4465305953246
16.2617281619838 14.0481422185600 96.8439247688156
19.3129176899152 16.1538299478817 100.192182520473
22.3109908491398 18.3139287572312 103.491303850297
25.2559476396574 20.5284386466085 106.741288758288
28.1477880614681 22.7973596160135 109.942137244444
30.9865121145718 25.1206916654464 113.093849308768
33.7721197989686 27.4984347949070 116.196424951258
36.5046111146585 29.9305890043955 119.249864171914
39.1839860616414 32.4171542939117 122.254166970737
41.8102446399174 34.9581306634557 125.209333347726
44.3833868494865 37.5535181130275 128.115363302882
46.9034126903487 40.2033166426271 130.972256836204
49.3703221625039 42.9075262522545 133.780013947693
51.7841152659521 45.6661469419096 136.538634637348
54.1447920006935 48.4791787115926 139.248118905170
56.4523523667279 51.3466215613034 141.908466751158
58.7067963640554 54.2684754910419 144.519678175312
60.9081239926759 57.2447405008082 147.081753177633
63.0563352525895 60.2754165906024 149.594691758121
65.1514301437962 63.3605037604243 152.058493916775
67.1934086662959 66.5000020102740 154.473159653595
69.1822708200888 69.6939113401515 156.838688968582
71.1180166051746 72.9422317500567 159.155081861736
73.0006460215536 76.2449632399898 161.422338333056
74.8301590692256 79.6021058099507 163.640458382542
76.6065557481907 83.0136594599393 165.809442010195
78.3298360584488 86.4796241899558 167.929289216014
80 90 170
第五个无人机飞行轨迹坐标：
10 10 90
11.4430439150901 10.2866306322833 92.6722764498318
12.9554270579200 10.7498319829504 95.3507203453653
14.5371494284899 11.3896040520011 98.0353316866004
16.1882110267996 12.2059468394355 100.726110473537
17.9086118528492 13.1988603452537 103.423056706176
19.6983519066386 14.3683445694555 106.126170384516
21.5574311881679 15.7143995120411 108.835451508558
23.4858496974371 17.2370251730103 111.550900078301
25.4836074344461 18.9362215523633 114.272516093746
27.5507043991951 20.8119886500999 117.000299554893
29.6871405916839 22.8643264662203 119.734250461742
31.8929160119125 25.0932350007243 122.474368814292
34.1680306598811 27.4987142536121 125.220654612544
36.5124845355895 30.0807642248836 127.973107856497
38.9262776390377 32.8393849145388 130.731728546152
41.4094099702259 35.7745763225776 133.496516681509
43.9618815291539 38.8863384490002 136.267472262568
46.5836923158218 42.1746712938065 139.044595289328
49.2748423302295 45.6395748569965 141.827885761790
52.0353315723772 49.2810491385702 144.617343679953
54.8651600422647 53.0990941385276 147.412969043818
57.7643277398920 57.0937098568686 150.214761853385
60.7328346652593 61.2648962935935 153.022722108654
63.7706808183664 65.6126534487020 155.836849809624
66.8778661992134 70.1369813221942 158.657144956296
70.0543908078002 74.8378799140701 161.483607548669
73.3002546441269 79.7153492243297 164.316237586745
76.6154577081936 84.7693892529730 167.155035070521
80 90 170
第六个无人机飞行轨迹坐标：
10 10 90
14.1209814179771 12.1676180371927 92.5919125748743
18.1200208134878 14.3774505495614 95.1957328722330
21.9971181865322 16.6294975371059 97.8114608920761
25.7522735371103 18.9237589998263 100.439096634403
29.3854868652220 21.2602349377226 103.078640099215
32.8967581708674 23.6389253507947 105.730091286511
36.2860874540464 26.0598302390428 108.393450196292
39.5534747147591 28.5229496024667 111.068716828556
42.6989199530054 31.0282834410666 113.755891183306
45.7224231687854 33.5758317548423 116.454973260539
48.6239843620991 36.1655945437939 119.165963060257
51.4036035329464 38.7975718079214 121.888860582459
54.0612806813273 41.4717635472248 124.623665827145
56.5970158072420 44.1881697617041 127.370378794316
59.0108089106902 46.9467904513593 130.128999483971
61.3026599916722 49.7476256161904 132.899527896111
63.4725690501878 52.5906752561973 135.681964030735
65.5205360862370 55.4759393713801 138.476307887843
67.4465610998199 58.4034179617389 141.282559467435
69.2506440909365 61.3731110272735 144.100718769512
70.9327850595867 64.3850185679840 146.930785794074
72.4929840057705 67.4391405838704 149.772760541119
73.9312409294881 70.5354770749327 152.626643010649
75.2475558307392 73.6740280411708 155.492433202663
76.4419287095241 76.8547934825849 158.370131117162
77.5143595658426 80.0777733991748 161.259736754145
78.4648483996947 83.3429677909407 164.161250113612
79.2933952110805 86.6503766578824 167.074671195564
80 90 170