龐岳峰，霍文杰，張彬艷，馬占順

一種基于RTK的遙測設(shè)備方位零位標(biāo)定方法*

龐岳峰，霍文杰，張彬艷，馬占順

（酒泉衛(wèi)星發(fā)射中心 酒泉 732750）

針對現(xiàn)有遙測設(shè)備方位零位標(biāo)定方法不滿足機(jī)動測控需求的問題，提出一種基于旋翼無人機(jī)及實時動態(tài)RTK載波相位差分技術(shù)的遙測設(shè)備方位零位標(biāo)定方法，推導(dǎo)測向關(guān)鍵算法，完成方位零位標(biāo)定系統(tǒng)設(shè)計。通過采用數(shù)據(jù)同步匹配、異常值剔除及隨機(jī)誤差平滑等算法提高標(biāo)定精度。測試及分析結(jié)果表明，采用該方法的方位零位標(biāo)定精度可滿足當(dāng)前S頻段和Ka頻段遙測設(shè)備要求。

方位零位；旋翼無人機(jī)；RTK；遙測設(shè)備

引 言

實時動態(tài)RTK（Real-Time Kinematic）載波相位差分技術(shù)是基于載波相位觀測值的實時動態(tài)定位技術(shù)，能夠?qū)崟r得到厘米級的定位精度[1,2]。其優(yōu)勢是在消除衛(wèi)星軌道?鐘差等殘余誤差[3,4]的同時可以實時估計電離層參數(shù)或采用高精度電離層改正數(shù)來削弱其影響[5]。

為了實現(xiàn)目標(biāo)捕獲與跟蹤，車載遙測設(shè)備到達(dá)布站位置后，要標(biāo)定天線方位零位偏差。當(dāng)前，部分車載遙測設(shè)備無尋北功能，在外場執(zhí)行任務(wù)時，現(xiàn)有的方位零位偏差標(biāo)定方法不能兼顧標(biāo)定精度和對機(jī)動測控設(shè)備快速標(biāo)校的需求。針對該問題，研究了采用小型旋翼無人機(jī)及RTK載波相位差分技術(shù)來實現(xiàn)方位零位偏差修正的方法，完成了低成本、高精度遙測設(shè)備方位零位標(biāo)定系統(tǒng)設(shè)計。

1 遙測設(shè)備方位零位偏差

2 基于RTK技術(shù)的方位零位標(biāo)定系統(tǒng)設(shè)計

隨著我國北斗系統(tǒng)全面建成，多系統(tǒng)多頻信號RTK測向的優(yōu)勢更加明顯，多頻多模觀測信號將大大減弱環(huán)境限制對RTK技術(shù)的影響，提高定位測向的精度和可用性[6-8]。單個GNSS接收機(jī)可確定位置，兩個以上GNSS接收機(jī)可測向，據(jù)此原理設(shè)計基于RTK測向技術(shù)的遙測設(shè)備方位零位標(biāo)定系統(tǒng)。

圖1 方位零位偏差定義

2.1 方位零位標(biāo)定系統(tǒng)組成

方位零位標(biāo)定系統(tǒng)由旋翼無人機(jī)、RTK移動端、RTK基準(zhǔn)站及數(shù)據(jù)處理終端組成。RTK基準(zhǔn)站接基準(zhǔn)天線和測向天線，可作為獨(dú)立的測向單元使用。在遙測設(shè)備機(jī)械零位已校準(zhǔn)的前提下，采用基準(zhǔn)、測向天線測量出的設(shè)備車尾方位即方位零位偏差，由于這種測量方式基線較短，方位零位偏差測量精度在0.1°左右。

在需要進(jìn)一步提高方位零位偏差測量精度時，采用無人機(jī)搭載RTK移動端的模式，RTK基準(zhǔn)站基準(zhǔn)、測向天線與RTK移動端位置信息進(jìn)行聯(lián)合解算完成。測量時將基準(zhǔn)端天線安放在設(shè)備車體上，無人機(jī)搭載RTK移動端懸停，無人機(jī)動力及所搭載設(shè)備供電統(tǒng)一由無人機(jī)電源模塊提供。采用數(shù)傳電臺把基準(zhǔn)站的觀測信息連續(xù)傳給移動端，移動端通過電臺接收觀測數(shù)據(jù)，解算后實時得到三維坐標(biāo)、基線長度和方位信息并向地面數(shù)據(jù)處理終端發(fā)送，同時數(shù)據(jù)處理終端通過電臺發(fā)送無人機(jī)控制信息和信標(biāo)設(shè)置命令。這種動態(tài)測量模式一般要求基準(zhǔn)站和移動站同時接收到5顆以上的衛(wèi)星，遙測設(shè)備方位零位標(biāo)定系統(tǒng)組成如圖2所示。

圖2 方位零位標(biāo)定系統(tǒng)示意圖

基準(zhǔn)站由主機(jī)、電源模塊和電臺組成。RTK板卡接收衛(wèi)星信號，并接收所有衛(wèi)星的RTK改正數(shù)據(jù)，然后按照RTCM的標(biāo)準(zhǔn)格式通過串口發(fā)送給數(shù)傳電臺，數(shù)傳電臺將改正數(shù)據(jù)發(fā)送給RTK移動端，供其進(jìn)行實時載波相位差分。RTK基準(zhǔn)站組成見圖3、板卡實物見圖5。

圖3 RTK基準(zhǔn)站組成示意圖

無人機(jī)及RTK移動端由旋翼無人機(jī)、數(shù)傳電臺和RTK移動端組成。RTK移動端與RTK基準(zhǔn)站主要有兩方面區(qū)別:一是為減小移動端體積，延長電池使用時間，采用小型化設(shè)計；二是為方便野外作業(yè)，RTK移動端可選擇采用無人機(jī)電源供電或外接電池供電。移動端接收衛(wèi)星信號，并接收基準(zhǔn)站發(fā)送的改正數(shù)據(jù)，進(jìn)行實時載波相位差分，從而獲得高精度基線測向?；鶞?zhǔn)站和移動端的RTK板卡采用2018年上市的ZED-F9P芯片；數(shù)傳電臺采用XBee模塊XPB9B，其傳輸實測距離大于1200m；Ingenic X1000微處理器完成相關(guān)運(yùn)算和通信參數(shù)設(shè)置。無人機(jī)及RTK移動端組成關(guān)系如圖4所示。

圖4 RTK移動端組成示意圖

圖5 RTK基準(zhǔn)站板卡實物圖

2.2 測向解算流程設(shè)計

方位零位標(biāo)定的前提是求解基線向量。計算的流程是首先利用三差求出近似的基線長度，再利用浮動雙差法求出相位模糊度和基線矢量，將求得的相位模糊度湊整后，進(jìn)行固定雙差的解算，最后求解出精密基線向量[9-11]。移動端電臺將接收到的改正數(shù)據(jù)通過串口送達(dá)開發(fā)板，移動端同時進(jìn)行衛(wèi)星觀測、解算衛(wèi)星位置，在選星及周跳探測后建立雙差觀測方程，然后通過確定單個天線的載波相位整周模糊度，進(jìn)而確定雙天線的載波相位整周模糊度單差，完成基線解算及精度計算后輸出結(jié)果，處理結(jié)果發(fā)送模塊將測向值通過串口發(fā)送給電臺?；谳d波相位的差分測向解算流程如圖6所示。

圖6 基于載波相位差分的測向流程圖

2.3 方位位標(biāo)定方法

為提高測量精度，標(biāo)定時需獲得遙測天線站址中心相對于RTK基準(zhǔn)天線的坐標(biāo)，該參數(shù)可用幾何學(xué)原理求得。方位零位標(biāo)定時，基準(zhǔn)端接基準(zhǔn)天線和測向天線，兩天線放置于遙測天線站址中心同一水平面內(nèi)，與站址中心構(gòu)成一個形狀固定的三角形?；鶞?zhǔn)和測向天線的位置通過測量得到，通過坐標(biāo)轉(zhuǎn)換以及三角形余弦定理，計算出遙測天線的相對站址坐標(biāo)。無人機(jī)搭載RTK移動端和信標(biāo)機(jī)在車體外一定距離懸停（圖7），具體步驟如下：

圖7 RTK測量標(biāo)定方位零位示意圖

①為遙測天線站址中心，事先已測定0、1長度和∠12角度。

②在天線載車1處放置RTK基準(zhǔn)端基準(zhǔn)天線，2處放置基準(zhǔn)端測向天線，無人機(jī)搭載RTK移動端懸停，為無人機(jī)懸停點(diǎn)在12投影面上的投影點(diǎn)，載波相位差分測定1、2、1、2，依據(jù)1、2及0可解算出角度∠21（余弦定理）。

③三角形1中，已知兩邊一夾角（1、1、∠O1），計算出∠1。

④計算出天線相對于正北的方位角=∠1+∠1。

⑥控制無人機(jī)改變懸停位置，重復(fù)步驟②至步驟⑤，同樣方法進(jìn)行三次標(biāo)定，取均值作為正式值。

3 方位零位標(biāo)定系統(tǒng)關(guān)鍵算法

考慮無人機(jī)懸停精度易受外界條件影響，地面處理終端通過實時接收處理遙測設(shè)備伺服跟蹤數(shù)據(jù)和RTK數(shù)據(jù)得出方位零位偏差，通過對遙測設(shè)備伺服跟蹤數(shù)據(jù)和RTK數(shù)據(jù)的時間對齊、插值、野值剔除、平滑等算法提高測量精度。

3.1 RTK測向結(jié)果計算

RTK測向計算過程在數(shù)據(jù)處理終端實現(xiàn)，基準(zhǔn)站及移動端定位信息通過電臺發(fā)送至數(shù)據(jù)處理終端后由終端計算基線方向。由于遙測設(shè)備采用的是站心坐標(biāo)系，需要進(jìn)行坐標(biāo)轉(zhuǎn)換，具體步驟如下。

步驟1：坐標(biāo)轉(zhuǎn)換根據(jù)基準(zhǔn)站記錄的位置信息（經(jīng)度c、緯度c、高程c），將它轉(zhuǎn)換成地心固連系位置參數(shù)。具體公式如下：

步驟2：將移動端由大地直角坐標(biāo)系轉(zhuǎn)換為移動端相對于基準(zhǔn)站的東北天坐標(biāo)(,,)公式如下：

步驟3：按照下式計算方位角、俯仰角和距離：

其中、具有方向性，的不同符號與方位角計算關(guān)系見表1，方位角度轉(zhuǎn)換完成后，可以得到移動站相對于基準(zhǔn)站的距離、方位和俯仰。

表1 方位角符號與計算關(guān)系

3.2 數(shù)據(jù)同步及匹配

由于RTK測量數(shù)據(jù)和遙測設(shè)備測角數(shù)據(jù)的傳輸頻率不同，因此需進(jìn)行數(shù)據(jù)同步和匹配。數(shù)據(jù)同步主要是為保證兩數(shù)據(jù)時間的對齊，在此以移動端收星時間作為同步基準(zhǔn)。遙測測角的采樣率和RTK定位信息的采樣率不同，并且在測量數(shù)據(jù)記錄的過程中，可能會有某個點(diǎn)的數(shù)據(jù)沒有被記錄到，所以在時間對齊后還需要進(jìn)行采樣率匹配，以實現(xiàn)數(shù)據(jù)同步。

遙測測角的采樣率為每秒20次，RTK測量數(shù)據(jù)傳輸為每秒5次，工程中還需要進(jìn)行插值。RTK測量數(shù)據(jù)插值選擇Neville算法，發(fā)揮其模型簡單、計算量小的優(yōu)勢。具體插值方法可參考文獻(xiàn)[12]，此處不再贅述。

3.3 測量數(shù)據(jù)隨機(jī)誤差平滑

平滑計算的目的是減小隨機(jī)誤差。遙測設(shè)備測量數(shù)據(jù)和RTK測量數(shù)據(jù)常帶有隨機(jī)誤差，需要對測量數(shù)據(jù)進(jìn)行平滑處理，以提高求解精度，本文采取多項式平滑方法。

設(shè)一組測量數(shù)據(jù){i，i}（=1，2···，），（i為采樣時間，i為測量數(shù)據(jù)），設(shè)多項式為

通過最小二乘法原理使偏差最小，即

根據(jù)求極值方法，將式（4）代入式（5），并求偏導(dǎo)數(shù)得出：

3.4 異常值的檢測與剔除

4 標(biāo)定精度測試與分析

4.1 RTK測向精度

利用經(jīng)過大地精確測量的點(diǎn)位，分別對96.2m、422.5m和807.7m基線下RTK測向精度進(jìn)行了測試。96.2m基線精度為0.015°，422.5m基線精度為0.004°，807.7m基線精度為0.002°。結(jié)果表明測向精度與基線長度具有很大的相關(guān)性，基線越長計算的精度越高。為保證方位角計算的精確度，在有效距離內(nèi)應(yīng)盡量增加基線長度。

4.2 無人機(jī)懸停精度

對無人機(jī)搭載移動端懸停進(jìn)行精度測試，無人機(jī)型號為大疆M600 pro，選擇基線距離為800m左右的5個不同懸停位置進(jìn)行測試，每次懸停時間180s，每秒記錄5組數(shù)據(jù)。統(tǒng)計懸停時段的方位最大差及均方差，測試結(jié)果反映無人機(jī)懸停的水平方向均方差在0.026°~0.029°之間，見表2。

表2 無人機(jī)懸停精度（方位）

4.3 方位零位標(biāo)定精度

在某S頻段5.2m天線口徑車載遙測設(shè)備上進(jìn)行方位零位標(biāo)定精度測試，測試前采用方位標(biāo)對設(shè)備方位零位偏差進(jìn)行校準(zhǔn)，以此校準(zhǔn)值為方位零位偏差真值，然后采用無人機(jī)搭載RTK移動端標(biāo)定方法進(jìn)行重新標(biāo)定。選用兩套設(shè)備進(jìn)行精度測試，每套設(shè)備進(jìn)行3次標(biāo)定。3次標(biāo)定時無人機(jī)懸停方位不同，但無人機(jī)與待標(biāo)定設(shè)備距離均保持在800m左右，標(biāo)定結(jié)果如表3。

表3 方位零位標(biāo)定精度

進(jìn)一步對圖7中參與推導(dǎo)方位零位的各項誤差進(jìn)行分析，影響方位零位標(biāo)定精度的變量為1及2誤差、0及1測量誤差、標(biāo)校電視測量誤差、無人機(jī)懸停水平精度和RTK移動端測量精度。已測得方位零位標(biāo)定精度小于0.049°，滿足現(xiàn)有S頻段車載遙測設(shè)備的標(biāo)定要求。大疆M600 pro懸停引入誤差為0.029°，屬于主要誤差源。所以采用具有RTK差分功能的無人機(jī)后，方位零位標(biāo)定精度還會明顯提高。

5 結(jié)束語

移動端還設(shè)計了一個小型信標(biāo)機(jī)。該信標(biāo)機(jī)在方位零位標(biāo)定功能中并未用到，但它是實現(xiàn)定向靈敏度標(biāo)定和光電軸校準(zhǔn)的必要器件，為后續(xù)功能拓展提供支持。本文精度測試所采用的大疆M600 pro無人機(jī)水平懸停精度為1.5m，如果采用具備RTK差分功能的無人機(jī)，其水平懸停精度可提高一個數(shù)量級，再通過改用高精度標(biāo)校望遠(yuǎn)鏡、加長基線距離、提高基準(zhǔn)站天線安裝精度等措施后，該標(biāo)定系統(tǒng)方位零位標(biāo)定精度可滿足Ka頻段遙測系統(tǒng)不大于0.01°的方位零位標(biāo)定精度要求。

[1] 張寶成. GNSS非差非組合精密單點(diǎn)定位的理論方法與應(yīng)用研究[J]. 測繪學(xué)報, 2014, 43(10): 1099. ZHANG Baocheng. Study on the oretical methodology and applications of precise point positioning using un-differenced and uncombined GNSS data[J]. Acta Geodaetica et Cartographica Sinica, 2014, 43(10): 1099.

[2] 王世進(jìn), 秘金鐘, 李得海, 等. GPS/BDS的RTK定位算法研究[J]. 武漢大學(xué)學(xué)報信息科學(xué)版, 2014, 39(5): 621–625. WANG Shijin, MI Jinzhong, LI Dehai, et al. Real-time kinematic positioning algorithm of GPS/BDS[J]. Geomatics and Information Science of Wuhan University, 2014, 39(5): 621–625.

[3] 鄒璇, 唐衛(wèi)明, 葛茂榮, 等. 基于非差觀測的網(wǎng)絡(luò)實時動態(tài)定位方法及其在連續(xù)運(yùn)行基準(zhǔn)站跨網(wǎng)服務(wù)中的應(yīng)用[J]. 測繪學(xué)報, 2011, 40(s1): 1–5. ZOU Xuan, TANG Weiming, GE Maorong, et al. Method of network RTK based on un-differenced observation corrections and its functional realization in cross CORS service[J]. Acta Geodaetica et Cartographica Sinica, 2011, 40(s1): 1–5.

[4] 鄢子平, 丁樂樂, 黃恩興, 等. 網(wǎng)絡(luò)RTK參考站間模糊度固定新方法[J]. 武漢大學(xué)學(xué)報信息科學(xué)版, 2013, 38(3): 295–298. YAN Ziping, DING Lele, HUANG Enxing, et al. A new method of ambiguity resolution in network RTK between reference stations[J]. Geomatics and Information Science of Wuhan University, 2013, 38(3): 295–298.

[5] LI Xingxing, GE Maorong, ZHANG Hongping, et al. The GFZ real-time GNSS precise positioning service system and its adaption for COMPASS[J]. Advances in Space Research, 2013, 51(6): 1008–1018.

[6] 姚宜斌, 胡明賢, 許超鈐. 基于DREAMNET的GPS/BDS/GLONASS多系統(tǒng)網(wǎng)絡(luò)RTK定位性能分析[J]. 測繪學(xué)報, 2016, 45(9): 1009–1018. YAO Yibin, HU Mingxian, XU Chaoqian. Algorithm and positioning accuracy analysis of GPS/BDS/GLONASSF network RTK nased on DREAMNET[J]. Acta Geodaetica et Cartographica Sinica, 2016, 45(9): 1009–1018.

[7] 何俊, 袁小玲, 曾琪, 等. GPS/BDS/GLONASS組合單點(diǎn)定位研究[J]. 測繪科學(xué), 2014, 39(8): 124–128, 170. HE Jun, YUAN Xiaoling, ZENG Qi, et al. Study of GPS/BDS/GLONASS combined single point localization[J]. Science of Surveying and Mapping, 2014, 39(8): 124–128, 170.

[8] 李豹, 許江寧, 曹可勁, 等. 改進(jìn)LAMBDA算法實現(xiàn)單頻GPS整周模糊度快速解算[J]. 中國慣性技術(shù)學(xué)報, 2013, 21(3): 365–368. LI Bao, XU Jiangning, CAO Kejing, et al. A fast resolution of single frequency GPS integer ambiguity realized by improved LAMBDA algorithm[J]. Journal of Chinese Inertial Technology, 2013, 21(3): 365–368.

[9] WILLI D, ROTHACHER M. GNSS attitude determination with non-synchronized receivers and short baselines on board a spacecraft[J]. GNSS Solutions, 2017, 21(4): 1605–1617.

[10] 席志紅, 耿更飛, 付存利. 一種基于雙天線的北斗定位系統(tǒng)設(shè)計與實現(xiàn)[J]. 電子科技, 2014, 27(8): 101–104. XI Zhihong, GEN Gengfei, FU Cunli. Design and implement of Beidou positioning system based on double antenna[J]. Electronic Science and Technology, 2014, 27(8): 101–104.

[11] 吳玉平, 王建華, 楊釗. 基于雙天線的高精度GPS定位測向系統(tǒng)及其在無人水面艇上的應(yīng)用[J]. 計算機(jī)測量與控制, 2015, 23(4): 1330–1332. WU Yuping, WANG Jianhua, YANG Zhao. High precision GPS system based on double antennas and its application in unmanned surface vessel[J]. Computer Measurement & Control, 2015, 23(4): 1330–1332.

[12] 龐岳峰, 吳小東, 牛攀峰. 測控設(shè)備引導(dǎo)跟蹤數(shù)據(jù)插值方法[J]. 電子科技, 2016, 29(11): 118–121. PANG Yuefeng, WU Xiaodong, NIU Panfeng. Measurement and control equipment tracking data interpolation method[J]. Electronic Science and Technology, 2016, 29(11): 118–121.

Azimuth zero position calibration method of telemetry equipment based on RTK surveying technology

PANG Yuefeng, HUO Wenjie, ZHANG Binyan, MA Zhanshun

（Jiuquan Satellite Launch Center, Jiuquan 732750, China）

In order to solve the problem that the azimuth zero position calibration method of current telemetry equipment doesn't meet the requirements of mobile measurement and control, this paper proposes an azimuth zero position calibration method based on rotor UAV and RTK surveying technology. The key algorithm of direction finding is deduced and the design of azimuth zero calibration system is completed. The calibration accuracy is improved by using the algorithms of data synchronization matching, outlier elimination and random error smoothing. The test result shows that the calibration accuracy of this method can meet the requirements of current telemetry equipment in S and Ka frequency bands.

Azimuth zero position; Rotor UAV; RTK; Telemetry equipment

V556.1

A

CN11-1780(2020)02-0068-07

酒泉衛(wèi)星發(fā)射中心科研基金（2018ZKZ003）

2020-03-17

Email:ycyk704@163.com

TEL:010-68382327 010-68382557

龐岳峰 1980年生，碩士，工程師，主要研究方向為無線電測控技術(shù)。

霍文杰 1988年生，碩士，助理工程師，主要研究方向為航天工程。

張彬艷 1979年生，碩士，工程師，主要研究方向為信號與信息處理。

馬占順 1994年生，本科，助理工程師，主要研究方向為無線電測控技術(shù)。