留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

车载三天线GNSS的直接法定姿及精度评估

蔡小波 许厚泽 王勇 柴华 丁磊香

蔡小波, 许厚泽, 王勇, 柴华, 丁磊香. 车载三天线GNSS的直接法定姿及精度评估[J]. 武汉大学学报 ● 信息科学版, 2018, 43(6): 820-825. doi: 10.13203/j.whugis20160171
引用本文: 蔡小波, 许厚泽, 王勇, 柴华, 丁磊香. 车载三天线GNSS的直接法定姿及精度评估[J]. 武汉大学学报 ● 信息科学版, 2018, 43(6): 820-825. doi: 10.13203/j.whugis20160171
CAI Xiaobo, XU Houze, WANG Yong, CHAI Hua, DING Leixiang. Direct Attitude Determination Method Based on Vehicle-mounted Three-antenna GNSS and the Accuracy Evaluation[J]. Geomatics and Information Science of Wuhan University, 2018, 43(6): 820-825. doi: 10.13203/j.whugis20160171
Citation: CAI Xiaobo, XU Houze, WANG Yong, CHAI Hua, DING Leixiang. Direct Attitude Determination Method Based on Vehicle-mounted Three-antenna GNSS and the Accuracy Evaluation[J]. Geomatics and Information Science of Wuhan University, 2018, 43(6): 820-825. doi: 10.13203/j.whugis20160171

车载三天线GNSS的直接法定姿及精度评估

doi: 10.13203/j.whugis20160171
基金项目: 

国家自然科学基金 41274084

详细信息
    作者简介:

    蔡小波, 博士生, 主要从事GNSS/INS组合导航研究。caixb2006@126.com

  • 中图分类号: P228

Direct Attitude Determination Method Based on Vehicle-mounted Three-antenna GNSS and the Accuracy Evaluation

Funds: 

The National Natural Science Foundation of China 41274084

More Information
    Author Bio:

    CAI Xiaobo, PhD candidate, specializes in GNSS/INS integrated navigation. E-mail: caixb2006@126.com

  • 摘要: 针对移动测量系统对载体姿态的需求,对车载三天线全球卫星导航系统(global navigation satellite system,GNSS)的直接法定姿进行了研究。分析了定姿的原理,给出了姿态解算公式,并提出一种简便的方法确定航向角的象限,解决了航向角的多值性问题。为了评估该方法的精度,利用车载的三天线GNSS进行了动态实验,采集了动态观测数据,利用直接法对观测数据进行了姿态解算,并用同车搭载的一套高精度惯性导航系统(inertial navigation system,INS)给出的姿态参考值对三天线GNSS定姿的精度和可靠性进行了评估。结果表明,三天线GNSS直接法定姿精度高、可靠性好,并具有计算简便,可避免奇异性问题等优点。
  • 图  1  载体坐标系及三天线示意图

    Figure  1.  Illustration of Body-frame and Three-antenna

    图  2  航向角象限判定

    Figure  2.  Quadrant Determination of the Yaw Angle

    图  3  三天线GNSS测得的航向角与高精度INS的比较

    Figure  3.  Comparison of the Yaw Angle Determined from Three-antenna GNSS and INS

    图  4  三天线GNSS测得的俯仰角与高精度INS的比较

    Figure  4.  Comparison of the Pitch Angle Determined from Three-antenna GNSS and INS

    图  5  三天线GNSS测得的横滚角与高精度INS的比较

    Figure  5.  Comparison of the Roll Angle Determined from Three-antenna GNSS and INS

    图  6  三天线GNSS定姿的误差

    Figure  6.  Errors of the Attitude Determined from Three-antenna GNSS

    表  1  航向角符号与x12, ny12, n的关系

    Table  1.   Relationship Between the Sign of the Yaw Angle and x12, n, y12, n

    x12, n的符号 y12, n的符号 象限 航向角γ取值
    + + 0°~90° γ0
    + - 90°~180° γ0+180°
    - - 180°~270° γ0+180°
    - + 270°~360° γ0+360°
    下载: 导出CSV

    表  2  姿态角误差统计/(°)

    Table  2.   Statistics of the Attitude Error/(°)

    航向角 俯仰角 横滚角
    最大值 1.121 3.999 12.651
    最小值 -1.898 -5.666 -16.013
    标准差 0.168 0.397 0.974
    下载: 导出CSV
  • [1] Madeira S, Gonçalves J, Bastos L. Accurate DTM Generation in Sand Beaches Using Mobile Mapping[J]. Journal of Coastal Conservation, 2013, 17(3):579-588 doi:  10.1007/s11852-013-0256-1
    [2] Kukko A, Kaartinen H, Hyyppä J, et al. Multiplatform Mobile Laser Scanning:Usability and Performance[J]. Sensors, 2012, 12(9):11712-11733 doi:  10.3390/s120911712
    [3] Li Y, Efatmaneshnik M, Dempster A. Attitude Determination by Integration of MEMS Inertial Sensors and GPS for Autonomous Agriculture Applications[J]. GPS Solutions, 2012, 16(1):41-52 doi:  10.1007/s10291-011-0207-y
    [4] 吴富梅, 聂建亮, 何正斌.低成本车载GPS/INS组合导航姿态角更新算法[J].中国惯性技术学报, 2010, 18(6):675-679 http://www.cqvip.com/Main/Detail.aspx?id=36657417

    Wu Fumei, Nie Jianliang, He Zhengbin. Low-cost GPS/INS Integrated Navigation Algorithm in Land Vehicle System Considering Attitude Update[J].Journal of Chinese Inertial Technology, 2010, 18(6):675-679 http://www.cqvip.com/Main/Detail.aspx?id=36657417
    [5] Liu S, Sun F, Zhang L, et al. Tight Integration of Ambiguity-fixed PPP and INS:Model Description and Initial Results[J]. GPS Solutions, 2016, 20(1):39-49 doi:  10.1007/s10291-015-0464-2
    [6] Rabbou M A, El-Rabbany A. Tightly Coupled Integration of GPS Precise Point Positioning and MEMS-based Inertial Systems[J]. GPS Solutions, 2015, 19(4):601-609 doi:  10.1007/s10291-014-0415-3
    [7] Wu Z, Yao M, Ma H, et al. Low-cost Attitude Estimation with MIMU and Two-antenna GPS for Satcom-on-the-Move[J]. GPS Solutions, 2013, 17(1):75-87 doi:  10.1007/s10291-012-0262-z
    [8] Hide C, Pinchin J, Park D. Development of a Low Cost Multiple GPS Antenna Attitude System[C]. The 20th International Technical Meeting of the Satellite Division of The Institute of Navigation, Manassas, VA, 2007
    [9] Aleshechkin A. Algorithm of GNSS-based Attitude Determination[J]. Gyroscopy and Navigation, 2011, 2(4):269-276 doi:  10.1134/S207510871104002X
    [10] Teunissen P J G. The Affine Constrained GNSS Attitude Model and Its Multivariate Integer Least-squares Solution[J]. Journal of Geodesy, 2012, 86(7):547-563 doi:  10.1007/s00190-011-0538-z
    [11] Tenn H K, Jan S S, Hsiao F B. Pitch and Roll Attitude Estimation of a Small-scaled Helicopter Using Single Antenna GPS with Gyroscopes[J]. GPS Solutions, 2009, 13(3):209-220 doi:  10.1007/s10291-008-0114-z
    [12] 刘根友, 欧吉坤. GPS单历元定向和测姿算法及其精度分析[J].武汉大学学报·信息科学版, 2003, 28(6):732-735 http://ch.whu.edu.cn/CN/abstract/abstract4852.shtml

    Liu Genyou, Ou Jikun. Determining Attitude with Single Epoch GPS Algorithm and Its Precision Ana-lysis[J]. Geomatics and Information Science of Wuhan University, 2003, 28(6):732-735 http://ch.whu.edu.cn/CN/abstract/abstract4852.shtml
    [13] Axelrad P, Ward L M. Spacecraft Attitude Estimation Using the Global Positioning System:Metho-dology and Results for RADCAL[J]. Journal of Guidance, Control and Dynamics, 1996, 19(6):1201-1209 doi:  10.2514/3.21772
    [14] Chen W, Qin H. New Method for Single Epoch, Single Frequency Land Vehicle Attitude Determination Using Low-end GPS Receiver[J]. GPS Solutions, 2012, 16(3):329-338 doi:  10.1007/s10291-011-0234-8
    [15] Wang Y, Zhang X, Zhang Y. Improved Ambiguity Function Method Based on Analytical Resolution for GPS Attitude Determination[J]. Measurement Science and Technology, 2007, 18(9):2986-2990 http://iopscience.iop.org/0957-0233/18/9/032
    [16] Ballal T, Bleakley C J. GNSS Instantaneous Ambiguity Resolution and Attitude Determination Exploiting the Receiver Antenna Configuration[J]. IEEE Transactions on Aerospace and Electronic Systems, 2014, 50(3):2061-2069 doi:  10.1109/TAES.2014.120120
    [17] 曲建铭, 秦红磊, 金天, 等.基于基线约束及递推多历元的改进GNSS定姿技术[J].解放军理工大学学报(自然科学版), 2014, 15(5):428-433 http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=jfjlgdxxb201405004

    Qu Jianming, Qin Honglei, Jin Tian, et al. Improved Attitude Determination Technique of GNSS Based on Baseline Constraint and Recursive Multiple-epoch[J]. Journal of PLA University of Science and Technology (Natural Science Edition), 2014, 15(5):428-433 http://www.wanfangdata.com.cn/details/detail.do?_type=perio&id=jfjlgdxxb201405004
    [18] Lu G. Development of a GPS Multi-antenna System for Attitude Determination[D]. Calgary: University of Calgary, 1995
    [19] 何海波. 高精度GPS动态测量及质量控制[D]. 郑州: 信息工程大学, 2002

    He Haibo. Precise Kinematic GPS Surveying and Quality Control[D]. Zhengzhou: Information Engineering University, 2002
    [20] 王冰, 隋立芬, 张清华, 等.利用GPS解算载体测姿的算法研究[J].武汉大学学报·信息科学版, 2013, 38(12):1392-1395 http://ch.whu.edu.cn/CN/abstract/abstract2817.shtml

    Wang Bing, Sui Lifen, Zhang Qinghua, et al. Research on Attitude Determination Algorithms Using GPS[J]. Geomatics and Information Science of Wuhan University, 2013, 38(12):1392-1395 http://ch.whu.edu.cn/CN/abstract/abstract2817.shtml
    [21] 秦永元.惯性导航[M].北京:科学出版社, 2006

    Qin Yongyuan. Inertial Navigation[M]. Beijing:Science Press, 2006
  • [1] 舒红, 史文中.  浅谈测量平差到空间数据分析的可靠性理论延伸 . 武汉大学学报 ● 信息科学版, 2018, 43(12): 1979-1985, 1993. doi: 10.13203/j.whugis20180339
    [2] 张过, 管志超.  卫星成像质量可靠性研究初探 . 武汉大学学报 ● 信息科学版, 2018, 43(12): 1954-1961. doi: 10.13203/j.whugis20180202
    [3] 王冰, 隋立芬, 张清华, 甘雨.  利用GPS解算载体测姿的算法研究 . 武汉大学学报 ● 信息科学版, 2013, 38(12): 1392-1395.
    [4] 许长辉, 高井祥, 周锋, 王坚.  精密单点定位的可靠性研究 . 武汉大学学报 ● 信息科学版, 2012, 37(6): 709-713.
    [5] 史文中, 陈江平, 詹庆明, 舒红.  可靠性空间分析初探 . 武汉大学学报 ● 信息科学版, 2012, 37(8): 883-887.
    [6] 袁修孝, 李然.  带匹配支持度的多源遥感影像SIFT匹配方法 . 武汉大学学报 ● 信息科学版, 2012, 37(12): 1438-1442.
    [7] 袁修孝, 吴珍丽, 季顺平.  POS影像外方位元素相关性对模型上下视差理论精度的影响 . 武汉大学学报 ● 信息科学版, 2009, 34(8): 889-893.
    [8] 张剑清, 胡安文.  多基线摄影测量前方交会方法及精度分析 . 武汉大学学报 ● 信息科学版, 2007, 32(10): 847-851.
    [9] 张磊, 伍吉仓, 陈艳玲.  InSAR高程模型及其精度分析 . 武汉大学学报 ● 信息科学版, 2007, 32(2): 108-111.
    [10] 袁修孝, 傅建红, 左正立, 孙红星.  机载POS系统用于航空遥感直接对地目标定位的精度分析 . 武汉大学学报 ● 信息科学版, 2006, 31(10): 847-850.
    [11] 尤红建, 丁赤彪, 向茂生.  机载高分辨率SAR图像直接对地定位原理及精度分析 . 武汉大学学报 ● 信息科学版, 2005, 30(8): 712-715.
    [12] 卢秀山, 宁津生, 冯尊德, 郭英.  观测有效性的度量方法 . 武汉大学学报 ● 信息科学版, 2003, 28(2): 144-148.
    [13] 陶本藻, 姚宜斌.  可靠性分析与数据探测 . 武汉大学学报 ● 信息科学版, 2002, 27(6): 607-610.
    [14] 张正禄, 罗年学, 黄全义, 梅文胜.  一种基于可靠性的工程控制网优化设计新方法 . 武汉大学学报 ● 信息科学版, 2001, 26(4): 354-360.
    [15] 黄加纳, 蓝悦明, 覃文忠.  地图数字化的坐标转换及数据的精度与相关性 . 武汉大学学报 ● 信息科学版, 2001, 26(3): 213-216.
    [16] 袁修孝.  GPS辅助光束法平差中观测值的自动定权 . 武汉大学学报 ● 信息科学版, 1999, 24(2): 115-118.
    [17] 邵巨良.  无需相似性量测的多片影像匹配 . 武汉大学学报 ● 信息科学版, 1998, 23(4): 383-387.
    [18] 舒宁.  SPOT卫星影象严密数字几何校正的直接法 . 武汉大学学报 ● 信息科学版, 1992, 17(3): 77-82.
    [19] 赵少荣.  变形监测网的可区分性分析 . 武汉大学学报 ● 信息科学版, 1991, 16(2): 18-27.
    [20] 单杰, 李德仁.  摄影测量与大地测量观测值联合平差的质量分析 . 武汉大学学报 ● 信息科学版, 1990, 15(4): 6-15.
  • 加载中
图(6) / 表(2)
计量
  • 文章访问数:  1336
  • HTML全文浏览量:  52
  • PDF下载量:  318
  • 被引次数: 0
出版历程
  • 收稿日期:  2017-05-12
  • 刊出日期:  2018-06-05

车载三天线GNSS的直接法定姿及精度评估

doi: 10.13203/j.whugis20160171
    基金项目:

    国家自然科学基金 41274084

    作者简介:

    蔡小波, 博士生, 主要从事GNSS/INS组合导航研究。caixb2006@126.com

  • 中图分类号: P228

摘要: 针对移动测量系统对载体姿态的需求,对车载三天线全球卫星导航系统(global navigation satellite system,GNSS)的直接法定姿进行了研究。分析了定姿的原理,给出了姿态解算公式,并提出一种简便的方法确定航向角的象限,解决了航向角的多值性问题。为了评估该方法的精度,利用车载的三天线GNSS进行了动态实验,采集了动态观测数据,利用直接法对观测数据进行了姿态解算,并用同车搭载的一套高精度惯性导航系统(inertial navigation system,INS)给出的姿态参考值对三天线GNSS定姿的精度和可靠性进行了评估。结果表明,三天线GNSS直接法定姿精度高、可靠性好,并具有计算简便,可避免奇异性问题等优点。

English Abstract

蔡小波, 许厚泽, 王勇, 柴华, 丁磊香. 车载三天线GNSS的直接法定姿及精度评估[J]. 武汉大学学报 ● 信息科学版, 2018, 43(6): 820-825. doi: 10.13203/j.whugis20160171
引用本文: 蔡小波, 许厚泽, 王勇, 柴华, 丁磊香. 车载三天线GNSS的直接法定姿及精度评估[J]. 武汉大学学报 ● 信息科学版, 2018, 43(6): 820-825. doi: 10.13203/j.whugis20160171
CAI Xiaobo, XU Houze, WANG Yong, CHAI Hua, DING Leixiang. Direct Attitude Determination Method Based on Vehicle-mounted Three-antenna GNSS and the Accuracy Evaluation[J]. Geomatics and Information Science of Wuhan University, 2018, 43(6): 820-825. doi: 10.13203/j.whugis20160171
Citation: CAI Xiaobo, XU Houze, WANG Yong, CHAI Hua, DING Leixiang. Direct Attitude Determination Method Based on Vehicle-mounted Three-antenna GNSS and the Accuracy Evaluation[J]. Geomatics and Information Science of Wuhan University, 2018, 43(6): 820-825. doi: 10.13203/j.whugis20160171
  • 在移动测量系统,如车载或机载的移动摄影测量系统和激光扫描系统中,除了需要载体的位置信息外,还需要知道载体的姿态信息[1-2]。获取姿态信息最直接的方法是采用惯性导航系统(inertial navigation system, INS),然而,INS价格昂贵,且存在姿态误差随时间积累等不足因素[3-4],实际应用中还需要利用其他设备对其进行辅助[5-6]。近年来,随着全球卫星导航系统(glo-bal navigation satellite system, GNSS)动态定位技术的发展,利用多天线的GNSS测量载体姿态的方法受到越来越多的关注[7-11]。多天线GNSS定姿经济方便,使用灵活,并且姿态精度稳定,误差不会随时间积累,具有一定的优势。利用两副天线可以测量载体的航向角和俯仰角,同时测量载体的3个姿态角,至少需要3副天线。

    利用多天线GNSS定姿的方法一般有两类,一类是先解算天线间的基线向量,然后利用基线向量解算载体的姿态[12-13],这类定姿方法相对直观,并且可以利用基线长度辅助模糊度固定,提高基线解算质量;还有一类是将载体的姿态4元素或姿态角作为待解参数,与整周模糊度一起求解[14-17],这类方法需要姿态的初始值,如果初始值精度较差,则难以收敛。

    由基线向量解算姿态的方法主要有直接法和基于最小二乘法的迭代法[18-19]。迭代法是在有初始姿态的情况下,利用每个历元天线间的基线向量在载体系和导航系的坐标迭代计算载体姿态[18], 这种方法需要事先测量天线在载体系的坐标,解算过程中需要进行矩阵求逆,存在奇异性问题[19],并且当初始姿态精度较差时,容易发散[20];直接法是直接利用天线间的基线向量在导航系的坐标解算载体的姿态,此方法计算简便,利用两条基线向量就可以解算姿态,不存在奇异性问题[19]。但由于这种方法直接解算姿态角,需要对姿态角的象限进行判断,存在多值性问题。

    本文主要研究基于三天线GNSS的直接法定姿,给出姿态解算公式,针对航向角存在的多值性问题,给出一种简便的方法确定航向角的取值。为了检验本文定姿方法的精度和可靠性,用车载三天线GNSS获取的实测数据进行姿态解算,并用同平台的高精度INS对三天线GNSS定姿的精度和可靠性进行评估。

    • 姿态指载体相对于参考坐标系的角位置。在导航和移动测量中,参考坐标系一般取导航坐标系,则载体的姿态即为载体系(b系)相对于导航系(n系)的角位置。n系至b系的变换可通过3次旋转来实现:n系先绕Z轴顺时针旋转γ角,再绕X轴逆时针旋转β角,最后绕Y轴逆时针旋转α角。γβα构成一组欧拉角,称为载体的姿态角,其中α为横滚角,β为俯仰角,γ为航向角。载体的姿态除了可用姿态角表示之外,亦可用姿态矩阵表示,n系至b系的坐标变换矩阵Cnb定义为载体的姿态矩阵。姿态矩阵和姿态角之间的关系可表示为[21]:

      $$ \begin{array}{*{20}{c}} {\mathit{\boldsymbol{C}}_n^b = {\mathit{\boldsymbol{R}}_2}\left( \alpha \right){\mathit{\boldsymbol{R}}_1}\left( \beta \right){\mathit{\boldsymbol{R}}_3}\left( { - \gamma } \right) = }\\ {\left[ {\begin{array}{*{20}{c}} {\cos \alpha }&0&{ - \sin \alpha }\\ 0&1&0\\ {\sin \alpha }&0&{\cos \alpha } \end{array}} \right]\left[ {\begin{array}{*{20}{c}} 1&0&0\\ 0&{\cos \beta }&{\sin \beta }\\ 0&{ - \sin \beta }&{\cos \beta } \end{array}} \right]\left[ {\begin{array}{*{20}{c}} {\cos \gamma }&{ - \sin \gamma }&0\\ {\sin \gamma }&{\cos \gamma }&0\\ 0&0&1 \end{array}} \right] = }\\ {\left[ {\begin{array}{*{20}{c}} {\cos \alpha \cos \gamma + \sin \alpha \sin \beta \sin \gamma }&{ - \cos \alpha \sin \gamma + \sin \alpha \sin \beta \cos \gamma }&{ - \sin \alpha \cos \beta }\\ {\cos \beta \sin \gamma }&{\cos \beta \cos \gamma }&{\sin \beta }\\ {\sin \alpha \cos \gamma - \cos \alpha \sin \beta \sin \gamma }&{ - \sin \alpha \sin \gamma - \cos \alpha \sin \beta \cos \gamma }&{\cos \alpha \cos \beta } \end{array}} \right]} \end{array} $$ (1)

      由于n系和b系均为直角坐标系,姿态矩阵为正交矩阵[21],即(Cnb)T=(Cnb)-1b系至n系的坐标变换矩阵记为Cbn,有Cbn=(Cnb)-1=(Cnb)T

      将3副天线固定于车顶,取天线1为主天线,其相位中心的位置作为载体系的原点,天线1与天线2的连线与车辆纵轴平行并指向车头方向,构成载体系的Y轴,X轴在车顶平面内垂直于Y轴,Z轴垂直于车顶指向天顶方向,并与X轴和Y轴构成右手坐标系,将此坐标系记为载体坐标系O-XbYbZb,如图 1所示。则天线1、2、3在载体系的坐标分别为(0, 0, 0)、(0, L12, 0)、(L13sinθ, L13cosθ, 0)。

      图  1  载体坐标系及三天线示意图

      Figure 1.  Illustration of Body-frame and Three-antenna

      在每个观测历元,通过精密单点定位可以获得天线1在WGS-84系的坐标,通过动态基线解算可以获得WGS-84系下天线1至天线2、天线1至天线3的基线向量,分别用s12, es 13, e表示:

      $$ {\mathit{\boldsymbol{s}}_{12,e}} = \left[ {\begin{array}{*{20}{c}} {{x_{12,e}}}\\ {{y_{12,e}}}\\ {{z_{12,e}}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {{x_{2,e}} - {x_{1,e}}}\\ {{y_{2,e}} - {y_{1,e}}}\\ {{z_{2,e}} - {z_{1,e}}} \end{array}} \right] $$ (2)
      $$ {\mathit{\boldsymbol{s}}_{13,e}} = \left[ {\begin{array}{*{20}{c}} {{x_{13,e}}}\\ {{y_{13,e}}}\\ {{z_{13,e}}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {{x_{3,e}} - {x_{1,e}}}\\ {{y_{3,e}} - {y_{1,e}}}\\ {{z_{3,e}} - {z_{1,e}}} \end{array}} \right] $$ (3)

      将其变换到导航系,有:

      $$ {\mathit{\boldsymbol{s}}_{12,n}} = \left[ {\begin{array}{*{20}{c}} {{x_{12,n}}}\\ {{y_{12,n}}}\\ {{z_{12,n}}} \end{array}} \right] = \mathit{\boldsymbol{C}}_e^n{\mathit{\boldsymbol{s}}_{12,e}} $$ (4)
      $$ {\mathit{\boldsymbol{s}}_{13,n}} = \left[ {\begin{array}{*{20}{c}} {{x_{13,n}}}\\ {{y_{13,n}}}\\ {{z_{13,n}}} \end{array}} \right] = \mathit{\boldsymbol{C}}_e^n{\mathit{\boldsymbol{s}}_{13,e}} $$ (5)

      Cen可由天线1的WGS-84坐标计算,得:

      $$ \mathit{\boldsymbol{C}}_e^n{\rm{ = }}\left[ {\begin{array}{*{20}{c}} { - \sin \lambda }&{\cos \lambda }&0\\ { - \cos \lambda \sin \mathit{\Phi }}&{ - \sin \lambda \sin \mathit{\Phi }}&{\cos \mathit{\Phi }}\\ {\cos \lambda \cos \mathit{\Phi }}&{\sin \lambda {\cos}\mathit{\Phi }}&{\sin \mathit{\Phi }} \end{array}} \right] $$ (6)

      λΦ为天线1的经度和纬度,由精密单点定位获得。两基线向量在载体系的坐标为:

      $$ {\mathit{\boldsymbol{s}}_{12,b}} = \left[ {\begin{array}{*{20}{c}} 0\\ {{L_{12}}}\\ 0 \end{array}} \right] $$ (7)
      $$ {\mathit{\boldsymbol{s}}_{13,b}} = \left[ {\begin{array}{*{20}{c}} {{L_{13}}\sin \theta }\\ {{L_{13}}\cos \theta }\\ 0 \end{array}} \right] $$ (8)

      天线1至天线2的基线向量在载体系和导航系的坐标之间的关系为:

      $$ {\mathit{\boldsymbol{s}}_{12,n}} = \mathit{\boldsymbol{C}}_b^n{\mathit{\boldsymbol{s}}_{12,b}} = {\left( {\mathit{\boldsymbol{C}}_b^n} \right)^{\rm{T}}}{\mathit{\boldsymbol{s}}_{12,b}} $$ (9)

      将式(1)、式(4)、式(7)代入式(9)得:

      $$ \left[ {\begin{array}{*{20}{c}} {{x_{12,n}}}\\ {{y_{12,n}}}\\ {{z_{12,n}}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {\cos \beta \sin \gamma }\\ {\cos \beta \cos \gamma }\\ {\sin \beta } \end{array}} \right]{L_{12}} $$ (10)

      由式(10)可得航向角为:

      $$ \gamma = \arctan \left( {\frac{{{x_{12,n}}}}{{{y_{12,n}}}}} \right) $$ (11)

      俯仰角为:

      $$ \beta = \arctan \left( {\frac{{{z_{12,n}}}}{{\sqrt {x_{12,n}^2 + y_{12,n}^2} }}} \right) $$ (12)

      天线1至天线3的基线向量在载体系和导航系的坐标之间的关系为:

      $$ {\mathit{\boldsymbol{s}}_{13,b}} = \mathit{\boldsymbol{C}}_n^b{\mathit{\boldsymbol{s}}_{13,n}} $$ (13)

      将式(1)、式(5)、式(8)代入式(13)得:

      $$ \left[ {\begin{array}{*{20}{c}} {{L_{13}}\sin \theta }\\ {{L_{13}}\cos \theta }\\ 0 \end{array}} \right] = \\\left[ {\begin{array}{*{20}{c}} {\cos \alpha }&0&{ - \sin \alpha }\\ 0&1&0\\ {\sin \alpha }&0&{\cos \alpha } \end{array}} \right]\left[ {\begin{array}{*{20}{c}} {{x_{13,n}}\cos \gamma - {y_{13,n}}\sin \gamma }\\ {{x_{13,n}}\cos \beta \sin \gamma + {y_{13,n}}\cos \beta \cos \gamma + {z_{13,n}}\sin \beta }\\ { - {x_{13,n}}\sin \beta \sin \gamma - {y_{13,n}}\sin \beta \cos \gamma + {z_{13,n}}\cos \beta } \end{array}} \right] $$ (14)

      由式(14)可得横滚角为:

      $$ \alpha = - \arctan \left( {\frac{{{{z''}_{13,n}}}}{{{{x''}_{13,n}}}}} \right) $$ (15)

      式中,

      $$ {{x''}_{13,n}} = {x_{13,n}}\cos \gamma - {y_{13,n}}\sin \gamma $$ (16)
      $$ \begin{array}{l} {{z''}_{13,n}} = - {x_{13,n}}\sin \beta \sin \gamma - \\ \;\;\;\;\;\;\;\;{y_{13,n}}\sin \beta \cos \gamma + {z_{13,n}}\cos \beta \end{array} $$ (17)
    • 从式(11)、式(12)及式(15)可以看出,3个姿态角的表达式均为反正切函数,反正切函数的取值范围为-90°~90°,而航向角的取值为0°~360°,俯仰角的取值为-90°~90°,横滚角的取值为-180°~180°。因此俯仰角不存在多值性问题,横滚角在实际应用中由于载体的运动特性会受限于一定的取值范围之内,也不存在多值性问题,下面给出航向角取值的判定方法。

      航向角为导航系(n系)至载体系(b系)的第一次旋转形成的角度,此旋转绕Zn轴进行。旋转后n系及b系的位置、天线1至天线2的基线向量旋转前后的位置如图 2所示。

      图  2  航向角象限判定

      Figure 2.  Quadrant Determination of the Yaw Angle

      由式(11)可知,航向角只与天线1至天线2的基线向量在n系的坐标分量x12, ny12, n有关。图 2标出了航向角分别在4个象限时b系的位置及x12, ny12, n的取值,由此,即可通过x12, ny12, n的符号来判定航向角的象限,如表 1所示,γ0为直接由航向角的表达式计算得到的初始值。

      表 1  航向角符号与x12, ny12, n的关系

      Table 1.  Relationship Between the Sign of the Yaw Angle and x12, n, y12, n

      x12, n的符号 y12, n的符号 象限 航向角γ取值
      + + 0°~90° γ0
      + - 90°~180° γ0+180°
      - - 180°~270° γ0+180°
      - + 270°~360° γ0+360°
    • 为了检验三天线GNSS直接法定姿的精度和可靠性,进行了车载实验。实验车搭载了一套NovAtel公司的三天线GNSS,采样频率为1 Hz,用于姿态测量。同时随车搭载了一套高精度的INS,陀螺漂移为0.006°/h,采样频率为200 Hz,用于获取姿态参考值,对三天线GNSS定姿结果进行外符合精度检验。3副GNSS天线按照图 1所示固定于车顶,天线1和天线2之间的基线长度为2.641 m,天线1和天线3之间的基线长度为2.820 m,实验共采集了3 h的动态观测数据,车速40 km/h左右。

      数据处理时,先利用精密星历和精密钟差解算天线1的WGS-84坐标,再解算天线1至天线2和天线1至天线3之间的动态基线。然后利用天线1的WGS-84坐标将基线坐标变换到导航系,利用导航系下的基线坐标解算载体姿态角,并用本文给出的方法判定航向角的取值。解得的姿态角与高精度INS的比较如图 3~5所示。

      图  3  三天线GNSS测得的航向角与高精度INS的比较

      Figure 3.  Comparison of the Yaw Angle Determined from Three-antenna GNSS and INS

      图  4  三天线GNSS测得的俯仰角与高精度INS的比较

      Figure 4.  Comparison of the Pitch Angle Determined from Three-antenna GNSS and INS

      图  5  三天线GNSS测得的横滚角与高精度INS的比较

      Figure 5.  Comparison of the Roll Angle Determined from Three-antenna GNSS and INS

      图 3~5可以看出,在动态条件下,三天线GNSS定姿法能够很好地捕捉到载体姿态的变化,并与高精度INS给出的姿态参考值符合较好,姿态精度稳定。只有456 000~457 500 s这段时间精度较差,与观测条件较差有关。通过数据分析可以发现,三天线GNSS测得的航向角和横滚角与高精度INS之间存在一定的系统差,航向角差0.546°,横滚角差0.678°,这一系统差主要来源于GNSS天线与INS在安装时产生的系统偏差。去掉这一系统差之后,三天线GNSS定姿的误差如图 6所示。

      图  6  三天线GNSS定姿的误差

      Figure 6.  Errors of the Attitude Determined from Three-antenna GNSS

      从式(11)、式(12)及式(15)可以看出,基线向量的精度对姿态角的精度起着决定性的作用。航向角和俯仰角的精度和天线1至天线2之间的基线精度相关,而横滚角的精度和天线1至天线3之间的基线精度相关。基线解算精度与天线接收到的卫星信号质量及卫星分布相关。除此之外,姿态解算精度还与天线布局有关。从图 6可以看出,三天线直接法定姿得到的航向角误差最小,俯仰角误差稍大,横滚角误差最大,这是因为航向角和俯仰角的精度与天线1和天线2之间的基线长度成正比,横滚角的精度与天线2至天线3之间的基线长度在横轴方向的投影成正比。并且从式(11)、式(12)及式(15)分析可以发现,在计算航向角时用的是基线坐标的比值,计算俯仰角时进行了乘方和开方运算,放大了噪声,而计算横滚角时用到了航向角与俯仰角,所以噪声也会更大。3个姿态角的误差统计如表 2所示。

      表 2  姿态角误差统计/(°)

      Table 2.  Statistics of the Attitude Error/(°)

      航向角 俯仰角 横滚角
      最大值 1.121 3.999 12.651
      最小值 -1.898 -5.666 -16.013
      标准差 0.168 0.397 0.974
    • 本文研究了三天线GNSS直接法动态定姿的方法,针对直接法定姿存在的航向角多值性问题,给出一种判定航向角取值的简便方法。利用车载实测数据进行了姿态解算,对本文的方法进行了验证。车载实验时两条基线长度分别为2.641 m和2.820 m,利用本文定姿方法解算得到的姿态外符合精度分别为航向角0.168°,俯仰角0.397°,横滚角0.974°。实验结果表明,三天线GNSS定姿法能很好地追踪移动载体的姿态变化,并且精度稳定,可靠性高。在良好的观测条件下,可以长时间保持较高的精度,相对于低精度的INS系统具有一定的优势。若建立实时通讯系统,还可以为移动测量系统提供实时的姿态信息。

参考文献 (21)

目录

    /

    返回文章
    返回