史紅玉, 劉淑芬
(1. 河南理工大學(xué) 計(jì)算機(jī)科學(xué)與技術(shù)學(xué)院, 河南 焦作 454150; 2. 吉林大學(xué) 計(jì)算機(jī)科學(xué)與技術(shù)學(xué)院, 長(zhǎng)春 130012)
無(wú)人機(jī)的航路規(guī)劃是指在最低油耗、最小威脅和最短距離等約束條件下, 對(duì)無(wú)人機(jī)在起點(diǎn)與終點(diǎn)間的路徑進(jìn)行的優(yōu)化設(shè)計(jì). 考慮到一般無(wú)人機(jī)的巡航高度, 其無(wú)法利用地形躲避威脅, 所以航路規(guī)劃可簡(jiǎn)化為一個(gè)二維模型問(wèn)題, 只考慮其水平航跡.
Voronoi圖作為一種基本的幾何結(jié)構(gòu), 目前已被廣泛應(yīng)用于無(wú)人機(jī)航路規(guī)劃中[1]. 根據(jù)威脅區(qū)域分布的情形生成由初始可選路徑集構(gòu)成的Voronoi圖, Voronoi邊是離散威脅源的中垂線, 能使無(wú)人機(jī)在飛行過(guò)程中有效降低威脅代價(jià). 目前, 基于Voronoi圖規(guī)劃航路的方法已有許多, 如趙文婷等[2]根據(jù)威脅源基于Voronoi圖建模, 計(jì)算航路代價(jià), 并針對(duì)算法中存在的優(yōu)缺點(diǎn), 提出了對(duì)算法的改進(jìn); 趙艷麗等[3]首先基于Voronoi圖建模, 然后獲得初始規(guī)劃解集, 最后通過(guò)引入Cauchy變異隨機(jī)數(shù)和擾動(dòng)對(duì)量子粒子群(QPSO)算法進(jìn)行改進(jìn), 確定了最終航路規(guī)劃的改進(jìn)算法; 劉平等[4]首先由Voronoi圖生成了初始航路, 然后在各種約束條件下賦予各邊相應(yīng)的權(quán)值, 最后應(yīng)用離散型粒子群算法搜索出滿意的規(guī)劃解; 劉森琪等[5]根據(jù)威脅源生成Voronoi圖, 計(jì)算航路代價(jià), 采用改進(jìn)的蟻群算法計(jì)算最優(yōu)航路; Asano等[6]通過(guò)給定一組線段, 在線段中點(diǎn)視角的大小確定屬于線段的Voronoi區(qū)域, 提出一種尋找最大視角的有效算法; Bhattacharya等[7]基于Voronoi圖算法, 在簡(jiǎn)單分離的情形下計(jì)算起點(diǎn)與目標(biāo)節(jié)點(diǎn)之間的距離. 這些算法雖然都能實(shí)現(xiàn)無(wú)人機(jī)的航路規(guī)劃, 但仍存在收斂速度慢、易陷入局部?jī)?yōu)化等問(wèn)題[8-9]. 無(wú)人機(jī)在戰(zhàn)場(chǎng)上對(duì)環(huán)境的預(yù)先設(shè)想不一定與實(shí)際環(huán)境一致, 因此為實(shí)現(xiàn)航路規(guī)劃的準(zhǔn)確快速, 需要初始路徑有一個(gè)更精確合理的優(yōu)化. 本文在得到初始路徑的基礎(chǔ)上, 針對(duì)傳統(tǒng)算法的不足, 提出一種新的快速優(yōu)化算法, 并通過(guò)仿真實(shí)驗(yàn)驗(yàn)證了該算法的可行性.
Voronoi圖是在其組成點(diǎn)集中連接兩個(gè)鄰點(diǎn)直線的垂直平分線構(gòu)成的一組連續(xù)多邊形, 它是計(jì)算幾何的重要組成部分, 廣泛應(yīng)用于與區(qū)域劃分相關(guān)的領(lǐng)域, 其中的最近點(diǎn)、n點(diǎn)的凸包和最小樹(shù)問(wèn)題均可由Voronoi圖解決[10].
定義1[11]在二維空間2上, 有n個(gè)離散的生成元p={p1,p2,…,pn}, 其中任意兩個(gè)生成元互不重疊,p對(duì)應(yīng)的Voronoi圖是平面的一個(gè)子區(qū)域劃分, 整個(gè)平面S被劃分為n個(gè)單元,Vs={Vp1,Vp2,…,Vpn}. 對(duì)于生成元pi的Voronoi區(qū)域, 有
Vpi={q∈2|d(pi,q) (1) 其中d(q,pi)和d(pj,q)分別為q到pi和pj的距離. 性質(zhì)1對(duì)于Voronoi多邊形中的點(diǎn)q, 若q在pi所在的多邊形中, 用d(q,pi)表示兩點(diǎn)間的直線距離, 則有d(pi,q) 性質(zhì)2Voronoi圖中任意n個(gè)基點(diǎn)(n>3)的平面, 平面頂點(diǎn)數(shù)不超過(guò)2n-5, 且邊的數(shù)目不超過(guò)3n-6. 性質(zhì)3Voronoi圖在增減生成元時(shí), 通過(guò)局域動(dòng)態(tài)特性只影響相鄰的空間區(qū)域, 不影響整個(gè)空間的劃分. 由Voronoi圖的定義和性質(zhì)可知, Voronoi圖各邊上的點(diǎn)到相對(duì)應(yīng)的兩個(gè)點(diǎn)距離相等, 即Voronoi邊上的點(diǎn)是到威脅點(diǎn)最遠(yuǎn)的點(diǎn), 無(wú)人機(jī)沿Voronoi邊飛行可獲得相對(duì)的安全保障. 基于Voronoi圖的航路規(guī)劃算法思想: 首先確定所有威脅源, 將該威脅源等價(jià)為點(diǎn), 作為Voronoi圖的點(diǎn)集, 將威脅源范圍的大小作為Voronoi圖相鄰區(qū)域的“距離”度量長(zhǎng)度, 然后生成Voronoi圖, 圖上各條邊在相應(yīng)的領(lǐng)域內(nèi)與威脅源“距離”越大, 則受到的威脅相應(yīng)越小. Voronoi圖中線段與線段相交的點(diǎn)構(gòu)成了無(wú)人機(jī)飛行時(shí)的航跡節(jié)點(diǎn), 且可以由威脅源的強(qiáng)度大小和Voronoi圖各邊的長(zhǎng)短計(jì)算出各邊相應(yīng)的權(quán)值. 其次, 利用最短路徑搜索算法[12]得到初始的最優(yōu)路徑, 該初始路徑根據(jù)威脅代價(jià)有效避開(kāi)了威脅值較大的區(qū)域, 同時(shí)也盡可能以較短的路徑抵達(dá)目標(biāo)點(diǎn). 最后利用本文提出的優(yōu)化初始航路算法, 求得最終的航路圖. 在無(wú)人機(jī)執(zhí)行任務(wù)時(shí), 經(jīng)常會(huì)在飛行環(huán)境中遇到一些包括地形威脅、雷達(dá)探測(cè)威脅等情形, 針對(duì)上述威脅信息, 本文基于威脅作用半徑, 以威脅場(chǎng)空間形狀的威脅信息量化處理方法建模. 根據(jù)地貌特征, 將絕對(duì)高度在500 m以上的地形概括為高山和陡坡. 地形威脅主要指地面上的山峰或一些較高的物體, 模擬公式為 (2) 其中: Temp(x,y)為地圖中該點(diǎn)的高度值;k為威脅區(qū)域的威脅程度;x,y為坐標(biāo)點(diǎn); VarX,VarY為方差, 方差數(shù)越小, 表示沿對(duì)應(yīng)軸方向的地形越陡峭. 將威脅元素山峰定高在H的二維平面時(shí), 威脅模型可表示為 {(x,y)}={(x,y)|(x-ox)2+(y-oy)2≤max{a,b}2}, (3) 其中:a,b分別為地形威脅模型橢圓橫切面的長(zhǎng)、短軸長(zhǎng); max{a,b}表示a,b中最大值; 點(diǎn)o為地平面橫切面的中心點(diǎn). 該區(qū)域定義為無(wú)人機(jī)禁飛區(qū), 無(wú)人機(jī)在該區(qū)域內(nèi)的損壞概率為1, 存活率為0. 在無(wú)人機(jī)航路研究中, 雷達(dá)探測(cè)威脅也是構(gòu)成威脅點(diǎn)的一個(gè)主要因素, 雷達(dá)方程可表示為 p=K/R4, (4) 其中:p是距雷達(dá)接收機(jī)R處收到的回波信號(hào)功率, 表示雷達(dá)的威脅強(qiáng)度;K表示對(duì)應(yīng)于具體雷達(dá)的常數(shù). 飛行器對(duì)目標(biāo)的距離R是影響p的重要因素,p與距離R的四次方成反比,R表示為 (5) 其中(x1,y1)與(x2,y2)分別為無(wú)人機(jī)的坐標(biāo)和雷達(dá)位置的坐標(biāo). 第i個(gè)雷達(dá)對(duì)無(wú)人機(jī)的威脅程度表示為 (6) 圖1 威脅分布的Voronoi圖Fig.1 Voronoi diagram of threat distribution 其中:j表示由n個(gè)航跡點(diǎn)組成的航路上的一點(diǎn);pj表示該點(diǎn)的回波強(qiáng)度. 假設(shè)無(wú)人機(jī)在飛行過(guò)程中遇到n個(gè)雷達(dá), 則無(wú)人機(jī)受到的雷達(dá)威脅Wz可表示為Wz=f(W1,W2,…,Wn). 無(wú)人機(jī)在高空平飛時(shí), 其航路規(guī)劃區(qū)域可認(rèn)為是一個(gè)二維平面. 在平面內(nèi)的威脅分布主要是雷達(dá)等設(shè)備或很高的山峰, 可以把這些雷達(dá)或山峰在地圖上等效為點(diǎn), 然后以這些點(diǎn)作為基點(diǎn)集, 構(gòu)造出由威脅點(diǎn)分布的Voronoi圖, 最后可在構(gòu)造好的Voronoi圖中進(jìn)行航路規(guī)劃. 圖1為根據(jù)威脅模型建立的Voronoi圖, 圖中的圓點(diǎn)表示威脅源. 無(wú)人機(jī)航路規(guī)劃是在滿足約束條件的基礎(chǔ)上規(guī)劃出一條由起點(diǎn)到目標(biāo)點(diǎn)的飛行軌跡. 它是一個(gè)約束條件較復(fù)雜的多目標(biāo)規(guī)劃問(wèn)題[13], 其約束條件一般包括無(wú)人機(jī)的安全性能和燃油性能[14], 因此, 本文考慮的航路代價(jià)包括與距離有關(guān)的威脅代價(jià)和燃油代價(jià). 圖2 威脅代價(jià)的計(jì)算Fig.2 Calculation of threat cost 雷達(dá)作為威脅源構(gòu)成了與其相接的Voronoi邊的威脅元素, 假設(shè)無(wú)人機(jī)具有的雷達(dá)反射截面均相同, 則可用Voronoi圖每條邊的積分表示該邊的雷達(dá)威脅代價(jià), 如圖2所示. 無(wú)人機(jī)反射雷達(dá)回波的強(qiáng)度與其到雷達(dá)距離的四次方成反比[15], 則Voronoi圖中邊的雷達(dá)威脅代價(jià)為 (7) 其中,r1,r2為加權(quán)系數(shù), 分別表示威脅和距離在弧的權(quán)值中所占的比. 將線上的積分轉(zhuǎn)化為線上5個(gè)點(diǎn)的積分, 本文采用十等分法, 用ftemp(Vi,pj)表示經(jīng)過(guò)十等分后威脅源對(duì)Voronoi邊的威脅權(quán)值, 則 (8) 假設(shè)無(wú)人機(jī)在飛行過(guò)程中速度恒定, 則其在飛行過(guò)程中所消耗的燃油與飛行航路的長(zhǎng)度成正比, 燃油代價(jià)為 ffurl=kli, (9) 其中k為比例系數(shù). 由于無(wú)人機(jī)航行過(guò)程中的代價(jià)主要包括威脅代價(jià)fweight(Vi)和燃油代價(jià)ffurl, 所以無(wú)人機(jī)的航路總代價(jià)可表示為 fzong=kfweight(Vi)+(1-k)ffurl, (10) 其中,k為安全性能與燃油性能的系數(shù), 若要求無(wú)人機(jī)安全性能最大, 則k=0; 若要求航路最短, 則k=1. 由Voronoi圖經(jīng)過(guò)最短路徑搜索算法計(jì)算后, 可得到一條初始的優(yōu)化路徑, 由于未考慮到無(wú)人機(jī)的運(yùn)動(dòng)約束, 所以該路徑必須進(jìn)一步優(yōu)化路徑中包含的一些不可飛的尖銳轉(zhuǎn)彎角. 一般情形下, 使用B樣條插值[16-17]、三次樣條插值法或K-path法解決航路中存在的尖角問(wèn)題. 下面以B樣條插值法為例進(jìn)行說(shuō)明. B樣條插值(簡(jiǎn)稱B-Spline插值)屬于逼近樣條類, 與控制多邊形的外形更接近, 而且還具有局部修改能力, 應(yīng)用廣泛. 定義2由(m+n+1)個(gè)平面或Pi(i=0,1,2,…,m+n)個(gè)空間頂點(diǎn)組成的曲線, 稱為n次參數(shù)曲線段: (11) 其中:Pk,n(t)表示第k段n次B樣條曲線段(k=0,1,2,…,m), 曲線段全體構(gòu)成n次B樣條曲線, 由點(diǎn)Pi(i=0,1,2,…,m+n)構(gòu)成的多邊形表示B樣條曲線的特征多邊形;Gi,n(t)表示基函數(shù), 可定義為 (12) 在無(wú)人機(jī)給定的航路離散點(diǎn)中, 選取(n+1)個(gè)控制點(diǎn)Pj(j=0,1,2,…,n), 則K階B樣條曲線方程為 (13) 其中, 參數(shù)u的范圍由B樣條其他參數(shù)的選取確定. B樣條插值函數(shù)一般用于消除路段間的轉(zhuǎn)折, 使整條航路趨于平滑, 滿足了無(wú)人機(jī)的可飛條件, 但僅解決了路徑的尖角問(wèn)題, 使初始航路的路線變得圓潤(rùn)平滑適合飛行. 無(wú)人機(jī)在飛行過(guò)程中對(duì)時(shí)間節(jié)點(diǎn)的要求較嚴(yán)格, 期望優(yōu)化后的航程基本不變, 在遇到緊急任務(wù)或燃料告急時(shí), 則希望航程最短, 因此, 在出現(xiàn)上述情形時(shí)就需要采取其他規(guī)劃方式實(shí)現(xiàn)規(guī)劃要求. 本文提出一種新的快速對(duì)初始航路優(yōu)化的算法, 不僅能解決航路不能飛的問(wèn)題, 同時(shí)也對(duì)威脅代價(jià)和燃油代價(jià)進(jìn)行進(jìn)一步的優(yōu)化. 本文提出的優(yōu)化初始航路改進(jìn)算法描述如下. 1) 初始化. 首先備份原始路徑中的節(jié)點(diǎn)坐標(biāo), 確定當(dāng)前的迭代次數(shù)和迭代次數(shù)最大值. 2) 根據(jù)初始的航路路線, 首先從起點(diǎn)開(kāi)始確定兩條線段, 即確定3個(gè)順序排列的節(jié)點(diǎn)坐標(biāo), 如圖3所示. 3) 圖3中point2,point1,point3分別對(duì)應(yīng)Voronoi圖中節(jié)點(diǎn)坐標(biāo)Pi-1,Pi,Pi+1, 利用夾角公式計(jì)算兩條線段構(gòu)成的夾角, 如果該夾角大于120°, 則符合航行要求不做處理; 如果該夾角小于120°, 則進(jìn)行以下處理: ① 如圖4所示, 分別在兩條線段上用linspace函數(shù)在對(duì)應(yīng)的線段上選5個(gè)點(diǎn), 以一邊為例. ② 由中間節(jié)點(diǎn)到兩邊線段最近的間隔點(diǎn)pointA和pointB再次用linspace函數(shù)將對(duì)應(yīng)的線段劃分成中間節(jié)點(diǎn)到該間隔點(diǎn)線段長(zhǎng)度10倍的小段, 即將每條線段都以長(zhǎng)度0.1分隔開(kāi). ③ 由interp2函數(shù)可分別求得由中間節(jié)點(diǎn)到兩端最近間隔點(diǎn)的權(quán)重值以及兩個(gè)間隔點(diǎn)間的權(quán)重值, 如圖5所示. LengthWeightA=interp2(x,y,Plane,SegXA,SegYA,‘linear’) 存放point1到pointA上由②中劃分后每個(gè)間隔點(diǎn)的油耗值和威脅值, 其中:x,y表示坐標(biāo)點(diǎn); Plane表示初始化帶有Voronoi圖上每點(diǎn)油耗值和威脅程度值的矩陣; SegXA和SegYA表示插值后的坐標(biāo)點(diǎn). point1到pointA線段的權(quán)重值為 WeightA=sum(LengthWeightA). 同理可求出另外兩條邊的權(quán)重值. 圖5 權(quán)重比較示意圖Fig.5 Schematic diagram of weight comparison ④ 將①中一條線段上的間隔點(diǎn)遍歷另一條線段上的所有間隔點(diǎn), 根據(jù)③可求出對(duì)應(yīng)的權(quán)重值. DifWeighti,j=WeightAi,j+WeightBi,j-WeightABi,j(i,j∈[2,5])表示三邊權(quán)重值的比較: 其中i,j分別表示兩條線段上第i個(gè)和第j個(gè)間隔點(diǎn). 由max(DifWeight((:)))獲取最優(yōu)的節(jié)點(diǎn), 即在該兩點(diǎn)時(shí)油耗和威脅值均最小. 假設(shè)圖5兩邊大于第三邊的權(quán)值是在所有間隔點(diǎn)中最大的, 則pointA,pointB即為本文新獲取的節(jié)點(diǎn), 原來(lái)的節(jié)點(diǎn)為point2,point1,point3, 現(xiàn)在新路徑節(jié)點(diǎn)為point2,pointA,pointB. 4) 根據(jù)對(duì)權(quán)重值的比較, 找到最優(yōu)線路的節(jié)點(diǎn)坐標(biāo), 獲取新的兩點(diǎn)坐標(biāo)若是初始節(jié)點(diǎn)中的坐標(biāo)則不做改變, 如果不是則替換相應(yīng)的初始節(jié)點(diǎn)坐標(biāo). 5) 更新完節(jié)點(diǎn)后, 回到初始化, 對(duì)新得到的路徑節(jié)點(diǎn)進(jìn)行再次判斷是否符合無(wú)人機(jī)的飛行條件, 然后再次進(jìn)行優(yōu)化、更新、迭代, 從而得到最終的符合飛行要求的新路徑節(jié)點(diǎn), 生成最后的路徑圖. 本文得出的最終路徑不僅解決了航路中存在的尖角不可飛問(wèn)題, 減少了路程時(shí)間, 而且航行中的油耗和威脅值也是最優(yōu)的. 為了驗(yàn)證本文提出的對(duì)初始路徑優(yōu)化算法的有效性, 對(duì)圖1所示的具有40個(gè)威脅源的區(qū)域進(jìn)行航路規(guī)劃. 實(shí)驗(yàn)環(huán)境為: Inter CPU 2.20 GHz, 4.00 GB內(nèi)存, 操作系統(tǒng)為Win7專業(yè)版, 仿真環(huán)境采用MATLAB R2014a實(shí)現(xiàn). 假設(shè)飛機(jī)在飛行中一直勻速行駛, 飛行高度固定. 圖1中的點(diǎn)表示航路中存在的雷達(dá)、山峰等構(gòu)成的威脅源, 規(guī)劃空間中共有40個(gè)威脅. 航路的起始點(diǎn)坐標(biāo)為(-30,-40), 目標(biāo)點(diǎn)坐標(biāo)為(18,30). 下面分3種情形討論. 情形1) 圖6和圖7分別為不考慮燃油代價(jià), 只考慮航行中威脅代價(jià)時(shí)生成的初始航路和優(yōu)化后的航路. 由圖6和圖7可見(jiàn), 無(wú)人機(jī)在規(guī)劃路線時(shí)基本避開(kāi)了威脅區(qū), 威脅代價(jià)最小, 選擇了一條路徑最遠(yuǎn)的航路, 此時(shí)燃油代價(jià)最大. 航路的數(shù)據(jù)信息列于表1. 由表1可見(jiàn), 當(dāng)不考慮燃油只考慮威脅代價(jià)的權(quán)值時(shí), 新規(guī)劃的航路比初始航路值在航程、時(shí)間等方面均有明顯改善, 證明了本文提出優(yōu)化算法的正確性. 圖6 情形1)的初始航路Fig.6 Initial route chart of case 1) 圖7 情形1)優(yōu)化后的航路Fig.7 Optimized route chart of case 1) 無(wú)人機(jī)航路點(diǎn)數(shù)/個(gè)航路航程/km生存概率航路時(shí)間/s迭代次數(shù)航路代價(jià)原航路18162.12117.882001 731.66新航路25131.41113.252001 405.56 情形2) 圖8和圖9分別為考慮50%權(quán)重燃油代價(jià)和50%權(quán)重威脅代價(jià)后生成的初始航路和優(yōu)化后航路. 由圖8和圖9可見(jiàn), 與圖6和圖7相比, 此時(shí)無(wú)人機(jī)規(guī)劃的航路移動(dòng)到了威脅點(diǎn)較集中的區(qū)域, 威脅代價(jià)增加, 燃油代價(jià)相對(duì)減少. 航路的數(shù)據(jù)信息列于表2. 由表2可見(jiàn), 當(dāng)將燃油和威脅代價(jià)各考慮50%權(quán)重時(shí), 新優(yōu)化的航路較初始航路, 多項(xiàng)數(shù)據(jù)都得以更新, 航路具有可行性, 航路所用算法能規(guī)劃出一條最優(yōu)路線. 圖8 情形2)的初始航路Fig.8 Initial route chart of case 2) 圖9 情形2)優(yōu)化后的航路Fig.9 Optimized route chart of case 2) 無(wú)人機(jī)航路點(diǎn)數(shù)/個(gè)航路航程/km生存概率航路時(shí)間/s迭代次數(shù)航路代價(jià)原航路17148.72115.732001 512.43新航路25125.75113.162001 277.32 情形3) 圖10和圖11分別為只考慮了燃油代價(jià), 未考慮威脅代價(jià)生成的初始航路和優(yōu)化后航路. 由圖10和圖11可見(jiàn), 航路將進(jìn)一步移動(dòng)到威脅更集中的區(qū)域, 此時(shí)的燃油代價(jià)最小, 但威脅代價(jià)最大. 航路的數(shù)據(jù)信息統(tǒng)計(jì)列于表3. 由表3可見(jiàn), 該算法能快速為無(wú)人機(jī)規(guī)劃出新的滿足各項(xiàng)約束的航路, 在威脅區(qū)域密度相對(duì)小的情形下, 航路避開(kāi)了威脅區(qū), 減少了不必要的代價(jià). 圖10 情形3)的初始航路Fig.10 Initial route chart of case 3) 圖11 情形3)優(yōu)化后的航路Fig.11 Optimized route chart of case 3) 無(wú)人機(jī)航路點(diǎn)數(shù)/個(gè)航路航程/km生存概率航路時(shí)間/s迭代次數(shù)航路代價(jià)原航路16117.44112.432001 279.63新航路893.67110.01200956.78 以上生成的3條最優(yōu)航路顯示了無(wú)人機(jī)航路由威脅點(diǎn)較少的區(qū)域移動(dòng)到威脅點(diǎn)較集中區(qū)域的過(guò)程, 新航路對(duì)比原航路不僅縮短了航行路程, 同時(shí)也減少了航路時(shí)間和航路代價(jià). 無(wú)人機(jī)航路規(guī)劃路線合理, 航路規(guī)劃結(jié)果顯示了權(quán)值變換對(duì)該結(jié)果的影響. 實(shí)驗(yàn)結(jié)果表明, 本文提出的無(wú)人機(jī)航路規(guī)劃算法計(jì)算原理簡(jiǎn)單、易于實(shí)現(xiàn), 生成的最優(yōu)航路既可以保證整個(gè)飛行任務(wù)的全局最優(yōu)特性, 也可以滿足飛行任務(wù)的需求. 綜上所述, 本文根據(jù)威脅源的分布, 基于Voronoi圖建模生成了初始的航路規(guī)劃圖, 并運(yùn)用新的優(yōu)化初始航路算法得到了最終航路. 仿真實(shí)驗(yàn)驗(yàn)證了由該算法在Voronoi圖中進(jìn)行航路規(guī)劃的可行性和有效性. 實(shí)驗(yàn)結(jié)果表明, 該航路圖保證了無(wú)人機(jī)能在航行時(shí)間和花費(fèi)代價(jià)更少的情形下成功回避航路中的各種威脅, 并順利到達(dá)目標(biāo)點(diǎn).1.2 Voronoi圖算法的主要思想
1.3 Voronoi圖建模
2 基于Voronoi圖的航路代價(jià)計(jì)算
2.1 威脅代價(jià)
2.2 燃油代價(jià)
2.3 總代價(jià)
3 對(duì)初始航路的優(yōu)化
3.1 B樣條插值
3.2 優(yōu)化初始航路改進(jìn)算法
4 仿真實(shí)驗(yàn)