余 馳
(慶安集團有限公司航空設(shè)備研究所,西安 710077)
機載光電轉(zhuǎn)塔系統(tǒng)是一種廣泛應(yīng)用于無人機、固定翼飛機和旋翼機等載機平臺的高精度光電探測設(shè)備[1],它隨著精密傳動技術(shù)、隨動控制技術(shù)、光學技術(shù)、傳感器技術(shù)和圖像處理技術(shù)的發(fā)展和應(yīng)用,朝著高精度和高分辨率的方向發(fā)展[2-3]。機載光電轉(zhuǎn)塔系統(tǒng)一般通過多軸運動合成實現(xiàn)對一定空域目標和區(qū)域的探測和監(jiān)控,軸線的指向精度是實現(xiàn)高精度探測、態(tài)勢感知和環(huán)境監(jiān)控的基礎(chǔ)。在高精度的機載光電轉(zhuǎn)塔系統(tǒng)中,加工誤差、結(jié)構(gòu)變形誤差、配合與安裝誤差、成件精度等均會通過幾何關(guān)系耦合到方位軸和俯仰軸,最終表現(xiàn)為產(chǎn)生相應(yīng)的合成軸系誤差。因此在不同的應(yīng)用領(lǐng)域?qū)S系誤差的控制研究備受關(guān)注[4-11],也是決定隨動跟蹤精度的重要因素之一。
這些誤差可以通過系統(tǒng)設(shè)計控制和降低,但卻是不可避免的存在。為了消除誤差、提高精度,本文建立了機載光電轉(zhuǎn)塔系統(tǒng)軸系誤差的數(shù)學模型,推導出了因軸系誤差在方位和俯仰方向產(chǎn)生隨動跟蹤誤差的影響關(guān)系,并進行了仿真與分析,提出了將誤差角度作為位置環(huán)的補償引入到隨動控制中,消除誤差,提高隨動精度的解決方法。
機載光電轉(zhuǎn)塔系統(tǒng)軸系關(guān)系見圖1,Y框為方位框,P框為俯仰框,以實現(xiàn)在方位和俯仰兩個自由度的隨動。建立載體坐標系OXaYaZa、機載光電轉(zhuǎn)塔系統(tǒng)方位框坐標系OXyYyZy和俯仰框坐標系OXpYpZp。α,β分別為方位框坐標系OXyYyZy和俯仰框坐標系OXpYpZp繞OZa和OXy旋轉(zhuǎn)的方位角和俯仰角。
圖1 機載光電轉(zhuǎn)塔系統(tǒng)軸系關(guān)系圖Fig.1 Shafting relationship of airborne optical-electronic turret system
OXaYaZa坐標系中向量R,分解到OXaYaZa坐標系中3個軸的分量分別為Rax,Ray,Raz。在不考慮軸系誤差時,Rax,Ray,Raz通過OZa軸的摩擦和幾何約束耦合到方位框中,可以得到Rax,Ray,Raz分解到方位框坐標系3個軸的分量分別為Ryx,Ryy,Ryz,如圖2、圖3所示,其算式見式(1)。
圖2 方位與載體坐標系的關(guān)系圖Fig.2 Relationship between yawing and aircraft coordinate system
(1)
式中:
(2)
圖3 俯仰與方位坐標系的關(guān)系圖Fig.3 Relationship between pitching and yawing coordinate system
Ryx,Ryy,Ryz通過OXp軸的摩擦和幾何約束耦合到俯仰框中,可以得到Ryx,Ryy,Ryz分解到俯仰框坐標系3個軸的分量分別為Rpx,Rpy,Rpz。即
(3)
式中:
(4)
Tp,a=Tp,yTy,a
(5)
(6)
在考慮軸系誤差時,設(shè)θ為方位軸誤差角度,γ為俯仰軸誤差角度,如圖4所示。
圖4 機載光電轉(zhuǎn)塔系統(tǒng)軸系誤差關(guān)系圖Fig.4 Relationship of axial system error of airborne optical-electronic turret system
因為軸系誤差的存在等效于OXaYaZa坐標系繞OZa和OXa1旋轉(zhuǎn)了一個θ和γ的旋轉(zhuǎn)角,OXaYaZa坐標系繞OZa旋轉(zhuǎn)θ角形成了OXa1Ya1Za1坐標系,OXa1Ya1Za1坐標系繞OXa1旋轉(zhuǎn)γ角形成了OXa2Ya2Za2坐標系。則OXaYaZa坐標系中的向量R,3個軸的分量為Rax,Ray,Raz在OXa1Ya1Za1坐標系和OXa2Ya2Za2新坐標系的分量分別為Rax1,Ray1,Raz1和Rax2,Ray2,Raz2。
(7)
式中:
(8)
Rax1,Ray1,Raz1通過OXa1軸旋轉(zhuǎn)γ角,可以得到Rax1,Ray1,Raz1在OXa2Ya2Za2坐標系3個軸的分量分別為Rpx2,Rpy2,Rpz2,即
(9)
式中:
(10)
(11)
(12)
因為軸系誤差θ和γ的存在,在OXaYaZa坐標系中的向量R,分解到OXa2Ya2Za2坐標系中3個軸的分量分別為Rax2,Ray2,Raz2,如圖5所示。
圖5 軸系誤差隨動狀態(tài)關(guān)系圖Fig.5 Relationshop diagram when axial system erroris in servo state
當方位框坐標系OXyYyZy和俯仰框坐標系OXpYpZp繞OZa2和OXy旋轉(zhuǎn)的方位角和俯仰角分別為α,β時,Rax2,Ray2,Raz2變化為Rpxe,Rpye,Rpze,即表示為OXaYaZa坐標系中的向量R,因軸系誤差θ和γ的存在,同樣經(jīng)過α,β時分別變換為Rpxe,Rpye,Rpze。根據(jù)式(1)~式(6)可得
(13)
(14)
整理后可得
(15)
在OXaYaZa坐標系中的向量R,即Rax,Ray,Raz在理想軸系和有軸系誤差引起的隨動誤差值為
(16)
(17)
式中:I為3×3的單位矩陣,即
(18)
將式(6)、式(12)和式(18)代入式(17)后整理可得
(19)
在OXaYaZa坐標系中的向量R,分解到OXaYaZa坐標系中3個軸的分量分別為Rax,Ray,Raz。機載光電轉(zhuǎn)塔系統(tǒng)的視軸一般與OYa重合或平行,在此取與OYa重合,并將向量R單位化,則有
(20)
將式(20)代入式(19),可將式(19)簡化為
(21)
由于安裝與配合誤差、結(jié)構(gòu)變形誤差、加工誤差、成件誤差等因素的存在,折合到輸出軸不可避免會產(chǎn)生機載光電轉(zhuǎn)塔系統(tǒng)在方位軸和俯仰軸的軸系誤差。按照系統(tǒng)誤差合成的原理,考慮到未定系統(tǒng)誤差的不確定性及項數(shù)較多,采用平方根求和平均法。設(shè)機載光電轉(zhuǎn)塔系統(tǒng)軸系在方位軸和俯仰軸的系統(tǒng)合成誤差角度分別為θ,γ時,為了跟蹤空間范圍的某一個目標或監(jiān)控某一個區(qū)域時,機載光電轉(zhuǎn)塔系統(tǒng)方位和俯仰需要隨動的角度分別為α,β,將式(21)中ΔRpx和ΔRpz線位移誤差轉(zhuǎn)換為對應(yīng)的角位移誤差,按照表1給出了幾組合成誤差和隨動跟蹤范圍的參數(shù)算例,利用軟件編程,可以得出不同軸系誤差情況下在方位、俯仰和兩自由度合成的誤差仿真曲線,結(jié)果見圖6~圖8。
表1 隨動角度和軸系誤差參數(shù)表
圖6 軸系誤差參數(shù)Ⅰ的誤差曲線Fig.6 Error curves with axial system error parameter Ⅰ
圖7 軸系誤差參數(shù)Ⅱ的誤差曲線Fig.7 Error curves with axial system error parameter Ⅱ
當存在5″的方位軸和俯仰軸誤差時,在不同的方位和俯仰隨動角度跟蹤下,由圖6a可知,在方位隨動角度為0°和俯仰隨動的負向極限角度為-80°時,誤差最大,絕對值約為20 μrad;由圖6b可知,在俯仰隨動角度為0°和方位隨動極限角度為-180°時,誤差最大,絕對值約為45 μrad;由圖6c可知,在機載光電轉(zhuǎn)塔系統(tǒng)探測和監(jiān)控時,合成的誤差最大值出現(xiàn)在方位角度-180°和俯仰角度+20°范圍附近,其誤差最大值的絕對值約為50 μrad。當分別存在10″和20″的方位軸和俯仰軸誤差時,在不同的方位和俯仰隨動角度跟蹤下,由圖7和圖8可以得出,誤差絕對值最大的隨動角度是基本相同的,只是10″,20″的方位方向誤差絕對值變大,分別約為40 μrad和80 μrad;10″,20″的俯仰方向誤差絕對值變大,分別約為90 μrad和180 μrad;10″,20″的兩個自由度合成誤差絕對值變大,合成的誤差最大值出現(xiàn)在方位角度-180°和俯仰角度+20°范圍附近,合成誤差最大的絕對值分別約為110 μrad和200 μrad。上述分析表明,在不同隨動使用范圍和精度要求的機載光電轉(zhuǎn)塔系統(tǒng)中,軸系誤差的存在會對不同隨動跟蹤位置的目標探測和監(jiān)控產(chǎn)生不同的精度影響。因此在系統(tǒng)設(shè)計時,需要根據(jù)隨動范圍和實際精度使用的需求,按照建立的數(shù)學模型和仿真結(jié)果進行精度分配、軸系誤差控制和評估,以支撐系統(tǒng)設(shè)計和滿足使用需求。
圖8 軸系誤差參數(shù)Ⅲ的誤差曲線Fig.8 Error curves with axial system error parameter Ⅲ
在高精度的機載光電轉(zhuǎn)塔系統(tǒng)中,加工誤差、結(jié)構(gòu)變形誤差、配合與安裝誤差、成件精度等均會通過幾何關(guān)系耦合到方位軸和俯仰軸,即會產(chǎn)生相應(yīng)的軸系誤差,這些誤差可以通過系統(tǒng)設(shè)計控制和降低,但卻是不可避免的存在。因此,對精度要求較高的機載光電轉(zhuǎn)塔系統(tǒng),就需要通過一些措施進行消除和補償。本文建立了軸系誤差數(shù)學模型,推導出因軸系誤差在方位和俯仰方向隨動跟蹤誤差公式。對特定的系統(tǒng),可以通過方位軸和俯仰軸誤差檢測,獲得軸系誤差參數(shù)。在實際應(yīng)用時,可以將誤差角度作為位置環(huán)的補償引入到隨動控制中。當方位和俯仰隨動角度變化時,補償?shù)闹狄搽S之實時變化,通過系統(tǒng)閉環(huán)控制達到實時消除誤差,提高隨動精度的效果。
機載光電轉(zhuǎn)塔系統(tǒng)隨著精密傳動技術(shù)、隨動控制技術(shù)、光學技術(shù)、傳感器技術(shù)和圖像處理技術(shù)的發(fā)展和應(yīng)用,會朝著高精度和高分辨率的方向發(fā)展。為了提高精度,建立了軸系誤差對隨動精度影響的數(shù)學模型,推導出軸系誤差在不同隨動角度時對隨動跟蹤精度的影響關(guān)系。通過仿真對軸系誤差在不同隨動角度的變化特性進行了分析,給出了將誤差角度反饋到隨動控制系統(tǒng)位置環(huán)進行補償、實時消除誤差和提高精度的解決方法,可用于機載光電轉(zhuǎn)塔系統(tǒng)設(shè)計分析和誤差控制,具有工程應(yīng)用參考價值。
[1] 劉洵,王國華,毛大鵬,等.軍用飛機光電平臺的研發(fā)趨勢與技術(shù)剖析[J].中國光學與應(yīng)用光學,2009,12(4):269-288.
[2] 王濤,朱明超,訚勝利,等.穩(wěn)定平臺軸系精度對視軸指向誤差的影響分析[J].紅外與激光工程,2011,40(11):2265-2269.
[3] 許照東,陳松燦,李辛.穩(wěn)定平臺動態(tài)精度分析及改進[J].紅外與激光工程,2006,35(s1):454-458.
[4] 李巖,范大鵬.光電穩(wěn)定機構(gòu)指向誤差建模與敏感度分析[J].國防科技大學學報,2008,30(1):104-109.
[5] 陳兆兵,郭勁,時魁,等.某復合告警系統(tǒng)的軸系精度分析[J].機械設(shè)計與制造,2013(3):214-216.
[6] 賈琛斐,劉建東,張健,等.艦載光電指向器多軸系耦合精度分析[J].光學與光電技術(shù),2013,11(1):71-75.
[7] 江波,周泗忠,姜凱,等.車載經(jīng)緯儀的垂軸系誤差分析[J].紅外與激光工程,2015,44(5):1623-1627.
[8] 張峰,丁洪生,付鐵,等.星載天線指向機構(gòu)誤差分析與建模[J].電子機械工程,2010,26(1):41-44.
[9] 曲智勇,姚郁.仿真轉(zhuǎn)臺誤差分析及誤差建模[J].計算機仿真,2006,23(3):301-304.
[10] 賈建援,柴偉,于大林,等.方位俯仰轉(zhuǎn)臺誤差參數(shù)辨識與指向精度分析[J].儀器儀表學報,2016,37(7):1500-1508.
[11] 葉建華,高誠輝,江吉彬.旋轉(zhuǎn)臺集合誤差的在機測量與辨識[J].儀器儀表學報,2015,36(12):2804-2811.