全站儀/INS組合確定FAST饋源艙位姿

張志峰，陳楚湘，詹婉嬋，詹銀虎

(1.信息工程大學(xué) 理學(xué)院，鄭州 450001；2.75711部隊(duì)，廣州 510515；3.信息工程大學(xué) 導(dǎo)航與空天目標(biāo)工程學(xué)院，鄭州 450001)

全站儀/INS組合確定FAST饋源艙位姿

張志峰1，陳楚湘1，詹婉嬋2，詹銀虎3

(1.信息工程大學(xué) 理學(xué)院，鄭州 450001；2.75711部隊(duì)，廣州 510515；3.信息工程大學(xué) 導(dǎo)航與空天目標(biāo)工程學(xué)院，鄭州 450001)

針對目前FAST饋源艙精調(diào)機(jī)構(gòu)的測量主要依賴全站儀測量系統(tǒng)，存在測量頻率較低、無法滿足實(shí)時動態(tài)要求的問題，提出一種全站儀/INS組合位姿確定方法：采用全站儀位姿測量結(jié)果修正INS的累積漂移誤差，實(shí)現(xiàn)測量結(jié)果的實(shí)時動態(tài)更新。仿真計算結(jié)果表明，組合定位方法能夠滿足FAST總體運(yùn)行對饋源艙位姿精度的要求。

FAST；饋源艙；全站儀；慣性導(dǎo)航系統(tǒng)；組合定位

0 引言

中國最大的500 m口徑球面射電望遠(yuǎn)鏡(five hundred meter aperture spherical radio telescope，F(xiàn)SAT)正在貴州省籌建，也是世界上最大的單口徑射電望遠(yuǎn)鏡[1]。饋源艙是FAST工程的核心部件之一，在天文觀測運(yùn)行中，饋源艙由6根鋼索概略拖動至反射面焦點(diǎn)，再通過精調(diào)機(jī)構(gòu)微調(diào)，實(shí)現(xiàn)饋源高精度的定位和指向跟蹤[2]。饋源測量系統(tǒng)的任務(wù)分為2部分：一是在500 m跨度的鋼索結(jié)構(gòu)上，通過一次索驅(qū)動測量實(shí)現(xiàn)饋源艙的概略定位，精度僅要求為cm級，目前傾向于通過基于全球定位系統(tǒng)(global positioning system，GPS)的實(shí)時動態(tài)差分法(real-time kinematic，RTK)實(shí)現(xiàn)[3-4]；二是對饋源艙精調(diào)機(jī)構(gòu)的實(shí)時動態(tài)定位精度達(dá)到4 mm，定姿精度達(dá)到1°，位姿輸出頻率10 Hz，并將測量結(jié)果實(shí)時反饋給控制系統(tǒng)，實(shí)現(xiàn)閉環(huán)控制[5]。由于攝影測量易受外界環(huán)境干擾且動態(tài)識別實(shí)時處理困難，激光跟蹤儀測程有限，而GPS動態(tài)測量精度無法達(dá)到要求；目前提出的精調(diào)機(jī)構(gòu)位姿測量方案中，主要考慮全站儀測量系統(tǒng)[6-8]。但全站儀測量頻率無法達(dá)到10 Hz的要求。

本文提出將全站儀/INS組合定位方法應(yīng)用于饋源艙精調(diào)機(jī)構(gòu)的測量，旨在滿足測量精度的同時，提高系統(tǒng)的位姿輸出頻率。

1 系統(tǒng)組成及測量方案

精調(diào)機(jī)構(gòu)位姿測量系統(tǒng)由全站儀和慣性測量單元(inertial measurement unit，IMU)組成。其中全站儀共9臺，分布JD-13、JD-14、JD-15、JD-17、JD-18、JD-19、JD-21、JD-22和JD-23共9個基墩，如圖1所示，用于獲得采樣率為5 Hz、均方根(root mean square，RMS)為5 mm的測量點(diǎn)位坐標(biāo)。IMU用于獲得10 Hz的精調(diào)機(jī)構(gòu)位姿變化測量結(jié)果，并通過與全站儀測量數(shù)據(jù)的融合處理獲得采樣率為10 Hz、精度為5 mm的精調(diào)機(jī)構(gòu)位姿信息。測量基準(zhǔn)網(wǎng)的絕對定向擬采用天文大地測量的方法得到，精度最高可達(dá)0.3"[9-10]。

精調(diào)機(jī)構(gòu)的全站儀測量系統(tǒng)由位于反射面內(nèi)測量基準(zhǔn)點(diǎn)上的全站儀、位于精調(diào)機(jī)構(gòu)下平臺邊緣的目標(biāo)棱鏡、測量控制及數(shù)據(jù)處理系統(tǒng)、供電通訊線路等組成(如圖2所示)。

在測量實(shí)施時，由測量控制系統(tǒng)控制全站儀照準(zhǔn)對應(yīng)的目標(biāo)棱鏡進(jìn)行測量，獲得動態(tài)測量數(shù)據(jù)，并由數(shù)據(jù)傳輸線傳給數(shù)據(jù)處理系統(tǒng)，通過全站儀動態(tài)測量數(shù)據(jù)處理軟件實(shí)時處理獲得棱鏡的點(diǎn)位坐標(biāo)。用于精調(diào)機(jī)構(gòu)位姿測量的IMU設(shè)備由2臺慣性測量單元構(gòu)成，安置于精調(diào)機(jī)構(gòu)的下平臺上。在測量實(shí)施時，由測量控制系統(tǒng)控制2臺IMU同時工作，實(shí)時獲得精調(diào)機(jī)構(gòu)下平臺的動態(tài)測量數(shù)據(jù)，并由數(shù)據(jù)傳輸線傳給數(shù)據(jù)處理系統(tǒng)。

測量系統(tǒng)工作流程：

1)由測量控制系統(tǒng)向全站儀發(fā)送各種工作指令；

2)全站儀按照動態(tài)測量模式運(yùn)行，一臺全站儀跟蹤一個事先確定的棱鏡，進(jìn)行距離和角度測量，連續(xù)獲得棱鏡中心的距離和水平角、垂直角觀測量，并發(fā)送給數(shù)據(jù)處理系統(tǒng)；

3)數(shù)據(jù)處理系統(tǒng)對每臺全站儀的測量數(shù)據(jù)進(jìn)行實(shí)時處理，獲得每個棱鏡的瞬時位置，進(jìn)而由9個棱鏡的位置計算出精調(diào)機(jī)構(gòu)的瞬時位置、姿態(tài)和對應(yīng)的時間等信息，并發(fā)送給全站儀測量控制系統(tǒng)；

4)全站儀測量控制系統(tǒng)將數(shù)據(jù)處理結(jié)果發(fā)送給測量總控系統(tǒng)。

2 全站儀定位精度分析

擬采用9臺徠卡公司生產(chǎn)的TS30全站儀，采用極坐標(biāo)法仿真測量精調(diào)機(jī)構(gòu)下平臺9個棱鏡。前期測量實(shí)驗(yàn)結(jié)果顯示，低動態(tài)條件下TS30在500 m尺度上的測角精度約為4"(1σ)，測距精度約為2 mm+1×10-6D。 故將仿真觀測條件設(shè)為

(1)

式中：mα、mβ為全站儀測角中誤差；md+為測距固定誤差；md×為測距比例誤差。饋源艙精調(diào)機(jī)構(gòu)的物理半徑按2 m計算，9個棱鏡均勻分布在圓周上。FAST在對天體進(jìn)行跟蹤觀測時，需要在反射面內(nèi)形成300 m口徑的瞬時拋物面，饋源的中心需要調(diào)整到拋物面的焦點(diǎn)上，以此可以計算饋源在水平方向上的移動范圍約為±100 m，如圖3所示。

經(jīng)過統(tǒng)計，圖4給出了全站儀仿真測量位置和姿態(tài)的精度(RMS)，X、Y軸表示饋源在水平方向偏離中心的距離，灰度表示饋源在相應(yīng)位置的定位和定姿精度。

由圖4可知，9個測站的定位精度優(yōu)于2.5 mm，定姿精度優(yōu)于360″，均達(dá)到精調(diào)機(jī)構(gòu)對位姿測量的要求。圖5進(jìn)一步給出了3個坐標(biāo)分量的精度。

由圖5可知，測量系統(tǒng)在水平方向的平均定位精度大約為1.3 mm，垂直方向的平均定位精度大約為1.5 mm。垂直方向的定位精度略低，這與測站的分布及饋源的空間定位結(jié)構(gòu)有關(guān)。

為了檢驗(yàn)測量系統(tǒng)的可靠性，下面采用6個測站跟蹤觀測6個棱鏡，仿真觀測條件不變，結(jié)果如圖6所示。

由圖可知，6個測站的定位精度優(yōu)于3 mm，定姿精度優(yōu)于430″，均達(dá)到精調(diào)機(jī)構(gòu)對位姿測量的要求，說明測量系統(tǒng)在保證測量精度的同時，至少有3個測站可作為備份，系統(tǒng)具有較強(qiáng)的冗余性。

3 IMU測量系統(tǒng)

為分析IMU系統(tǒng)的位置測量精度，利用德國SAS-EI-SN型IMU在靜止?fàn)顟B(tài)下進(jìn)行實(shí)驗(yàn)，該設(shè)備的零偏為0.75(°)/h，隨機(jī)游走為0.1(°)/h；采樣率為200 Hz。獲得的2 s連續(xù)400個采樣的系統(tǒng)緯度、經(jīng)度和高度測量結(jié)果相對于均值的差如圖7所示。

實(shí)驗(yàn)結(jié)果表明，IMU的位置測量誤差主要表現(xiàn)為測量結(jié)果存在系統(tǒng)性的漂移，從圖7中可以看出，2 s的測量數(shù)據(jù)，經(jīng)、緯度測量結(jié)果的漂移達(dá)到2～3 mm，高度結(jié)果的漂移達(dá)到23 mm。

圖8為濾掉1 s測量結(jié)果的線性項(xiàng)和二次項(xiàng)漂移后的殘差圖。

從圖中可以看出，濾掉線性項(xiàng)和二次項(xiàng)漂移后，經(jīng)、緯度和高度測量值的殘差變化離散度都小于0.03 mm。

圖9為在靜止?fàn)顟B(tài)下進(jìn)行實(shí)驗(yàn)獲得的2 s連續(xù)400個采樣的系統(tǒng)姿態(tài)測量結(jié)果相對于均值的變化，包括俯仰、橫滾和航向3個分量。從圖中可以看出，俯仰和橫滾方向的漂移在10″以內(nèi)，而航向角的漂移達(dá)到80″。

圖10是濾掉1 s姿態(tài)測量結(jié)果的線性項(xiàng)和二次項(xiàng)漂移后的殘差圖。

從圖中可以看出，濾掉線性項(xiàng)和二次項(xiàng)漂移后，俯仰、橫滾和航向3個分量的殘差變化離散度都小于3″。

4 測量數(shù)據(jù)融合處理

單臺TS30全站儀動態(tài)測量頻率一般為5 Hz，考慮到全站儀測量系統(tǒng)需要時間同步；因此系統(tǒng)的測量頻率也為5 Hz。對于精調(diào)機(jī)構(gòu)點(diǎn)位精度(RMS)5 mm、姿態(tài)精度1°、測量頻率10 Hz的指標(biāo)要求，需融合全站儀系統(tǒng)和IMU系統(tǒng)的測量數(shù)據(jù)才能實(shí)現(xiàn)。全站儀測量系統(tǒng)定位精度優(yōu)于3 mm、定姿精度優(yōu)于430"的測量結(jié)果可用于修正IMU隨時間漂移產(chǎn)生的定位和定姿累積誤差。在全站儀測量系統(tǒng)連續(xù)2次輸出測量結(jié)果的中間時刻，利用IMU數(shù)據(jù)推估饋源艙精調(diào)機(jī)構(gòu)的位置和姿態(tài)。

下面利用實(shí)測IMU數(shù)據(jù)和仿真的全站儀數(shù)據(jù)對數(shù)據(jù)融合處理結(jié)果的精度進(jìn)行分析。其中，全站儀采樣率取5 Hz，緯度、經(jīng)度和高度3個坐標(biāo)分量的測量精度都取1.5 mm。應(yīng)用數(shù)據(jù)融合處理方案可獲得精調(diào)機(jī)構(gòu)下平臺10 Hz位置測量結(jié)果的殘差分布，如圖11所示。

分析圖中結(jié)果可得，緯度、經(jīng)度和高度3個坐標(biāo)分量的標(biāo)準(zhǔn)差分別為1.6、1.7、1.7 mm，下平臺位置精度為2.9 mm。將位置精度按照2 m尺度換算為姿態(tài)精度，則優(yōu)于0.1°。位置和姿態(tài)精度均滿足FAST總體運(yùn)行要求。

5 結(jié)束語

本文提出將全站儀/INS組合應(yīng)用于FAST饋源艙精調(diào)機(jī)構(gòu)的位姿測量，仿真計算結(jié)果表明，二者組合后的定位精度為2.9 mm，定姿精度優(yōu)于0.1°，位姿輸出頻率為10 Hz，完全滿足FAST總體運(yùn)行對饋源艙位姿精度的要求。研究結(jié)果可以為FAST饋源艙測量系統(tǒng)的優(yōu)化提供參考。

[1] NAN R D.Five hundred meter aperture spherical radio telescope (FAST)[J].Science in China Series G：Physics Mechanics and Astronomy，2006，49(2)：129-148.

[2] 朱麗春.500米口徑球面射電望遠(yuǎn)鏡(FAST)測量與控制研究[D].北京：中國科學(xué)院國家天文臺，2006：1-10.

[3] 王文利，段寶巖.載波相位差分技術(shù)在饋源艙動態(tài)定位中的應(yīng)用[J].測繪學(xué)報，2000，29(1)：89-92.

[4] 詹銀虎，鄭勇，張超，等.GNSS-RTK技術(shù)在FAST饋源艙測量中的可行性研究[J].測繪通報，2013(10)：29-33.

[5] 詹銀虎，鄭勇，張超，等.FAST饋源艙精調(diào)機(jī)構(gòu)位姿測量系統(tǒng)性能分析[J].測繪通報，2015(2)：23-28.

[6] 駱亞波.測量機(jī)器人在FAST饋源動態(tài)跟蹤測量中的應(yīng)用[D].鄭州：信息工程大學(xué)，2003：23-30.

[7] 駱亞波，鄭勇，夏治國，等.測量機(jī)器人動態(tài)測量技術(shù)及應(yīng)用研究[J].測繪通報，2006(9)：14-18.

[8] 駱亞波，紀(jì)文亮，何峰.大射電望遠(yuǎn)鏡饋源系統(tǒng)精調(diào)平臺位置基準(zhǔn)標(biāo)定[J].測繪科學(xué)技術(shù)學(xué)報，2007，24(6)：402-405.

[9] 詹銀虎，鄭勇，張超，等．一種亮星識別算法及其在天文定向中的應(yīng)用[J].測繪學(xué)報，2015，44(3)：257-263.

[10]詹銀虎，鄭勇，張超，等．超大視場太陽敏感器圖像質(zhì)心提取算法[J].測繪學(xué)報，2015，44(10)：1078-1084.

Total stations/INS integrated method for measurement of FAST feed cabin

ZHANGZhifeng1，CHENChuxiang1，ZHANWanchan2，ZHANYinhu3

(1.College of Science，Information Engineering University，Zhengzhou 450001，China；2.Troops75711，Guangzhou 510515，China；3.College of Navigation and Aerospace Engineering，Information Engineering University，Zhengzhou 450001，China)

Aiming at the problem that the measurement of FAST feed cabin mainly uses total stations with low surveying frequency，which can not satisfy the needs of real-time conduction，the paper proposed an integrated measure method of total stations and INS：the positioning and attitude determination results of total station was used to correct the accumulative drift error of INS，in order to realize the real-time update of the surveying.Simulative calculations indicated that the integrated method could meet the accuracy requirement of the position and attitude determination of FAST feed cabin.

FAST；feed cabin；total station；INS；integrated positioning

2016-10-28

張志峰(1989—)，男，河南焦作人，碩士，助教，研究方向?yàn)楣こ虦y量、運(yùn)籌學(xué)。

張志峰，陳楚湘，詹婉嬋，等.全站儀/INS組合確定FAST饋源艙位姿[J].導(dǎo)航定位學(xué)報，2017，5(3)：105-110.(ZHANG Zhifeng，CHEN Chuxiang，ZHAN Wanchan，et al.Total stations/INS integrated method for the measurement of FAST’s feed cabin[J].Journal of Navigation and Positioning，2017，5(3)：105-110.)

10.16547/j.cnki.10-1096.20170321.

P228

A

2095-4999(2016)03-0105-05