針對半捷聯(lián)紅外導(dǎo)引頭穩(wěn)定控制的目的,通過采用與導(dǎo)引頭相關(guān)的坐標(biāo)系定義,采用四元數(shù)法進(jìn)行分析,建立了導(dǎo)引頭伺服鏡在慣性空間穩(wěn)定的數(shù)學(xué)公式,實現(xiàn)了對方位、俯仰兩個通道伺服鏡的慣性空間穩(wěn)定的公式分離,通過對求解方程進(jìn)行離散,得出了伺服鏡旋轉(zhuǎn)角增量形式的公式,并對離散方程的穩(wěn)定性進(jìn)行重點研究,為系統(tǒng)分析和設(shè)計提供理論依據(jù),算例表明算法公式的正確性,得到了提高伺服鏡在慣性空間的穩(wěn)定度精度使得其誤差小于1.0×10-6rad的結(jié)論。 

【文章來源】：電子設(shè)計工程. 2020,28(19)

【文章頁數(shù)】：5 頁

【部分圖文】：

伺服鏡捷聯(lián)穩(wěn)定框圖

伺服鏡捷聯(lián)穩(wěn)定模塊是整個穩(wěn)定系統(tǒng)的核心部分，其功能是把導(dǎo)引頭基座擾動信號，通過坐標(biāo)變換，經(jīng)過較復(fù)雜的計算，得到控制伺服鏡的角度信號，從而保證伺服鏡空間穩(wěn)定。捷聯(lián)穩(wěn)定模塊運用四元數(shù)法，將輸入的導(dǎo)引頭基座角速度作為輸入量，通過四元數(shù)表述的坐標(biāo)變換矩陣，在捷聯(lián)計算過程中，通過穩(wěn)定在慣性坐標(biāo)系的初始向量，改初始向量變換到伺服鏡視線坐標(biāo)系，最后得到穩(wěn)定初始矢量的伺服鏡方位、俯仰角度，捷聯(lián)穩(wěn)定模塊的輸出是控制伺服鏡輸出的實時角度。由慣性坐標(biāo)系先轉(zhuǎn)換到彈上坐標(biāo)系[x1,y1,z1]T，再由彈上坐標(biāo)系轉(zhuǎn)換到彈上測量坐標(biāo)系。這種轉(zhuǎn)換關(guān)系可用四元數(shù)姿態(tài)矩陣T來表示[6]:根據(jù)發(fā)射時的彈體初始方位、俯仰及滾轉(zhuǎn)角?0,ψ0,γ0，對應(yīng)的初始四元數(shù)q00,q10,q20,q30。α0,β0是伺服鏡的初始預(yù)定角。伺服鏡的穩(wěn)定問題，實際上就是截獲目標(biāo)時刻的伺服鏡坐標(biāo)在慣性空間保持不變，即不論彈體姿態(tài)角(ψ,?,γ)如何變化，都要控制α,β（伺服鏡轉(zhuǎn)角），使得伺服鏡實時位置[x,y,z]保持在慣性空間位置[x0,y0,z0]不變，即：

方程（11）、（12）的求解是采用增量法，實時計算出由于彈體姿態(tài)的擾動，伺服鏡需要保持穩(wěn)定的框架角[11-12]，運算變量運用單精度類型數(shù)據(jù)，計算的初始條件：α0=β0=0，ωx=ωy=0，ωz=0.001 rad/s，時間步長為1 ms，保持穩(wěn)定的角度增量為10-6rad。圖3針對變量選取float型和double型，進(jìn)行運算結(jié)果對比，用單精度數(shù)據(jù)解算的伺服鏡角度增量誤差值是發(fā)散的，隨著時間的增長，誤差還會繼續(xù)增大，甚至發(fā)散，導(dǎo)致穩(wěn)定算法失敗。而采用雙精度計算，算法是穩(wěn)定的，因此，采用捷聯(lián)穩(wěn)定模塊采用變量雙精度是必須的[13-14]。為此，伺服控制計算機選用TMS320C6701浮點處理器，運算變量選用double類型[15]。初期采用定點DSP(32位）處理器，要保持計算的穩(wěn)定性，必須采用64位定點計算增量角才能保證穩(wěn)定，32位定點計算達(dá)不到計算穩(wěn)定性的要求[16]。

【參考文獻(xiàn)】：
期刊論文
[1]基于無跡卡爾曼濾波的捷聯(lián)導(dǎo)引頭視線角速率估計方法[J]. 楊陽,蔡正誼,陳升澤,趙帥.  兵器裝備工程學(xué)報. 2019(02)
[2]基于隔離度特性的導(dǎo)引頭控制系統(tǒng)優(yōu)化設(shè)計[J]. 劉石祥,杜肖,符勝楠,夏群利.  系統(tǒng)工程與電子技術(shù). 2018(02)
[3]高超聲速飛行器俯沖段制導(dǎo)控制方法研究[J]. 劉清楷,陳堅,汪立新,秦偉偉,張廣豪.  現(xiàn)代防御技術(shù). 2017(06)
[4]基于理想彈道魯棒容積卡爾曼濾波視線角估計[J]. 劉振亞,高敏,程呈.  系統(tǒng)工程與電子技術(shù). 2018(02)
[5]半捷聯(lián)導(dǎo)引頭隔離度影響與STUKF在線補償[J]. 胡歐磊,王江,黃鵬,林德福,楊哲.  紅外與激光工程. 2017(03)
[6]基于多模型的捷聯(lián)紅外導(dǎo)引頭隔離度在線補償方法[J]. 宗睿,林德福,王偉,盛曉彥,蘭玲.  系統(tǒng)工程與電子技術(shù). 2017(01)
[7]全捷聯(lián)對地攻擊制導(dǎo)武器導(dǎo)引頭隔離度對制導(dǎo)系統(tǒng)性能的影響[J]. 袁亦方,林德福,楊濤.  紅外與激光工程. 2015(06)
[8]半捷聯(lián)滾仰導(dǎo)引頭視線角速度重構(gòu)提取技術(shù)[J]. 孫高,趙桂軍,呂鑒倬,曹培培.  制導(dǎo)與引信. 2015(02)
[9]滾仰式捷聯(lián)導(dǎo)引頭視線角速度提取技術(shù)研究[J]. 江云,李友年,王霞.  電光與控制. 2015(04)
[10]天線罩和導(dǎo)引頭隔離度對制導(dǎo)系統(tǒng)影響研究[J]. 鄭多,林德福,徐興華,祁載康.  系統(tǒng)工程與電子技術(shù). 2015(07)

碩士論文
[1]半捷聯(lián)穩(wěn)定平臺控制器設(shè)計及空間運動仿真[D]. 張又文.西南科技大學(xué) 2018



本文編號：3624182