




下載本文檔
版權(quán)說明:本文檔由用戶提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)
文檔簡(jiǎn)介
1、%三維制導(dǎo)模型,比例導(dǎo)引法求解%源代碼作者不詳,注釋人:lylogn%Modifiedbylylogn,2012年4月17日clearall;closeall;clcdt=0.1;%仿真時(shí)間步長(zhǎng)alpha=pi/6;v_t=0.42;s_t=v_t*dt;%目標(biāo)以0.42的速度沿alpha的角方向勻速飛行,s_t為目標(biāo)在單位仿真步長(zhǎng)前進(jìn)的距離v_m=0.60;s_m=v_m*dt;%s_m為導(dǎo)彈在單位仿真步長(zhǎng)沿目前速度方向前進(jìn)的距離x(1)=0;y(1)=1.0;z(1)=0;pmr(:,1)=x(1);y(1);z(1);%導(dǎo)彈初始位置,在坐標(biāo)原點(diǎn)ptr(:,1)=25;5;7;%目標(biāo)初始位
2、置K=3;%比例導(dǎo)引系數(shù)q(1)=0;%初始的視線角,設(shè)定參考線為t和m初始位置的連線o(1)=0;%初始導(dǎo)彈速度向量方向角a(1)=0;%初始導(dǎo)彈相對(duì)目標(biāo)的運(yùn)動(dòng)速度向量的方向角for(k=2:600)ptr(:,k尸ptr(1,1)-v_t*cos(alpha)*dt*k;ptr(2,1);ptr(3,1)+v_t*sin(alpha)*k*dt;%目標(biāo)運(yùn)行軌跡方程,勻速直線運(yùn)動(dòng)r(k-1)=sqrt(ptr(1,k-1)-pmr(1,k-1)A2+(ptr(2,k-1)-pmr(2,k-1)A2+(ptr(3,k-1)-pmr(3,k-1)A2);%k-1時(shí)刻導(dǎo)彈與目標(biāo)在三維空間中的歐氏距
3、離c=sqrt(ptr(1,k)-pmr(1,k-1)A2+(ptr(2,k)-pmr(2,k-1)A2+(ptr(3,k)-pmr(3,k-1)A2);%目標(biāo)k時(shí)刻位置與導(dǎo)彈k-1時(shí)刻位置間的距離b=acos(r(k-1)A2+s_tA2-cA2)/(2*r(k-1)*s_t);%此處參見公式一%dq=acos(r(k-1)A2-s_tA2+cA2)/(2*r(k-1)*c);%k-1時(shí)刻到k時(shí)刻的視線角變化量(假設(shè)導(dǎo)彈不動(dòng),目標(biāo)移動(dòng))%此處參見圖一%ifabs(imag(b)0%如果acos的值出現(xiàn)虛數(shù),則說明該角度一定很小,對(duì)其進(jìn)行近似操作b=0.0000001;endifabs(ima
4、g(dq)0%同上dq=0.0000001;endq(k尸q(k-1)+dq;%更新視線角o(k)=o(k-1)+K*dq;%更新導(dǎo)彈速度向量方向角a(k)=o(k)-q(k);%更新導(dǎo)彈相對(duì)目標(biāo)的運(yùn)動(dòng)速度向量的方向角c1=r(k-1)*sin(b)/sin(a(k)+b);%計(jì)算k-1時(shí)刻角b所對(duì)邊的長(zhǎng)度%此處參見公式二%c2=r(k-1)*sin(a(k)/sin(a(k)+b);%計(jì)算k-1時(shí)刻角a(k)所對(duì)邊的長(zhǎng)度c3=sqrt(c1-s_m)A2+(c2-s_t)A2+2*(c1-s_m)*(c2-s_t)*cos(a(k)+b);%計(jì)算k時(shí)刻導(dǎo)彈m與目標(biāo)t之間的距離(在導(dǎo)彈不動(dòng),目
5、標(biāo)移動(dòng)的假設(shè)條件下),為假值dq=a(k)-acos(c1-s_m)A2+c3A2-(c2-s_t)A2)/(2*(c1-s_m)*c3);%k-1時(shí)刻到k時(shí)刻的視線角變化量(假設(shè)導(dǎo)彈移動(dòng),目標(biāo)也移動(dòng)),以下代碼重復(fù)以上過程,為假值%此處參見圖二%ifabs(imag(dq)0dq=0.0000001;endq(k)=q(k-1)+dq;o(k)=o(k-1)+K*dq;a(k)=o(k)-q(k);c1=r(k-1)*sin(b)/sin(a(k)+b);c2=r(k-1)*sin(a(k)/sin(a(k)+b);c3=sqrt(c1-s_m)A2+(c2-s_t)A2+2*(c1-s_m
6、)*(c2-s_t)*cos(a(k)+b);%計(jì)算k時(shí)刻導(dǎo)彈m與目標(biāo)t之間的距離(在導(dǎo)彈移動(dòng),目標(biāo)也移動(dòng)的假設(shè)條件下),逼近真值,以下計(jì)算使之更加精確dq=a(k)-acos(c1-s_m)A2+c3A2-(c2-s_t)A2)/(2*(c1-s_m)*c3);%k-1時(shí)刻到k時(shí)刻的視線角變化量(假設(shè)導(dǎo)彈移動(dòng),目標(biāo)也移動(dòng)),以下代碼重復(fù)以上過程,為真值ifabs(imag(dq)0dq=0.0000001;end%?dedbylylogn2012.04.17,Tomakedqgetclosertoitstruevalueq(k)=q(k-1)+dq;o(k)=o(k-1)+K*dq;a(k)
7、=o(k)-q(k);c1=r(k-1)*sin(b)/sin(a(k)+b);c2=r(k-1)*sin(a(k)/sin(a(k)+b);c3=sqrt(c1-s_m)A2+(c2-s_t)A2+2*(c1-s_m)*(c2-s_t)*cos(a(k)+b);%計(jì)算k時(shí)刻導(dǎo)彈m與目標(biāo)t之間的距離(在導(dǎo)彈移動(dòng),目標(biāo)也移動(dòng)的假設(shè)條件下),逼近真值,以下計(jì)算使之更加精確dq=a(k)-acos(c1-s_m)A2+c3A2-(c2-s_t)A2)/(2*(c1-s_m)*c3);%k-1時(shí)刻到k時(shí)刻的視線角變化量(假設(shè)導(dǎo)彈移動(dòng),目標(biāo)也移動(dòng)),以下代碼重復(fù)以上過程,為真值ifabs(imag(dq
8、)0dq=0.0000001;endq(k)=q(k-1)+dq;o(k)=o(k-1)+K*dq;a(k)=o(k)-q(k);c1=r(k-1)*sin(b)/sin(a(k)+b);c2=r(k-1)*sin(a(k)/sin(a(k)+b);c3=sqrt(c1-s_m)A2+(c2-s_t)A2+2*(c1-s_m)*(c2-s_t)*cos(a(k)+b);%計(jì)算k時(shí)刻導(dǎo)彈m與目標(biāo)t之間的距離(在導(dǎo)彈移動(dòng),目標(biāo)也移動(dòng)的假設(shè)條件下),逼近真值,以下計(jì)算使之更加精確dq=a(k)-acos(c1-s_m)A2+c3A2-(c2-s_t)A2)/(2*(c1-s_m)*c3);%k-1時(shí)
9、刻到k時(shí)刻的視線角變化量(假設(shè)導(dǎo)彈移動(dòng),目標(biāo)也移動(dòng)),以下代碼重復(fù)以上過程,為真值ifabs(imag(dq)0dq=0.0000001;end%q(k)=q(k-1)+dq;o(k)=o(k-1)+K*dq;a(k)=o(k)-q(k);c1=r(k-1)*sin(b)/sin(a(k)+b);c2=r(k-1)*sin(a(k)/sin(a(k)+b);c3=sqrt(c1-s_m)A2+(c2-s_t)A2+2*(c1-s_m)*(c2-s_t)*cos(a(k)+b);%計(jì)算k時(shí)刻導(dǎo)彈m與目標(biāo)t之間的距離,終于近似為真值了x1(k)=ptr(1,k-1)+c2/s_t*(ptr(1,k
10、)-ptr(1,k-1);y1(k)=ptr(2,k-1)+c2/s_t*(ptr(2,k)-ptr(2,k-1);z1(k)=ptr(3,k-1)+c2/s_t*(ptr(3,k)-ptr(3,k-1);%計(jì)算出角b所對(duì)邊與目標(biāo)運(yùn)動(dòng)軌跡的交點(diǎn):(x1,y1,z1)%參見公式三%x(k)=pmr(1,k-1)+s_m/c1*(x1(k)-pmr(1,k-1);y(k)=pmr(2,k-1)+s_m/c1*(y1(k)-pmr(2,k-1);z(k)=pmr(3,k-1)+s_m/c1*(z1(k)-pmr(3,k-1);%計(jì)算出導(dǎo)彈k時(shí)刻所運(yùn)動(dòng)到的位置:(x,y,z)%參見公式三%pmr(:,
11、k)=x(k);y(k);z(k);r(k)=sqrt(ptr(1,k)-pmr(1,k)A2+(ptr(2,k)-pmr(2,k)A2+(ptr(3,k)-pmr(3,k)A2);ifr(k)0.06;break;end;endsprintf(遭遇時(shí)間:%3.1f,0.1*k);figure(1);plot3(pmr(1,1:k),pmr(2,1:k),pmr(3,1:k),k,ptr(1,:),ptr(2,:),ptr(3,:);axis(02505025);text(x(180),y(180),z(180),rightarrow比例導(dǎo)引律制導(dǎo)下的導(dǎo)彈運(yùn)動(dòng)軌跡,);text(ptr(1,280),ptr(2,280),ptr(3,280),rightarrow目標(biāo)運(yùn)動(dòng)軌跡,);gridon之后,鑒于程序中很多地方不結(jié)合模型圖也很難理解,將其中關(guān)鍵的圖例與公式提取如下:3味航上航天上B曰JINGUNIVERSITYOFAERONAUTICSANDASTRONAUTICS比例身和,三地剃與曼道畫蜂因梅是名覲叔理力)-GfexM切啞科訓(xùn)2*n團(tuán)-:的時(shí)刻事假設(shè)導(dǎo)彈不論目標(biāo)制動(dòng)工七卮飾現(xiàn)囪國二:k-L時(shí)卻倡資與彝詁廿仁
溫馨提示
- 1. 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
- 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
- 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
- 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
- 5. 人人文庫網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
- 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
- 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。
最新文檔
- 金融公司風(fēng)險(xiǎn)定價(jià)模型構(gòu)建
- 科學(xué)簡(jiǎn)史考試題及答案
- 開展市場(chǎng)調(diào)研與趨勢(shì)預(yù)測(cè)分析
- 功能性液體填充的新型光纖溫度傳感器制備及傳感特性研究
- 就業(yè)相關(guān)面試題及答案
- 人際處理面試題及答案
- 客戶管理系統(tǒng)的建設(shè)與應(yīng)用
- 2025年高考真題-生物(安徽卷) 含解析
- 電子商務(wù)概論(第7版)課件 第八章 移動(dòng)電子商務(wù)
- 山地戶外運(yùn)動(dòng)裝備個(gè)性化定制企業(yè)制定與實(shí)施新質(zhì)生產(chǎn)力項(xiàng)目商業(yè)計(jì)劃書
- 2024年福建高考真題化學(xué)試題(解析版)
- 消防宣傳月全民消防生命至上消防安全教育課件
- 24年追覓在線測(cè)評(píng)28題及答案
- 咨詢實(shí)施顧問能力素質(zhì)模型
- 2025年上海市數(shù)學(xué)高考一輪復(fù)習(xí):立體幾何(Ⅰ)(考點(diǎn)練+模擬練)含詳解
- 情侶協(xié)議書電子版簡(jiǎn)單模板
- 建筑水電安裝工程規(guī)范要求中的水泵安裝要求
- 【usmile電動(dòng)牙刷的營銷策略探析8600字(論文)】
- 小兒麻醉術(shù)后并發(fā)癥
- 2019青鳥消防JBF6481編碼器使用指南
- 2024-2030年中國生物基化學(xué)品行業(yè)市場(chǎng)發(fā)展趨勢(shì)與前景展望戰(zhàn)略分析報(bào)告
評(píng)論
0/150
提交評(píng)論