簡(jiǎn)介面向?qū)椫茖?dǎo)、飛行器控制等相關(guān)領(lǐng)域?qū)W習(xí)者這套基于MATLAB實(shí)現(xiàn)的三維比例導(dǎo)引程序可完成三維空間內(nèi)導(dǎo)彈追蹤目標(biāo)的運(yùn)動(dòng)軌跡仿真用于驗(yàn)證比例導(dǎo)引算法的跟蹤效果與參數(shù)影響。資源包內(nèi)共1個(gè)m文件整體大小僅897B代碼結(jié)構(gòu)精簡(jiǎn)便于直接閱讀與二次修改。程序涵蓋彈目初始狀態(tài)設(shè)定、比例導(dǎo)引方程建模、軌跡迭代計(jì)算與更新等關(guān)鍵環(huán)節(jié)運(yùn)行后可觀察攻擊角、偏航、俯仰及滾轉(zhuǎn)角隨時(shí)間的變化規(guī)律幫助使用者深入理解三維制導(dǎo)律工程實(shí)現(xiàn)細(xì)節(jié)。目前已有2201人學(xué)習(xí)下載適合學(xué)生、科研人員及工程技術(shù)人員用于理論學(xué)習(xí)、算法驗(yàn)證及實(shí)際制導(dǎo)系統(tǒng)設(shè)計(jì)參考。 聊飛行器制導(dǎo)三維比例導(dǎo)引算是最經(jīng)典的一道前菜。我剛接觸制導(dǎo)仿真的時(shí)候老師丟給我一句話(huà)“去把三維比例導(dǎo)引用MATLAB寫(xiě)出來(lái)跑通?！蹦菚?huì)兒以為就是一個(gè)公式套循環(huán)的事真正動(dòng)手才發(fā)現(xiàn)里面的坐標(biāo)系、視線(xiàn)角速率提取、限幅處理每一個(gè)細(xì)節(jié)都能讓你折騰一晚上。這篇就把我整理過(guò)的完整思路和可直接復(fù)現(xiàn)的MATLAB程序分享出來(lái)適合剛?cè)腴T(mén)制導(dǎo)仿真、正在做末制導(dǎo)導(dǎo)引律驗(yàn)證、或者想快速搭一個(gè)目標(biāo)攔截仿真框架的朋友。三維比例導(dǎo)引的核心能力是把“彈目之間的視線(xiàn)旋轉(zhuǎn)”轉(zhuǎn)化為導(dǎo)彈的法向過(guò)載指令實(shí)現(xiàn)攔截或交會(huì)。它的工程價(jià)值在于不依賴(lài)目標(biāo)的先驗(yàn)機(jī)動(dòng)信息只靠導(dǎo)引頭測(cè)得的視線(xiàn)角速率就能穩(wěn)定收斂因此從經(jīng)典空空導(dǎo)彈到現(xiàn)在的巡飛彈攔截幾乎都繞不開(kāi)這個(gè)導(dǎo)引律。而MATLAB程序的價(jià)值則是用幾分鐘的仿真代替實(shí)物試驗(yàn)讓你在寫(xiě)六自由度模型之前先用三自由度質(zhì)點(diǎn)模型把制導(dǎo)律的收斂性、脫靶量這些底層指標(biāo)摸清楚。1. 項(xiàng)目拆解三維比例導(dǎo)引到底在仿真什么1.1 比例導(dǎo)引的物理直覺(jué)與經(jīng)典公式先拋開(kāi)公式聊聊直覺(jué)。你追著一只飛盤(pán)跑的時(shí)候眼睛盯住飛盤(pán)視線(xiàn)方向會(huì)跟著飛盤(pán)轉(zhuǎn)動(dòng)。你的身體會(huì)自動(dòng)產(chǎn)生一個(gè)橫向加速度讓視線(xiàn)方向盡快“穩(wěn)定”下來(lái)也就是讓視線(xiàn)旋轉(zhuǎn)角速度歸零。比例導(dǎo)引Proportional NavigationPN干的事就是把這種直覺(jué)量化成控制律導(dǎo)彈速度矢量的轉(zhuǎn)動(dòng)角速度與彈目視線(xiàn)Line of SightLOS的轉(zhuǎn)動(dòng)角速度成正比。數(shù)學(xué)形式寫(xiě)出來(lái)就是這樣a_m N · Vc · λ?這里 λ? 是視線(xiàn)角速率Vc 是接近速度Closing VelocityN 是有效導(dǎo)航比Effective Navigation Ratio。這個(gè)公式的含義很直白視線(xiàn)轉(zhuǎn)得越快導(dǎo)彈就給出越大的橫向加速度去“壓住”視線(xiàn)旋轉(zhuǎn)。工程實(shí)現(xiàn)上它永遠(yuǎn)生成垂直于視線(xiàn)的加速度指令所以天然不會(huì)讓導(dǎo)彈沖著目標(biāo)盲目直飛而是走一條平滑的攔截彈道。很多教材會(huì)強(qiáng)調(diào)PN導(dǎo)引律在目標(biāo)不做機(jī)動(dòng)、速度恒定的情況下能夠保證零脫靶量。這個(gè)結(jié)論是線(xiàn)性化分析得到的實(shí)際仿真中只要彈目幾何不是極端構(gòu)型結(jié)果都很接近理論值。這也是為什么幾乎所有制導(dǎo)課程的第一個(gè)仿真題目都選它——簡(jiǎn)單、穩(wěn)定、物理意義清晰又是后續(xù)各種復(fù)雜導(dǎo)引律的基準(zhǔn)。1.2 三維問(wèn)題與二維問(wèn)題的本質(zhì)區(qū)別二維比例導(dǎo)引的教科書(shū)推導(dǎo)通常只在一個(gè)固定平面內(nèi)討論把視線(xiàn)角當(dāng)成一個(gè)標(biāo)量。但實(shí)際空戰(zhàn)、末制導(dǎo)場(chǎng)景中彈目很少老老實(shí)實(shí)待在同一平面內(nèi)這時(shí)候就必須上三維模型。三維和二維的差別可以看下面這個(gè)表維度二維比例導(dǎo)引三維比例導(dǎo)引運(yùn)動(dòng)空間固定平面三維空間視線(xiàn)角單個(gè)視線(xiàn)角 λ視線(xiàn)傾角、視線(xiàn)偏角兩個(gè)角制導(dǎo)指令一個(gè)法向加速度偏航、俯仰兩個(gè)通道加速度數(shù)學(xué)模型平面極坐標(biāo)方程矢量叉積或兩通道分解編程難度較低中等關(guān)鍵在于坐標(biāo)系統(tǒng)一三維實(shí)現(xiàn)有兩條常見(jiàn)路線(xiàn)。第一條是把視線(xiàn)角速率分解到俯仰和偏航兩個(gè)通道分別用 N·Vc·q_ε 和 N·Vc·q_β 生成過(guò)載指令這種寫(xiě)法貼近導(dǎo)引頭“俯仰/偏航兩軸跟蹤”的物理結(jié)構(gòu)工程上常用。第二條是直接用矢量運(yùn)算在整個(gè)仿真過(guò)程中全程使用慣性坐標(biāo)系下的位置和速度矢量用叉積一次性求出視線(xiàn)角速率矢量這種寫(xiě)法對(duì)MATLAB這種矩陣語(yǔ)言尤其友好代碼量少也不容易把坐標(biāo)系搞混。我下面的程序用的就是第二種方式它其實(shí)是從第一種方式推導(dǎo)出來(lái)的矢量等價(jià)形式理解起來(lái)稍微抽象一點(diǎn)但寫(xiě)起來(lái)非常干凈。2. 原理推導(dǎo)與關(guān)鍵參數(shù)先別急著寫(xiě)代碼2.1 視線(xiàn)角速率的矢量表達(dá)是怎么來(lái)的先定義最基本的狀態(tài)量。在慣性坐標(biāo)系下記導(dǎo)彈位置矢量為 Rm目標(biāo)位置矢量為 Rt那么彈目相對(duì)位置矢量R Rt - Rm相對(duì)速度矢量Vrel Vt - Vm相對(duì)距離的大小記作 r |R|。把 R 寫(xiě)成 r 乘以單位視線(xiàn)矢量 e_R即 R r · e_R。兩邊對(duì)時(shí)間求導(dǎo)Vrel ? · e_R r · ?_R這個(gè)式子里的 ?_R 其實(shí)就是視線(xiàn)方向的轉(zhuǎn)動(dòng)速率?，F(xiàn)在用 R 叉乘 VrelR × Vrel (r · e_R) × (? · e_R r · ?_R) r2 · (e_R × ?_R)因?yàn)?e_R 和自身叉乘為零而 e_R × ?_R 恰好就是視線(xiàn)角速率矢量 ω 的定義。于是ω (R × Vrel) / r2這就是程序里那行omega cross(R, Vrel) / (r * r);的來(lái)源。用這個(gè)矢量有一個(gè)好處它天然包含了俯仰和偏航兩個(gè)通道的視線(xiàn)旋轉(zhuǎn)信息而且全程不需要做任何姿態(tài)坐標(biāo)變換只要在慣性坐標(biāo)系里做一次叉積就拿到了。接近速度 Vc 的定義也順手一并解釋一下。Vc -?即彈目相對(duì)距離的減小速率它等于相對(duì)速度矢量在視線(xiàn)方向上的投影再取負(fù)Vc -R · Vrel / r當(dāng) Vc 0 時(shí)說(shuō)明彈目正在接近這是制導(dǎo)能正常工作的前提。如果 Vc 0說(shuō)明目標(biāo)正在遠(yuǎn)離此時(shí)導(dǎo)引指令已經(jīng)沒(méi)有意義了程序里需要做保護(hù)。2.2 導(dǎo)引系數(shù)N的取值與加速度限幅有效導(dǎo)航比 N 是比例導(dǎo)引唯一真正的“設(shè)計(jì)參數(shù)”。經(jīng)典線(xiàn)性化分析給出的結(jié)論是N 必須大于 2 才能保證系統(tǒng)穩(wěn)定N 越大響應(yīng)越快末端視線(xiàn)角速率收斂得越堅(jiān)決但 N 過(guò)大會(huì)放大導(dǎo)引頭測(cè)量噪聲導(dǎo)致指令抖動(dòng)。工程上常用 3 到 5標(biāo)準(zhǔn)值就是 3這也是很多程序里默認(rèn)N 3的原因。N 取值表現(xiàn)適用場(chǎng)景N 2系統(tǒng)不穩(wěn)定脫靶量發(fā)散不可用2 ~ 3響應(yīng)偏軟軌跡彎曲幅度大低噪聲環(huán)境可嘗試3 ~ 5響應(yīng)適中抗噪較好工程默認(rèn)區(qū)間N 5收斂快但對(duì)噪聲敏感需配合濾波使用另一個(gè)繞不開(kāi)的參數(shù)是加速度限幅。真實(shí)飛行器的法向過(guò)載是受限的導(dǎo)彈一般 30g 到 40g巡飛彈可能更低你不能讓仿真模型輸出一個(gè) 1000g 的指令然后飛著玩。所以在每個(gè)仿真步長(zhǎng)內(nèi)都要對(duì)計(jì)算出的 a_cmd 做飽和處理a_cmd a_cmd / |a_cmd| · min(|a_cmd|, a_max)這樣處理之后程序的行為才接近真實(shí)物理系統(tǒng)也基本不會(huì)出現(xiàn)因?yàn)橹噶钸^(guò)大導(dǎo)致積分瞬間發(fā)散的情況。3. MATLAB實(shí)現(xiàn)一個(gè)可以直接跑起來(lái)的三維比例導(dǎo)引仿真3.1 仿真初始條件設(shè)置與目標(biāo)運(yùn)動(dòng)模型程序的第一步是把初始條件擺清楚。我建議所有計(jì)算都在慣性坐標(biāo)系也就是模擬發(fā)射坐標(biāo)系下進(jìn)行不引入彈體坐標(biāo)系和視線(xiàn)坐標(biāo)系之間的旋轉(zhuǎn)矩陣這樣能省掉一大半調(diào)試時(shí)間。導(dǎo)彈初始位置放在原點(diǎn)速度指向 x 軸正方向目標(biāo)放在斜前方帶一個(gè)橫向速度分量模擬一個(gè)側(cè)向飛行的目標(biāo)。% 三維比例導(dǎo)引仿真主程序 % 所有位置、速度矢量均在慣性坐標(biāo)系下描述 %% 參數(shù)初始化 N 3; % 有效導(dǎo)航比經(jīng)典取值 dt 0.01; % 仿真步長(zhǎng)秒 t_max 40; % 最大仿真時(shí)間秒 r_miss 5; % 脫靶判定距離米 a_max 30 * 9.8; % 導(dǎo)彈最大法向加速度30g % 導(dǎo)彈初始狀態(tài) Rm0 [0; 0; 0]; % 初始位置 Vm0 [300; 0; 0]; % 初始速度m/s % 目標(biāo)初始狀態(tài) Rt0 [12000; 4000; 3000]; Vt0 [100; 60; 20]; %% 仿真狀態(tài)初始化 Rm Rm0; Vm Vm0; Rt Rt0; Vt Vt0; t 0; % 記錄歷史數(shù)據(jù) Rm_hist Rm; Rt_hist Rt; dist_hist norm(Rt - Rm); omega_hist zeros(3, 1); acc_hist zeros(3, 1);目標(biāo)運(yùn)動(dòng)模型這里先給一個(gè)最簡(jiǎn)單的情況勻速直線(xiàn)運(yùn)動(dòng)也就是Vt保持不變。后面如果你想驗(yàn)證比例導(dǎo)引對(duì)機(jī)動(dòng)目標(biāo)的適應(yīng)性再把目標(biāo)加速度項(xiàng)加進(jìn)去比如常值機(jī)動(dòng)或者正弦機(jī)動(dòng)。一般來(lái)說(shuō)勻速直線(xiàn)目標(biāo)是制導(dǎo)律最基本的驗(yàn)證場(chǎng)景跑通之后再做機(jī)動(dòng)目標(biāo)才談得上對(duì)比評(píng)估。3.2 制導(dǎo)主循環(huán)比例導(dǎo)引指令生成與積分更新主循環(huán)是整個(gè)程序的發(fā)動(dòng)機(jī)。每一幀要做的事情可以拆成四步計(jì)算彈目相對(duì)幾何、生成比例導(dǎo)引加速度指令、對(duì)指令限幅、然后用歐拉積分更新導(dǎo)彈和目標(biāo)的狀態(tài)。%% 主仿真循環(huán) while t t_max % 1. 計(jì)算相對(duì)運(yùn)動(dòng)關(guān)系 R Rt - Rm; % 相對(duì)位置矢量 Vrel Vt - Vm; % 相對(duì)速度矢量 r norm(R); % 當(dāng)前相對(duì)距離 % 距離小于脫靶判定值認(rèn)為命中結(jié)束仿真 if r r_miss break; end % 2. 計(jì)算接近速度和視線(xiàn)角速率矢量 Vc -R * Vrel / r; omega cross(R, Vrel) / (r * r); % 3. 比例導(dǎo)引加速度指令垂直視線(xiàn)方向 eR R / r; a_cmd N * Vc * cross(omega, eR); % 彈目正在分離時(shí)不輸出制導(dǎo)指令 if Vc 0 a_cmd zeros(3, 1); end % 4. 加速度限幅模擬真實(shí)過(guò)載約束 a_norm norm(a_cmd); if a_norm a_max a_cmd a_cmd / a_norm * a_max; end % 5. 歐拉積分更新導(dǎo)彈狀態(tài) Vm Vm a_cmd * dt; Rm Rm Vm * dt; % 6. 更新目標(biāo)狀態(tài)目前勻速直線(xiàn)運(yùn)動(dòng) Rt Rt Vt * dt; % 記錄數(shù)據(jù) t t dt; Rm_hist(:, end1) Rm; Rt_hist(:, end1) Rt; dist_hist(end1) r; omega_hist(:, end1) omega; acc_hist(:, end1) a_cmd; end大多數(shù)第一次寫(xiě)這個(gè)循環(huán)的人最容易犯的錯(cuò)誤是在第 3 步直接照抄教材二維公式以為加速度方向要指向目標(biāo)當(dāng)前位置。其實(shí)比例導(dǎo)引的加速度方向是垂直于視線(xiàn)方向的指向的目標(biāo)是“消除視線(xiàn)旋轉(zhuǎn)”不是“追當(dāng)前點(diǎn)”。上面cross(omega, eR)這個(gè)叉積算出來(lái)的新方向恰好落在視線(xiàn)垂直面內(nèi)而且方向能讓視線(xiàn)角速率朝著收斂方向走這個(gè)寫(xiě)法和二維公式在數(shù)學(xué)上完全等價(jià)但在三維空間里省事太多。3.3 可視化與脫靶量統(tǒng)計(jì)仿真跑完軌道畫(huà)出來(lái)程序才算真正有價(jià)值。三維軌跡圖用plot3一次就能搞定關(guān)鍵是把起點(diǎn)、終點(diǎn)和目標(biāo)軌跡區(qū)分清楚另外建議加axis equal否則三個(gè)軸比例不同軌跡形狀會(huì)被拉變形影響判斷。%% 三維軌跡繪制 figure(Color, w); plot3(Rm_hist(1,:), Rm_hist(2,:), Rm_hist(3,:), b-, LineWidth, 1.5); hold on; plot3(Rt_hist(1,:), Rt_hist(2,:), Rt_hist(3,:), r--, LineWidth, 1.5); plot3(Rm_hist(1,1), Rm_hist(2,1), Rm_hist(3,1), bo, MarkerSize, 10); plot3(Rt_hist(1,1), Rt_hist(2,1), Rt_hist(3,1), r^, MarkerSize, 10); plot3(Rm_hist(1,end), Rm_hist(2,end), Rm_hist(3,end), b*, MarkerSize, 12); plot3(Rt_hist(1,end), Rt_hist(2,end), Rt_hist(3,end), r*, MarkerSize, 12); xlabel(x (m)); ylabel(y (m)); zlabel(z (m)); title(三維比例導(dǎo)引攔截軌跡); legend(導(dǎo)彈軌跡, 目標(biāo)軌跡, 導(dǎo)彈起點(diǎn), 目標(biāo)起點(diǎn), 導(dǎo)彈終點(diǎn), 目標(biāo)終點(diǎn)); grid on; axis equal; view(3);脫靶量統(tǒng)計(jì)是所有后處理里最見(jiàn)功夫的一步。很多新手直接取dist_hist的最后一個(gè)值當(dāng)脫靶量但這其實(shí)是錯(cuò)的因?yàn)檎鎸?shí)脫靶量是彈道和目標(biāo)的最近交會(huì)距離通常發(fā)生在仿真終止點(diǎn)附近也可能略早于終止點(diǎn)。穩(wěn)妥的做法是在主循環(huán)里把每一幀的r都記錄下來(lái)然后取全部歷史里的最小值%% 脫靶量統(tǒng)計(jì) miss_dist min(dist_hist); fprintf(脫靶量%.2f m\n, miss_dist); % 相對(duì)距離隨時(shí)間變化曲線(xiàn) t_axis (0:length(dist_hist)-1) * dt; figure(Color, w); plot(t_axis, dist_hist, k-, LineWidth, 1.5); xlabel(時(shí)間 (s)); ylabel(相對(duì)距離 (m)); title(彈目相對(duì)距離隨時(shí)間變化); grid on;這樣統(tǒng)計(jì)出來(lái)的脫靶量才是可靠的。如果你的仿真步長(zhǎng)取的是 0.01 秒那么dist_hist的最小值和真實(shí)最優(yōu)脫靶量之間的誤差大概在米級(jí)以?xún)?nèi)對(duì)于導(dǎo)引律驗(yàn)證已經(jīng)夠用如果要做更高精度的統(tǒng)計(jì)分析可以再用拋物線(xiàn)擬合最小值附近幾個(gè)點(diǎn)得到亞步長(zhǎng)精度的脫靶量。4. 新手最容易踩的坑與排查技巧4.1 仿真為什么發(fā)散步長(zhǎng)、N值、限幅很多第一次跑通這個(gè)程序的朋友都遇到過(guò)“導(dǎo)彈軌跡像龍卷風(fēng)一樣越轉(zhuǎn)越大”的現(xiàn)象。這個(gè)問(wèn)題的根源一般不在比例導(dǎo)引本身而在仿真設(shè)置。最常見(jiàn)的三個(gè)原因步長(zhǎng)dt取得太大、有效導(dǎo)航比N取得太高、或者沒(méi)有對(duì)加速度指令限幅。歐拉積分是一階方法它要求每個(gè)仿真步長(zhǎng)內(nèi)狀態(tài)變化不要太劇烈。對(duì)攔截問(wèn)題來(lái)說(shuō)如果相對(duì)速度是 300 m/s 量級(jí)建議dt不超過(guò) 0.01 秒否則視線(xiàn)角速率變化速率超過(guò)積分器跟蹤能力就會(huì)出現(xiàn)數(shù)值失穩(wěn)。N 超過(guò) 5 之后指令增益放大對(duì)數(shù)值誤差也同步放大也會(huì)加劇發(fā)散。限幅就更好理解了不限幅時(shí)末段如果視線(xiàn)角速率劇烈增長(zhǎng)輸出一個(gè)極其離譜的加速度歐拉積分直接飛出合理范圍。4.2 末段視線(xiàn)角速率跳變?cè)趺刺幚肀壤龑?dǎo)引的矢量公式里ω (R × Vrel) / r2分母是 r 的平方。這意味著隨著彈目接近r 越來(lái)越小同樣的相對(duì)速度叉積算出的視線(xiàn)角速率會(huì)被放大。如果 r 已經(jīng)小于脫靶判定距離還不終止仿真下一個(gè)仿真步長(zhǎng)里 ω 可能直接跳到天文數(shù)字然后整條軌跡被帶飛。處理辦法有兩個(gè)層面。第一層是終止條件當(dāng) r r_miss 時(shí)立刻break不進(jìn)入下一步計(jì)算。第二層是數(shù)值保護(hù)即使 r 還沒(méi)到脫靶判定值但如果接近速度 Vc 降得很低也要小心 ω 的數(shù)值異?？梢栽谟?jì)算 ω 之前加一個(gè)判斷r 太小直接退出。這個(gè)坑幾乎是所有比例導(dǎo)引仿真的必考題代碼里必須先寫(xiě)清楚。4.3 坐標(biāo)系混亂導(dǎo)致的軌跡偏移三維制導(dǎo)仿真最隱蔽的問(wèn)題出在坐標(biāo)系約定上。很多人從二維直接搬到三維會(huì)在中途嘗試把矢量從慣性系轉(zhuǎn)到視線(xiàn)系再轉(zhuǎn)回來(lái)結(jié)果一個(gè)旋轉(zhuǎn)矩陣寫(xiě)錯(cuò)符號(hào)軌跡看著很平滑實(shí)際全偏了。我的建議是仿真主循環(huán)里只用慣性坐標(biāo)系方向余弦矩陣和姿態(tài)角一律不進(jìn)循環(huán)。視線(xiàn)角速率這類(lèi)量用叉積在慣性系里直接算不要顯式去求姿態(tài)角。需要出圖的時(shí)候再單獨(dú)算角度。這樣整個(gè)程序只有一套坐標(biāo)基準(zhǔn)排查問(wèn)題會(huì)非?？臁，F(xiàn)象可能原因排查方向軌跡指數(shù)級(jí)發(fā)散dt 太大 / N 過(guò)高縮小 dtN 改為 3末段突然飛走未設(shè)置 r_miss 終止條件判斷 r r_miss 后 break軌跡整體偏移但形態(tài)正常坐標(biāo)系混雜使用全部統(tǒng)一到慣性系指令振蕩無(wú)限幅 / N 過(guò)高加 a_max 限幅N 降到 4 以?xún)?nèi)脫靶量統(tǒng)計(jì)偏大取了終點(diǎn)距離而非最小值用 dist_hist 最小值5. 從能用走向好用幾個(gè)值得一提的改進(jìn)方向5.1 增廣比例導(dǎo)引APN對(duì)抗機(jī)動(dòng)目標(biāo)純比例導(dǎo)引面對(duì)勻速直線(xiàn)目標(biāo)表現(xiàn)很好但目標(biāo)一旦做持續(xù)性機(jī)動(dòng)脫靶量就會(huì)明顯上升。解決辦法是增廣比例導(dǎo)引Augmented Proportional NavigationAPN在原來(lái)的指令上疊加一個(gè)對(duì)目標(biāo)機(jī)動(dòng)加速度的補(bǔ)償項(xiàng)a_cmd N · Vc · (ω × e_R) (N / 2) · a_t_perp其中 a_t_perp 是目標(biāo)加速度在視線(xiàn)垂直平面內(nèi)的投影。這個(gè)補(bǔ)償項(xiàng)的直覺(jué)很清晰提前預(yù)測(cè)目標(biāo)因?yàn)闄C(jī)動(dòng)而產(chǎn)生的視線(xiàn)旋轉(zhuǎn)趨勢(shì)把這一部分“預(yù)支”到指令里。實(shí)戰(zhàn)中目標(biāo)的加速度不是精確已知的但你可以用導(dǎo)引頭跟蹤數(shù)據(jù)在線(xiàn)估計(jì)或者干脆用上一幀的目標(biāo)加速度做近似程序改動(dòng)很小效果提升顯著。5.2 帶終端角度約束的偏置比例導(dǎo)引有些場(chǎng)景要求命中時(shí)導(dǎo)彈的速度方向必須落在某個(gè)錐角內(nèi)比如從頂部攻擊裝甲目標(biāo)這時(shí)候純比例導(dǎo)引是做不到的。常見(jiàn)做法是在標(biāo)準(zhǔn)PN指令上疊加一個(gè)偏置項(xiàng)讓視線(xiàn)角速率的收斂過(guò)程“故意”偏一點(diǎn)然后在末端再拉回來(lái)最終同時(shí)滿(mǎn)足脫靶量和落角約束。偏置項(xiàng)的設(shè)計(jì)通常要用到剩余飛行時(shí)間 t_go r / Vc比如偏置量可以根據(jù)當(dāng)前視線(xiàn)角和期望終端視線(xiàn)角的差來(lái)構(gòu)造。這個(gè)方向在學(xué)術(shù)論文里被研究得很多但工程實(shí)現(xiàn)的核心仍然是先把標(biāo)準(zhǔn)三維PN跑通在此基礎(chǔ)上加偏置項(xiàng)才是順理成章的事。5.3 其他工程化擴(kuò)展再往后就是大家各自根據(jù)項(xiàng)目需求去加?xùn)|西了。比如給視線(xiàn)角速率加高斯白噪聲模擬導(dǎo)引頭量測(cè)誤差比如在制導(dǎo)指令回路中加入一階慣性環(huán)節(jié)模擬自動(dòng)駕駛儀動(dòng)態(tài)延遲再比如把三自由度質(zhì)點(diǎn)模型換成六自由度剛體模型加入氣動(dòng)系數(shù)和姿態(tài)控制律。這些擴(kuò)展都在三維PN這個(gè)地基之上所以把這一篇的仿真程序吃透后面的路會(huì)順很多。我個(gè)人實(shí)際操作中還有一個(gè)體會(huì)別急著堆功能先把仿真數(shù)據(jù)的后處理腳本寫(xiě)扎實(shí)。軌跡圖、相對(duì)距離曲線(xiàn)、脫靶量統(tǒng)計(jì)、過(guò)載曲線(xiàn)這幾張圖一旦形成固定模板后面做任何導(dǎo)引律實(shí)驗(yàn)都會(huì)快很多。每加一個(gè)新功能先跑一遍標(biāo)準(zhǔn)PN基線(xiàn)再對(duì)比改進(jìn)后的差異這樣才能知道改動(dòng)到底帶來(lái)了什么效果而不是把時(shí)間浪費(fèi)在調(diào)試各種臨時(shí)畫(huà)圖代碼上。本文還有配套的精品資源點(diǎn)擊獲取