三軸轉(zhuǎn)臺(tái)系統(tǒng)姿態(tài)變化下指向誤差建模與分析

（中國(guó)洛陽(yáng)電子裝備試驗(yàn)中心，洛陽(yáng) 471003）

0 引言

三軸轉(zhuǎn)臺(tái)是雷達(dá)對(duì)抗半實(shí)物仿真系統(tǒng)中的重要環(huán)境模擬設(shè)備之一，用于承載主/被動(dòng)雷達(dá)導(dǎo)引頭、反輻射無(wú)人機(jī)等負(fù)載設(shè)備，并模擬其在實(shí)際飛行過(guò)程中的姿態(tài)變化，具有仿真精度高、穩(wěn)定性好、通用性強(qiáng)等特點(diǎn)[1]。但受制造、裝配、變形等因素影響，轉(zhuǎn)臺(tái)不可避免的存在垂直度誤差、傾角回轉(zhuǎn)誤差等誤差分量，由此產(chǎn)生的綜合性指向誤差將直接影響仿真試驗(yàn)中負(fù)載設(shè)備的測(cè)角、定位和攻擊精度。因此，建立三軸轉(zhuǎn)臺(tái)系統(tǒng)指向誤差模型，研究各誤差分量對(duì)指向誤差的影響規(guī)律，對(duì)提高三軸轉(zhuǎn)臺(tái)精度具有十分重要的意義。

近年來(lái)國(guó)內(nèi)外學(xué)者對(duì)轉(zhuǎn)臺(tái)指向誤差進(jìn)行了廣泛的研究。其中幾何法、矢量法、機(jī)構(gòu)運(yùn)動(dòng)學(xué)等[2,3]被運(yùn)用進(jìn)行轉(zhuǎn)臺(tái)誤差建模，但這些方法存在適用范圍小、建模困難、通用性差等問(wèn)題。李凡[4]等人利用多體系統(tǒng)理論約束條件少、易解決復(fù)雜系統(tǒng)運(yùn)動(dòng)問(wèn)題、準(zhǔn)確性高等優(yōu)點(diǎn)，建立了三軸標(biāo)定轉(zhuǎn)臺(tái)指向誤差模型；趙玉華[5]等人研究了三軸轉(zhuǎn)臺(tái)有誤差情況下的運(yùn)動(dòng)規(guī)律，并詳細(xì)分析了不同幾何誤差對(duì)轉(zhuǎn)臺(tái)精度的影響；孫致月[6]等人則是基于臥式五軸轉(zhuǎn)臺(tái)結(jié)構(gòu)及運(yùn)動(dòng)原理，建立了五軸轉(zhuǎn)臺(tái)誤差分析模型，并進(jìn)一步提出了相關(guān)的誤差評(píng)價(jià)參數(shù)。

上述文獻(xiàn)的研究對(duì)象往往只是三軸轉(zhuǎn)臺(tái)本身，并沒(méi)有從包括負(fù)載設(shè)備的整個(gè)轉(zhuǎn)臺(tái)系統(tǒng)的角度考慮，導(dǎo)致所建指向誤差模型中缺乏負(fù)載設(shè)備安裝角度誤差分量，有失嚴(yán)謹(jǐn)；此外，實(shí)際仿真試驗(yàn)中轉(zhuǎn)臺(tái)姿態(tài)的變化使指向誤差也是動(dòng)態(tài)變化的，而目前的研究主要是針對(duì)轉(zhuǎn)臺(tái)在特定姿態(tài)角下的指向誤差，并沒(méi)有考慮在轉(zhuǎn)臺(tái)姿態(tài)變化下研究各誤差分量對(duì)指向誤差的影響規(guī)律。針對(duì)上述問(wèn)題，本文建立了從轉(zhuǎn)臺(tái)基座到負(fù)載設(shè)備的三軸轉(zhuǎn)臺(tái)系統(tǒng)多體拓?fù)浣Y(jié)構(gòu)，將負(fù)載設(shè)備安裝角度誤差分量引入特征矩陣，完善了指向誤差模型?；诮⒌哪Ｐ?，在轉(zhuǎn)臺(tái)姿態(tài)變化情況下，研究了不同誤差分量對(duì)系統(tǒng)指向誤差的影響規(guī)律，從而為三軸轉(zhuǎn)臺(tái)的設(shè)計(jì)裝調(diào)、誤差分配及補(bǔ)償提供了理論依據(jù)。

1 三軸轉(zhuǎn)臺(tái)系統(tǒng)原理模型

1.1 三軸轉(zhuǎn)臺(tái)系統(tǒng)結(jié)構(gòu)及運(yùn)動(dòng)原理

本文以某三軸立式仿真轉(zhuǎn)臺(tái)為研究對(duì)象，其結(jié)構(gòu)為U-O-O型，由外框、中框及內(nèi)框組成，如圖1所示。其中外框作繞z軸的偏航運(yùn)動(dòng)（轉(zhuǎn)動(dòng)角度α）；中框作繞y軸的俯仰運(yùn)動(dòng)（轉(zhuǎn)動(dòng)角度β），內(nèi)框作繞x軸的橫滾運(yùn)動(dòng)（轉(zhuǎn)動(dòng)角度γ）。負(fù)載設(shè)備沿內(nèi)框回轉(zhuǎn)軸安裝在轉(zhuǎn)臺(tái)上，即負(fù)載設(shè)備電軸與內(nèi)框回轉(zhuǎn)軸線重合。

圖1 三軸轉(zhuǎn)臺(tái)結(jié)構(gòu)示意圖

1.2 三軸轉(zhuǎn)臺(tái)系統(tǒng)誤差描述

三軸轉(zhuǎn)臺(tái)系統(tǒng)指向誤差是一種空間角度誤差，定義為負(fù)載設(shè)備電軸上的單位矢量經(jīng)過(guò)轉(zhuǎn)臺(tái)姿態(tài)變化后，預(yù)期指向與實(shí)際指向之間的角度偏差[7]。三軸轉(zhuǎn)臺(tái)系統(tǒng)中影響最終指向誤差的誤差分量包括：垂直度誤差、傾角回轉(zhuǎn)誤差、回轉(zhuǎn)位置誤差以及負(fù)載設(shè)備安裝角度誤差。其中，垂直度誤差定義為實(shí)際回轉(zhuǎn)軸線與理想軸線間的角度偏差[8]；傾角回轉(zhuǎn)誤差為回轉(zhuǎn)軸的角度位置變動(dòng)量；回轉(zhuǎn)位置誤差是指轉(zhuǎn)臺(tái)各運(yùn)動(dòng)軸受運(yùn)動(dòng)控制誤差、電機(jī)誤差、編碼器分辨率等因素引起的轉(zhuǎn)角誤差；負(fù)載設(shè)備安裝角度誤差為設(shè)備電軸與內(nèi)框回轉(zhuǎn)軸線之間的角度偏差。

2 三軸轉(zhuǎn)臺(tái)系統(tǒng)指向誤差模型的建立

2.1 多體系統(tǒng)運(yùn)動(dòng)學(xué)理論

多體系統(tǒng)運(yùn)動(dòng)學(xué)理論是進(jìn)行誤差建模的重要方法，其原理為：首先將研究對(duì)象抽象為一個(gè)多運(yùn)動(dòng)體系統(tǒng)并用拓?fù)浣Y(jié)構(gòu)概括和提煉，然后采用低序體陣列進(jìn)行數(shù)字化描述，最后通過(guò)建立理想無(wú)誤差和實(shí)際有誤差條件下的特征矩陣，獲得系統(tǒng)中任意運(yùn)動(dòng)體間的位姿變換關(guān)系及誤差傳遞關(guān)系[9]。

在多體系統(tǒng)中，通常設(shè)定大地慣性坐標(biāo)系為B0體，然后沿遠(yuǎn)離其方向，按自然數(shù)增長(zhǎng)序列對(duì)各運(yùn)動(dòng)體編號(hào)，并定義任意體Bk的n階低序體算子為：

式中：L為低序體算子，k為運(yùn)動(dòng)體序號(hào)，i為其n階低序體序號(hào)。設(shè)定存在運(yùn)動(dòng)體Bk和其相鄰低序體Bj，則兩者的低序體算子表達(dá)式為：

運(yùn)動(dòng)體Bk和Bj間相對(duì)運(yùn)動(dòng)關(guān)系如圖2所示，其中和Os分別為Bk在Bj體坐標(biāo)系（Ojxjyjzj）內(nèi)的理想運(yùn)動(dòng)參考點(diǎn)和實(shí)際運(yùn)動(dòng)參考點(diǎn)，相應(yīng)的理想位置矢量為實(shí)際位置矢量為位置誤差矢量為分別表示Bk體坐標(biāo)系原點(diǎn)在其實(shí)際運(yùn)動(dòng)坐標(biāo)系（Osxsyszs）中的理想運(yùn)動(dòng)位置和實(shí)際運(yùn)動(dòng)位置，相應(yīng)的理想位置矢量、實(shí)際位置矢量和位置誤差矢量分別為

圖2 相鄰運(yùn)動(dòng)體間相對(duì)運(yùn)動(dòng)關(guān)系示意圖

根據(jù)圖2中描述的運(yùn)動(dòng)關(guān)系，可獲得Bk內(nèi)任意一點(diǎn)P在Bj體參考坐標(biāo)系內(nèi)的位置矢量

式中：Tjk,p和Tjk,s分別為理想無(wú)誤差情況下的靜止特征矩陣和運(yùn)動(dòng)特征矩陣；Tjk,pe和Tjk,se分別為實(shí)際有誤差情況下的靜止誤差特征矩陣和運(yùn)動(dòng)誤差特征矩陣。則兩相鄰運(yùn)動(dòng)體之間理想特征矩陣Tjk,ideal和實(shí)際特征矩陣Tjk,actual的表達(dá)式為：

當(dāng)多體系統(tǒng)存在n組相鄰體時(shí)，可獲得整個(gè)多體系統(tǒng)的理想特征矩陣Tideal和實(shí)際特征矩陣Tactual的表達(dá)式[11]：

2.2 三軸轉(zhuǎn)臺(tái)系統(tǒng)多體拓?fù)浣Y(jié)構(gòu)

基于多體系統(tǒng)運(yùn)動(dòng)學(xué)理論可將三軸轉(zhuǎn)臺(tái)系統(tǒng)抽象為多個(gè)各運(yùn)動(dòng)體，并依照它們間的固連關(guān)系構(gòu)建如圖3所示的開(kāi)環(huán)鏈路結(jié)構(gòu)。以往的研究并沒(méi)有考慮負(fù)載設(shè)備，因此轉(zhuǎn)臺(tái)拓?fù)浣Y(jié)構(gòu)只建立到內(nèi)框，本文基于負(fù)載設(shè)備和轉(zhuǎn)臺(tái)內(nèi)框之間的固連關(guān)系，在原有鏈路結(jié)構(gòu)中增加了負(fù)載設(shè)備環(huán)節(jié)。進(jìn)一步設(shè)定基座為慣性參考坐標(biāo)系編號(hào)B0，沿著框→中框→內(nèi)框→負(fù)載設(shè)備的方向，對(duì)各運(yùn)動(dòng)體進(jìn)行編號(hào)并建立相應(yīng)的坐標(biāo)系，可獲得三軸轉(zhuǎn)臺(tái)系統(tǒng)多體拓?fù)浣Y(jié)構(gòu)。

圖3 三軸轉(zhuǎn)臺(tái)系統(tǒng)多體拓?fù)浣Y(jié)構(gòu)圖

依據(jù)上文中轉(zhuǎn)臺(tái)系統(tǒng)誤差描述和圖3中各運(yùn)動(dòng)體坐標(biāo)系，對(duì)影響系統(tǒng)指向誤差的各誤差分量進(jìn)行標(biāo)號(hào)，如表1所示。

表1 三軸轉(zhuǎn)臺(tái)系統(tǒng)誤差分量

表中垂直度誤差分量以S(z1x0)為例，它表示圖3中外框z1軸與基座x0軸間的垂直度誤差；其余誤差分量中以εx(z1)為例，表示外框z1軸轉(zhuǎn)動(dòng)過(guò)程產(chǎn)生的在x方向上角度誤差分量。建立三軸轉(zhuǎn)臺(tái)系統(tǒng)拓?fù)浣Y(jié)構(gòu)后，依據(jù)公式定義的低序體陣列對(duì)其進(jìn)行數(shù)字化描述，如表2所示。

表2 三軸轉(zhuǎn)臺(tái)系統(tǒng)低序體陣列

2.3 相鄰運(yùn)動(dòng)體間特征矩陣

結(jié)合三軸轉(zhuǎn)臺(tái)系統(tǒng)中相鄰運(yùn)動(dòng)體間的相對(duì)運(yùn)動(dòng)關(guān)系，并將各誤差分量引入其中，可推導(dǎo)出相應(yīng)的特征矩陣。以中框和內(nèi)框?yàn)槔?，其特征矩陣為?/p>

以往的研究中常常簡(jiǎn)單地以轉(zhuǎn)臺(tái)內(nèi)框回轉(zhuǎn)軸線表征負(fù)載設(shè)備電軸，忽視了兩者之間存在的負(fù)載設(shè)備安裝角度誤差分量，有失嚴(yán)謹(jǐn)。因此，本文在完善轉(zhuǎn)臺(tái)系統(tǒng)拓?fù)浣Y(jié)構(gòu)的基礎(chǔ)上，進(jìn)一步將負(fù)載設(shè)備安裝角度誤差分量引入內(nèi)框和負(fù)載設(shè)備間的特征矩陣，表征二者之間的位姿變化關(guān)系和誤差傳遞作用關(guān)系：

2.4 指向誤差模型

三軸轉(zhuǎn)臺(tái)系統(tǒng)拓?fù)浣Y(jié)構(gòu)及各運(yùn)動(dòng)體間特征矩陣建立后，進(jìn)一步根據(jù)公式和可獲得整個(gè)系統(tǒng)理想特征矩陣Tideal和實(shí)際特征矩陣Tactual：

實(shí)際研究中為了便于分析，通常將負(fù)載設(shè)備坐標(biāo)系x軸上的單位矢量表示為負(fù)載設(shè)備電軸指向?；谝呀⒌娜S轉(zhuǎn)臺(tái)系統(tǒng)理想和實(shí)際特征矩陣，可獲得負(fù)載設(shè)備電軸的實(shí)際指向向量和預(yù)期指向向量

根據(jù)三軸轉(zhuǎn)臺(tái)系統(tǒng)指向誤差的定義，其表達(dá)式為：

3 仿真結(jié)果分析

基于上文所建三軸轉(zhuǎn)臺(tái)系統(tǒng)指向誤差模型，仿真計(jì)算轉(zhuǎn)臺(tái)姿態(tài)變化時(shí)不同誤差分量對(duì)指向誤差的影響規(guī)律。仿真時(shí)，三軸轉(zhuǎn)臺(tái)模擬某負(fù)載設(shè)備實(shí)際姿態(tài)變化軌跡如圖4所示。其中轉(zhuǎn)臺(tái)外框偏航軸做周期性的正負(fù)向偏擺；中框俯仰軸作同外框同周期的規(guī)律運(yùn)動(dòng)，且兩軸在同時(shí)刻達(dá)到極限位置；內(nèi)框橫滾軸做周期轉(zhuǎn)動(dòng)，但變化規(guī)律與另外兩軸不同。

圖4 三軸轉(zhuǎn)臺(tái)姿態(tài)變化軌跡

為了便于分析，在仿真計(jì)算時(shí)將目標(biāo)誤差分量大小設(shè)定為10″，其余誤差分量置0。不同誤差分量對(duì)指向誤差影響的結(jié)果如圖5～圖8所示。

圖5 垂直度誤差對(duì)指向誤差影響

圖6 傾角回轉(zhuǎn)誤差對(duì)指向誤差影響

圖7 回轉(zhuǎn)位置誤差對(duì)指向誤差影響

圖8 負(fù)載設(shè)備安裝角度誤差對(duì)指向誤差影響

由圖中結(jié)果可知，在誤差分量S(z1y0)、S(y2z1)、S(y2x1)、εx(z1)及εz(z1)作用下，指向誤差呈與轉(zhuǎn)臺(tái)外框α、中框β角姿態(tài)軌跡相對(duì)應(yīng)的周期變化，與內(nèi)框γ角無(wú)關(guān)，且指向誤差在特定姿態(tài)角下達(dá)到極值，如表3所示：在S(z1y0)、S(y2z1)和εx(z1)作用下，當(dāng)轉(zhuǎn)臺(tái)α、β角最大時(shí)，系統(tǒng)指向誤差最大為8.7″，當(dāng)α、β角最小時(shí)，指向誤差最小為5.2″；而當(dāng)S(y2x1)和εz(z1)作用時(shí)，指向誤差在α、β角最小時(shí)達(dá)到最大為8.6″，在α、β角最大時(shí)指向誤差最小為5.1″。

表3 不同誤差分量引起的指向誤差極值

相較于其他誤差分量，指向誤差受S(z1x0)、S(x3y2)、S(x3z2)、εy(z1)、εz(y2)、εy(y2)、εy(x3)、εz(x3)、εy(x4)和εz(x4)影響作用較大，當(dāng)誤差分量大小為10″時(shí)指向誤差也達(dá)到10″，即在上述誤差分量作用下產(chǎn)生的指向誤差大小與誤差分量本身大小相同。此外，由圖中結(jié)果可知隨著轉(zhuǎn)臺(tái)姿態(tài)的變化，指向誤差不發(fā)生改變。

由仿真結(jié)果可知當(dāng)誤差分量εx(y2)、εx(x3)及εx(x4)作用時(shí)，系統(tǒng)指向誤差為0，即εx(y2)、εx(x3)及εx(x4)對(duì)指向誤差無(wú)影響，這主要是由于將負(fù)載設(shè)備坐標(biāo)系x軸方向上的單位矢量表示為電軸指向造成的。在進(jìn)行轉(zhuǎn)臺(tái)設(shè)計(jì)和誤差補(bǔ)償時(shí)，上述誤差分量可不用考慮。

4 結(jié)論

基于多體系統(tǒng)運(yùn)動(dòng)學(xué)理論，建立了完善的三軸轉(zhuǎn)臺(tái)指向誤差模型。在轉(zhuǎn)臺(tái)姿態(tài)變化下，仿真獲得了不同誤差分量對(duì)系統(tǒng)指向誤差的影響規(guī)律：

1）在外框與地基y向垂直度誤差、中框與外框垂直度誤差、外框x向傾角回轉(zhuǎn)誤差及回轉(zhuǎn)位置誤差作用下，指向誤差呈與轉(zhuǎn)臺(tái)外框和中框姿態(tài)軌跡相對(duì)應(yīng)的周期變化，且在特定姿態(tài)角下達(dá)到極值。

2）指向誤差受中框回轉(zhuǎn)位置誤差、負(fù)載設(shè)備y向安裝角度誤差等誤差分量影響作用較大，其大小與誤差分量相同，且不隨轉(zhuǎn)臺(tái)姿態(tài)變化。

3）中框x向傾角回轉(zhuǎn)誤差、內(nèi)框回轉(zhuǎn)位置誤差及負(fù)載設(shè)備x向安裝角度誤差對(duì)系統(tǒng)指向誤差無(wú)影響。