一種彈體初始掛裝姿態測量新方法

張虎龍

（中國飛行試驗研究院，陜西 西安 710089）

一種彈體初始掛裝姿態測量新方法

張虎龍

（中國飛行試驗研究院，陜西 西安 710089）

在彈體掛裝試飛試驗科目中，需要地面靜態標定掛裝彈體的姿態。針對掛裝彈體無等高基準孔位的情況，提出一種基于旋轉矩陣分解的計算方法。該方法只要求測量彈體的基本幾何特征，綜合采用特征探測算法、空間基準對齊算法、奇異值分解算法進行處理計算；為保證姿態測量參數的精度，要求在彈體粘貼輔助圓形標志時，分布要均勻，數量適中，提高空間基準對齊算法的穩健性。通過試驗分析，在無等高基準孔位的情況下，旋轉矩陣分解法能夠實現姿態測量參數誤差小于0.3°，方法切實有效，結果準確可靠，滿足飛行試驗的精度要求。

彈體；姿態測量；旋轉矩陣；分解

0 引 言

掛彈飛行試驗前，在地面往往需要對導彈的慣導相對機體主慣導的位姿關系進行高精度的標定，標定結果將作為兩者的初始安裝誤差，用于機動飛行時慣導基準傳遞的修正值。在工程中，導彈慣導相對機體主慣導的位姿關系可由彈體掛裝后在飛機基準下的位姿關系表達[1]。彈體掛裝姿態測量常用的方法是掛裝前，要求設計單位對彈體的水平和垂直等高點進行高精度標定[2]；掛裝后，利用三維坐標測量設備對彈體等高點進行測量，計算掛裝姿態角度。但在實際工作中，由于設計單位提供的彈體幾何特征不包括等高點，上述方法則會失效。針對此種情況，本文提出了一種新的姿態測量方法——旋轉矩陣分解法，其基本原理是基于彈體已有的幾何特征參數，建立彈體坐標基準；然后，利用三維坐標測量設備測量彈體幾何特征在機體坐標基準下的特征參數；基于彈體特征的兩套參數，建立彈體坐標基準與機體坐標基準的空間轉換關系，計算旋轉矩陣；對旋轉矩陣進行分解，獲取彈體的掛裝姿態角。

1 系統設計及原理

1.1 系統設計

彈體測姿系統主要由全站儀、影像測量設備、工作站及其相應附件組成，如圖1所示。

圖1 測量現場示意圖

1）全站儀：構建飛機機體坐標系，建立機體坐標基準并測量彈體附加標志。

2）單相機測量儀：測量彈體特征及附加標志，建立彈體坐標基準。

3）工作站：主要用于數據的實時數據處理與分析。

1.2 測量原理

1.2.1 坐標系與姿態角參數定義

在彈體測量過程中，需要建立兩種空間坐標系：

1）彈體坐標系：以彈的質心為原點，彈體縱軸為Zb軸，在彈的水平面內，垂直Z軸向右為Xb軸，按右手定則確定Yb軸，如圖2，坐標系O-XbYbZb。

2）機體坐標系：以飛機的質心為原點，飛機縱軸為Z軸，在飛機的水平面內，垂直Z軸向右為X軸，按右手定則確定Y軸，如圖2，坐標系O-XYZ。

彈體掛裝姿態參數[3]（見圖2）定義如下：

1）偏航角α：Xb軸在XZ坐標面上的投影與X軸的夾角。

2）俯仰角ω：Xb軸與XZ坐標面之間的夾角。

3）橫滾角κ：Y軸在YbZb坐標面上的投影與Yb軸的夾角。

圖2 姿態定義示意圖

圖3 機體坐標系建立示意圖

1.2.2 機體坐標系與彈體坐標系建立

1）機體坐標系建立

為了建立高精度的機體坐標基準，采用基于測角的空間交會的方法進行[4]。

利用空間交會法測量飛機縱軸上兩點A和B，如圖3所示。計算矢量BA在設備坐標系 （黑色部分）下的方位角θ，然后，將設備坐標系方位零位旋轉至矢量BA方向，原點定于縱軸點A或B[5]。

2）彈體坐標系建立

利用相機結合測量桿的攝影測量方法[6]，探測彈體的圓柱面和吊掛面[7]，基于3-2-1坐標系法構造彈體坐標系[8]。將圓柱面的對稱軸作為彈體的X軸，吊掛面的法向作為Y軸，利用右手定則確定Z軸。

①圓柱面探測算法

圓柱面上的任意一點Pi（xi，yi，zi）到軸線的距離都為半徑R。若中心軸線方向向量為（a，b，c），軸線上起始點為P0（x0，y0，z0），則實測半徑：

誤差方程為

其中ν為坐標觀測值殘差，引入兩個約束條件：

式（3）中x0，y0，z0為利用圓柱面上點計算的重心坐標值，由式（3）、式（4）和式（5），按照最小二乘法進行約束平差，得到圓柱面參數。

②平面探測算法

平面的一般數學表達式為Ax+By+Cz+D=0（C≠0），參數表達式為x=xi+at；y=yi+bt；z=zi+ct；把參數表達式帶入一般表達式中，得到t=a1xi-b1yi-c1zi-d1；若觀測n個測量點，使n個測量點到平面的距離平方和最小的 a1，b1，c1，d1，即是所要求的平面參數[9]。 建立誤差方程ν=AX，然后對ATA進行奇異值分解，最小奇異值對應的奇異值向量即是法向量（a，b，c），則平面方程為

1.2.3 旋轉矩陣分解法

對于機體坐標系，若依次繞Y軸旋轉α，再繞X軸旋轉ω，繞Z軸旋轉κ，即可實現飛機機體坐標系向彈體坐標系的坐標系對齊[10]；反之，若利用對齊算法建立轉換關系，可間接反求3個姿態角；其中，各角度旋轉正方向定義為從坐標系原點沿各軸正向觀察時逆時針旋轉方向。

對齊算法模型采用三維赫爾墨特法，間接反求旋轉矩陣[11]。由旋轉矩陣分解出彈體的掛裝姿態參數α，ω，κ，分解法具體實現如式（7）、式（8）。

2 試驗驗證

本次試驗的被測對象為掛裝的氣象傳感器，傳感器上有等高點（基準孔位），并粘貼圓形標志，分別采用常規計算方法與旋轉矩陣分解法計算傳感器掛裝姿態，分析對比驗證旋轉矩陣計算法的有效性。

2.1 測量過程

1）利用全站儀建立機體坐標基準，并測量傳感器已標定的等高點。

2）利用相機測量設備，采用圓柱面探測法與平面探測法，構建傳感器坐標系；高精度測量傳感器上粘貼的圓形標志點，獲取其在傳感器坐標系下的坐標值。

3）同樣，利用全站儀依次測量粘貼的圓形標志點，獲取其在傳感器坐標系下的坐標值。

2.2 計算方法

1）常規計算法

利用表1數據，采用常規測量方法[8]進行計算，結果如下：

2）旋轉矩陣分解法

利用表2數據，采用三維赫爾墨特法計算旋轉矩陣為

按照式（7）和式（8）分解計算姿態角

表1 基準孔位坐標

3）誤差分析

矩陣分解法的誤差主要體現在兩個方面：傳感器坐標系的構建誤差和旋轉矩陣的計算誤差。

以基準孔位建立的坐標系為標準，檢核探測法建立的坐標系誤差。利用表1與表3中4組對應點數據，對X，Y，Z 3個方向分別求取中誤差為（0.25，0.13， 0.11），綜合誤差

利用三維赫爾墨法反算的旋轉矩陣計算標志點的設備坐標值，將其與實測坐標值作差，如表4所示，誤差小于0.2mm，計算方法同M構。

結合該案例分析，矩陣分解法引起的點位誤差約為0.2+0.3=0.5（mm）；從常規測量方法與旋轉矩陣分解法的計算結果對比可以看出，由點位誤差引起的偏航角誤差Δα=αch-αx=13′26″，俯仰角誤差Δω=ωchωx=4′，橫滾角誤差Δκ=κch-κx=15′44″。該案例中傳感器尺寸與日常測試任務中掛裝彈體尺寸相當，因此，在彈體掛裝試驗中，采用矩陣分解法，姿態角誤差小于0.3°。

表2 圓形標志點坐標

表3 探測法測量基準孔位坐標

表4 基于旋轉矩陣的坐標反算值與實測值對比

3 結束語

彈體初始掛裝姿態測量是掛彈試飛前必做的一項地面標定工作。本文結合工作實際，針對彈體無基準孔位的情況下，提出了一種基于旋轉矩陣分解彈體姿態參數的計算方法，分析表明：1）矩陣分解法是基于彈體坐標系與機體坐標系的空間轉換關系進行間接求取，現場作業具有較強的靈活性；2）傳感器坐標系的構建誤差直接影響矩陣分解法的最終誤差，因此，在測量時，需做好坐標系的構建工作，特別是圓形標志點的空間布局要均勻，且具有一定的密度；3）為提高精度，在測量輔助圓形標志時，應使用單相機加編碼點測量法，交會角度在60°~100°之間；4）矩陣分解法姿態角度誤差小于0.3°，測試方法正確有效，滿足飛行試驗的精度要求。

[1]鄭辛，武少偉，吳亮華.導彈武器慣導系統傳遞對準技術綜述[J].導航定位與授時，2016，3（1）：1-7.

[2]張虎龍，李娟妮.機載火控雷達天線陣面安裝誤差的高精度校準方法[J].現代電子技術，2011，34（19）：4-8.

[3]張力軍，張士峰，楊華波.基于歐拉角觀測模型的航天器姿態確定方法[J].國防科技大學學報，2012，34（6）：84-88.

[4]惠廣裕，武瑞娟.利用雙經緯儀高精度標定機載雷達天線陣面[J].地理空間信息，2015，13（3）：36-38.

[5]武瑞娟，左澤敏，冀芳.一種飛機結構變形測量的新方法[J].科學技術與工程，2015，15（7）：265-269.

[6]何紅麗，陳茜，趙靜.一種高精度飛機形變測量方法[J].測控技術，2014，33（4）：16-18.

[7]譚昌柏.逆向工程中基于特征的實體模型重建關鍵技術研究[D].南京：南京航空航天大學，2006.

[8]王麗秀.飛機柔性裝配制孔設備的工件坐標系建立方法[J].機械設計與制造，2012（4）：229-231.

[9]侯海嘯，惠廣裕，吳衡.飛行試驗機體受載變形靜態檢測技術[J].測控技術，2011，30（1）：149-152.

[10]馮文灝.近景攝影測量[M].武漢：武漢大學出版社，2002：59-71.

[11]李國棟，趙威，田國會.一種基于旋轉矩陣分解的視覺伺服控制算法[J].山東大學學報，2012，42（1）：45-49.

（編輯：李剛）

A new method for measuring the pose of projectile body in initial hanging

ZHANG Hulong
（Chinese Flight Test Establishment，Xi’an 710089，China）

In the missile body flight subjects hanging test，the pose of the missile body needs to be calibrated on the ground.Under the condition of no same high datum hole，a method based on the decomposition of the rotation matrix is proposed.The method only requires the measurement of the basic geometric characteristics of the projectile;the feature detection algorithm，the spatial datum alignment algorithm，and the singular value decomposition algorithm are used comprehensively to deal with the computation;through experimental analysis，the rotation matrix decomposition method can achieve pose parameter accuracy above 0.3°under the condition of no same high datum hole. In order to ensure the accuracy of measurement of pose parameters，the method requires auxiliary circle mark pasted in the projectile，even distribution，moderate number，and improves the robustness of the spatial reference alignment algorithm.The actual test proves that the method is effective，accurate and reliable and fully meets the precision requirements of such tests.

projectile；pose measurement；rotation matrix；decomposition

A

：1674-5124（2017）02-0025-04

10.11857/j.issn.1674-5124.2017.02.005

2016-07-20；

：2016-09-05

張虎龍（1979-），男，湖南岳陽市人，高級工程師，研究方向為光電測試、信息融合、目標跟蹤技術等。