CN103900565B - 一种基于差分gps的惯导系统姿态获取方法 - Google Patents

一种基于差分gps的惯导系统姿态获取方法 Download PDF

Info

Publication number
CN103900565B
CN103900565B CN201410076441.XA CN201410076441A CN103900565B CN 103900565 B CN103900565 B CN 103900565B CN 201410076441 A CN201410076441 A CN 201410076441A CN 103900565 B CN103900565 B CN 103900565B
Authority
CN
China
Prior art keywords
inertial
carrier
gravitational vectors
acceleration
latitude
Prior art date
Application number
CN201410076441.XA
Other languages
English (en)
Other versions
CN103900565A (zh
Inventor
周广涛
郝勤顺
姜鑫
赵博
孙艳涛
梁宏
于春阳
夏秀玮
刘学敏
金诗宇
Original Assignee
哈尔滨工程大学
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 哈尔滨工程大学 filed Critical 哈尔滨工程大学
Priority to CN201410076441.XA priority Critical patent/CN103900565B/zh
Publication of CN103900565A publication Critical patent/CN103900565A/zh
Application granted granted Critical
Publication of CN103900565B publication Critical patent/CN103900565B/zh

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial

Abstract

本发明提供的是一种基于差分GPS的惯导系统姿态获取方法。由DGPS测量载体加速度,经低通滤波得到加速度测量值;根据惯导系统解算方程,在已知比力信息和载体加速度的情况下,得到地理系表示的重力矢量利用DGPS提供的经纬度信息以及初始经度信息,确定地理系到惯性系的转换矩阵,将地理系表示的重力矢量转换到惯性系,得到惯性系重力矢量;利用惯性空间的重力矢量求解重力矢量漂移角度和纬度;经过两次坐标转换,得到转换矩阵在惯导系统中,利用陀螺仪采集角速率信号计算旋转矢量,更新四元数,通过四元数实现的更新;根据确定系统的姿态转换矩阵,得到载体的航向和姿态角,从而确保姿态信息的精度满足舰船导航的需求。

Description

一种基于差分GPS的惯导系统姿态获取方法
技术领域
[0001] 本发明属于惯性导航系统和GPS的技术领域,涉及的是一种基于差分GPS (Differential GPS,DGPS)的惯导系统姿态解算方法。
背景技术
[0002] 惯性导航是利用惯性敏感器、基准方向及最初位置来确定载体的姿态、位置和速 度的自主式推算导航方法。它不受环境、载体机动和无线电干扰的影响,能连续提供全部导 航参数,在短时间内具有较高的相对精度,是最主要的自主导航手段。在信息化条件下的未 来战争中,导航设备作为一种重要的传感器,导航参数精度对于赢得未来战争起关键性制 约作用。
[0003] 目前,提高惯性器件精度和完善导航算法是改进导航系统导航性能的主要途径: 对于提高惯性器件精度而言,不仅器件本身上升空间较小,而且为提高精度付出的代价与 改进效果相比,其性价比较低,所以从硬件的角度来提高系统导航性能就显得优势较小;设 法完善导航解算方法以提高导航精度是近几年来惯导领域研究的热点,但只依靠惯导系统 依然无法回避导航误差随时间积累这一缺点,很难达到长航时的应用需求。
发明内容
[0004] 本发明的目的在于提供一种方法简单,适用范围广,精度高的基于差分GPS的惯导 系统姿态获取方法。
[0005] 本发明的目的是这样实现的:
[0006] 步骤一:利用DGPS测量载体运动加速度,经过低通滤波器滤波后得到一定分辨率 和精度的载体加速度测量值;
[0007] 步骤二:由惯导系统解算方程,在已知比力信息和载体加速度的情况下,得到地理 系表示的重力矢量gS所述载体加速度包括哥氏加速度和离心加速度;
[0008] 步骤三:利用DGPS提供的经炜度信息即经度A和炜度f以及初始经炜度信息即初 始经度和初始炜度料*确定地理系t到惯性系i的转换矩阵0,将地理系表示的重力矢量 转换到惯性系,得到惯性系重力矢量g1;
[0009] 步骤四:利用由地球旋转引起的表观重力的慢漂现象,根据步骤三获取的惯性系 重力矢量,求解重力矢量漂移角度a和炜度妒;
[0010] 步骤五:在已知重力矢量在赤道平面漂移角度a以及重力矢量与赤道平面的夹角e 的情况下,经过两次坐标转换,得到转换矩阵;
[0011]步骤六:在惯导系统中,利用陀螺仪采集角速率信号计算旋转矢量,通过更新四元 数Q,实现载体系到惯性系的转换矩阵加更新;
[0012]步骤七:根据转换矩阵cr和载体系到惯性系的转换矩阵(^,确定系统的姿态转 换矩阵G,从而得到载体的姿态角,所述载体的姿态包括航向、纵摇和横摇。
[0013] 本发明提供了一种基于DGPS的惯导系统姿态解算方法,旨在解决传统的姿态解算 方法会引入速度、位置信息,且存在舒勒周期和傅科周期,随时间积累会引入较大误差这一 问题。
[0014] 本发明利用加速度计和DGPS分别测量比力信息和载体加速度,由导航解算方程得 到重力矢量gS根据GPS提供位置信息计算q,将重力矢量转换到惯性系,利用惯性空间的 重力矢量求解重力矢量漂移角度和炜度得到转换矩阵再由陀螺仪采集角速率信号计 算旋转矢量更新四元数Q,完成^的更新,从而确定系统的姿态转换矩阵CL即获取载体 的姿态信息。
[0015] 本发明的优点在于:
[0016] 1、本发明提供的姿态解算方法不局限于特定的导航系统,无论是平台式惯导系统 还是捷联式惯导系统,例如,本地水平指北平台式系统、捷联式系统、空间稳定平台式系统 等。本发明方法简单,适用范围广,提供了一种高精度姿态解算方法。
[0017] 2、本发明避免了传统的姿态解算方法会引入速度、位置信息,且存在舒勒周期和 傅科周期,随时间积累会引入较大误差的问题。
附图说明
[0018] 图1是本发明的方法流程图;
[0019] 图2是本发明提供的重力矢量相对惯性空间慢漂示意图;
[0020] 图3是本发明提供的基于DGPS的惯导系统姿态解算方法流程图。
具体实施方式
[0021] 下面将结合附图和实施例对本发明作进一步的详细说明。
[0022] 本发明的一种基于DGPS的惯导系统姿态解算方法,包括以下几个步骤:
[0023]步骤一:利用DGPS测量载体加速度,经过低通滤波可得到一定分辨率的载体加速 度测量值。
[0024] 具体为,载体运动加速度的计算通常采用位置微分法,即对GPS载波相位双差动态 定位结果进行连续两次数字差分而得到载体加速度。由于GPS载波相位观测量受接收机噪 声、多路径效应、对流层和平流层的大气层延迟、星历误差等因素的影响,而数字差分将放 大高频噪声,因此需要利用低通滤波器滤除高频噪声以得到一定分辨率的高精度载体运动 加速度。
[0025] 步骤二:根据惯导系统解算方程,在已知比力信息和载体加速度(包括哥氏加速度 和离心加速度)的情况下,可以得到地理系表示的重力矢量
[0026] 具体为,设惯导系统的解算坐标系为a,测量参考坐标系为m,存在通用的惯导系统 解算方程,即
Figure CN103900565BD00051
[0028] 式中,
[0029] ra-导航解算坐标系中表示的位置矢量;
[0030] va-导航解算坐标系中表示的速度矢量;
[0031] fm-测量参考坐标系中表示的加速度计比力矢量;
[0032] [Pa]+载体位移角速度矢量反对称矩阵;
[0033] [<]-导航解算坐标系相对惯性坐标系的旋转角速度矢量< 的反对称矩阵;
[0034] [<] -测量参考坐标系相对惯性坐标系的旋转角速度矢量< 的反对称矩阵;
[0035] [2<+/?a]va-地球自转和载体运动所引起的哥氏加速度和离心加速度之和。 [0036]无论是对于平台式还是捷联式惯导系统,解算坐标系均为地理坐标系,即a系与t 系重合。利用步骤一中DGPS测得的载体速度信息,计算比力方程中的哥氏加速度和离心加 速度项,利用DGPS测得的载体速度信息i> fl,惯导系统中加速度计输出测量参考坐标系表示 的比例信息fm,从而得到地理系表示的重力矢量
[0037] 步骤三:利用DGPS提供的经炜度信息(A和W)以及初始经炜度信息(Aq和怀),确定 地理系(t)到惯性系(i)的转换矩阵0,将地理系表示的重力矢量转换到惯性系,即得到惯 性系重力矢量g 1。
[0038] 具体为,转换矩阵的计算需要用到经度和炜度信息,如果利用惯导系统提供的位 置信息,
[0039] 则会引入随时间发散的误差,于是借助DGPS实时提供位置信息,在一定程度上保 证计算精度。利用DGPS提供的经炜度信息(A和P)以及初始经炜度信息(\〇和%),确定地理 坐标系(t)到惯性坐标系(i)的转换矩阵C),即
Figure CN103900565BD00052
[0041 ]其中,
[0042] y =人+o j_et_入〇
[0043] 式中,表示载体的初始地理经度,《le表示地球相对惯性空间自转角速度,供为 地理炜度,t表示导航时间,A表示地理经度,y表示在t时间内经度方向转过的角度。
[0044] 传统的姿态矩阵求解会引入加速度积分带来的积累误差。针对这一问题,把姿态 矩阵的求解放在了惯性坐标系中,其核心就是计算惯性系的重力矢量,将步骤二中地理坐 标系表示的重力矢量gS经转换矩阵<,得到惯性系重力矢量g1,即
Figure CN103900565BD00061
[0046]式中,g卜gf和g〖分别表示惯性坐标系中三个正交轴下的重力分量。
[0047]步骤四:利用由地球旋转引起的表观重力的慢漂这一现象,根据步骤三获取的惯 性系重力矢量,求解重力矢量漂移角度a和炜度穸。
[0048]具体为,通过惯性系的重力矢量可"观察"到由地球旋转引起的表观重力的慢漂, 很容易看出惯性空间中表示的表观重力确定了一个主轴与地球旋转轴一致的锥体(如图 2)。因此,对g运动的研究可以得到地理北向,而不需要外部参考。
[0049] 重力矢量g1在赤道平面漂移角度可以通过g;. , 确定,用a表示该角度,则可以 通过下式确定角度值:
[0050]
Figure CN103900565BD00062
[0051]在初始对准刚一结束的时候,惯性坐标系就已经确定下来,再也不发生变化。我们 以惯性坐标系的原点0为基准,把赤道平面分为四个象限,我们发现重力在赤道平面两个水 平坐标轴上的投影的大小和方向也在发生相应的变化。所以,在求解a,识(a表示重力矢量 漂移角度、供表示炜度)的时候也要考虑相应的变化。
[0052] 在子午圈的变化也可以确定,用角度0来表示,该值与炜度值识相近,但是它的精 度较低,误差有可能在1°左右,主要是它通过重力矢量直接确定,毕竟重力矢量的测量存在 误差。重力矢量与赤道平面的夹角为:
[0053]
Figure CN103900565BD00063
[0054]步骤五:在已知重力矢量在赤道平面漂移角度a以及重力矢量与赤道平面的夹角0 的情况下,经过两次坐标转换,就可以得到转换矩阵C;"。
[0055] 具体为,由重力矢量在赤道平面漂移角度a确定的旋转矩阵为:
[0056]
Figure CN103900565BD00064
[0057]由重力矢量与赤道平面的夹角0形成的旋转矩阵为:
[0058]
Figure CN103900565BD00065
[0059]由重力矢量在赤道平面漂移角度a以及重力矢量与赤道平面的夹角0,可以确定惯 性坐标系到地理坐标系的旋转关系。即
[0060]
Figure CN103900565BD00071
[0061]步骤六:在惯导系统中,利用陀螺仪采集角速率信号计算旋转矢量,通过更新四元 数Q,从而可实现g (载体系到惯性系的转换矩阵)的更新。
[0062]具体为,利用惯导系统中陀螺仪采集角速度信号计算旋转矢量,进而更新四元数 q。从而完成q的更新:
Figure CN103900565BD00072
[0065] 其中,
Figure CN103900565BD00073
,为载体坐标系到惯性坐标系的转动四元 数。
[0066] 步骤七:根据C7和C;;,可以确定系统的姿态转换矩阵,即q,从而得到载体的姿 态角(航向、纵摇和横摇)。
[0067] 具体为,姿态转换矩阵按下式得到
Figure CN103900565BD00074
[0071] 式中,叫为矩阵中第i行第j列元素。
[0072] 针对传统的姿态解算方法会引入速度、位置信息,且存在舒勒周期和傅科周期,随 时间积累会引入较大误差的问题,本发明利用加速度计和DGPS分别测量比力信息和载体加 速度,由导航解算方程得到重力矢量gt,根据GPS提供位置信息计算C;,将重力矢量转换到 惯性系,利用惯性空间的重力矢量求解重力矢量漂移角度和炜度得到转换矩阵C?,再由陀 螺仪通过更新四元数Q,完成< 的更新,从而确定系统的姿态转换矩阵即获取载体的姿 态信息。

Claims (1)

1. 一种基于差分GPS的惯导系统姿态获取方法,其特征是: 步骤一:利用DGPS测量载体运动加速度,经过低通滤波器滤波后得到一定分辨率和精 度的载体加速度测量值; 步骤二:由惯导系统解算方程,在已知比力信息和载体加速度的情况下,得到地理系表 示的重力矢量gS所述载体加速度包括哥氏加速度和离心加速度; 步骤三:利用DGPS提供的经炜度信息即经度λ和炜度史以及初始经炜度信息即初始经度 λ〇和初始炜度科,确定地理系t到惯性系i的转换矩阵g,将地理系表示的重力矢量转换到 惯性系,得到惯性系重力矢量g1; 步骤四:利用由地球旋转引起的表观重力的慢漂现象,根据步骤三获取的惯性系重力 矢量,求解重力矢量漂移角度α和炜度妒; 步骤五:在已知重力矢量在赤道平面漂移角度α以及重力矢量与赤道平面的夹角β的情 况下,经过两次坐标转换,得到转换矩阵C7 ; 步骤六:在惯导系统中,利用陀螺仪采集角速率信号计算旋转矢量,通过更新四元数Q, 实现载体系到惯性系的转换矩阵ci的更新; 步骤七:根据转换矩阵ς"和载体系到惯性系的转换矩阵q,确定系统的姿态转换矩阵 q,从而得到载体的姿态角,所述载体的姿态包括航向、纵摇和横摇。
CN201410076441.XA 2014-03-04 2014-03-04 一种基于差分gps的惯导系统姿态获取方法 CN103900565B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410076441.XA CN103900565B (zh) 2014-03-04 2014-03-04 一种基于差分gps的惯导系统姿态获取方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410076441.XA CN103900565B (zh) 2014-03-04 2014-03-04 一种基于差分gps的惯导系统姿态获取方法

Publications (2)

Publication Number Publication Date
CN103900565A CN103900565A (zh) 2014-07-02
CN103900565B true CN103900565B (zh) 2016-11-23

Family

ID=50992034

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410076441.XA CN103900565B (zh) 2014-03-04 2014-03-04 一种基于差分gps的惯导系统姿态获取方法

Country Status (1)

Country Link
CN (1) CN103900565B (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104296780B (zh) * 2014-10-16 2017-04-05 东南大学 一种基于重力视运动的sins自对准与纬度计算方法
CN104374402B (zh) * 2014-10-23 2018-07-31 哈尔滨工程大学 一种位置未知条件下的星敏感器/加速度计粗对准方法
CN104864869B (zh) * 2015-06-05 2017-11-21 中国电子科技集团公司第二十六研究所 一种载体初始动态姿态确定方法
CN105823463B (zh) * 2016-03-17 2018-09-25 广州展讯信息科技有限公司 机动车辆姿态的测量方法及测量装置
CN105865455B (zh) * 2016-06-08 2018-07-24 中国航天空气动力技术研究院 一种利用gps与加速度计计算飞行器姿态角的方法
CN110187377A (zh) * 2017-03-20 2019-08-30 深圳市西博泰科电子有限公司 对移动设备导航定位的方法及设备
CN106940184B (zh) * 2017-04-24 2020-04-03 湖南华诺星空电子技术有限公司 一种基于差分gps的惯导定位方法及系统
CN109596144B (zh) * 2018-12-10 2020-07-24 苏州大学 Gnss位置辅助sins行进间初始对准方法

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6493631B1 (en) * 2001-05-31 2002-12-10 Mlho, Inc. Geophysical inertial navigation system
CN102706349A (zh) * 2012-06-06 2012-10-03 辽宁工程技术大学 一种基于光纤捷联罗经技术的载体姿态确定方法
CN103575297B (zh) * 2013-10-31 2017-02-01 中国人民解放军国防科学技术大学 基于卫星导航接收机的gnss和mimu组合导航航向角估计方法

Also Published As

Publication number Publication date
CN103900565A (zh) 2014-07-02

Similar Documents

Publication Publication Date Title
Wu et al. Velocity/position integration formula part I: Application to in-flight coarse alignment
Georgy et al. Low-cost three-dimensional navigation solution for RISS/GPS integration using mixture particle filter
CN103969672B (zh) 一种多卫星系统与捷联惯性导航系统紧组合导航方法
Bekir Introduction to modern navigation systems
US6876926B2 (en) Method and system for processing pulse signals within an inertial navigation system
EP2502026B1 (en) Spatial alignment determination for an inertial measurement unit (imu)
CN103776446B (zh) 一种基于双mems-imu的行人自主导航解算算法
CN101858748B (zh) 高空长航无人机的多传感器容错自主导航方法
CN104736963B (zh) 测绘系统和方法
CN105606094B (zh) 一种基于mems/gps组合系统的信息条件匹配滤波估计方法
CN100541135C (zh) 基于多普勒的光纤陀螺捷联惯导系统初始姿态确定方法
CN1330935C (zh) 安装误差角与标度因数解耦的微惯性测量单元精确标定方法
CN104215259B (zh) 一种基于地磁模量梯度和粒子滤波的惯导误差校正方法
CN100516775C (zh) 一种捷联惯性导航系统初始姿态确定方法
CN100587641C (zh) 一种适用于任意运动微小型系统的定姿系统
CN103217159B (zh) 一种sins/gps/偏振光组合导航系统建模及动基座初始对准方法
CN101907714B (zh) 基于多传感器数据融合的gps辅助定位方法
CN103245360B (zh) 晃动基座下的舰载机旋转式捷联惯导系统自对准方法
CN103245359B (zh) 一种惯性导航系统中惯性传感器固定误差实时标定方法
CN103575299B (zh) 利用外观测信息的双轴旋转惯导系统对准及误差修正方法
CN102486377B (zh) 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法
CN104567931A (zh) 一种室内惯性导航定位的航向漂移误差消除方法
CN103389092B (zh) 一种系留飞艇姿态测量装置及测量方法
CN100565115C (zh) 多位置捷联寻北系统方位效应的标定方法
CN102221372B (zh) 使用离心机和转台对惯性测量单元进行误差标定的方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CB03 Change of inventor or designer information
CB03 Change of inventor or designer information

Inventor after: Zhao Yuxin

Inventor after: Jin Shiyu

Inventor after: Zhou Guangtao

Inventor after: Hao Qinshun

Inventor after: Jiang Xin

Inventor after: Zhao Bo

Inventor after: Sun Yantao

Inventor after: Yu Chunyang

Inventor after: Xia Xiuwei

Inventor after: Liu Xuemin

Inventor before: Zhou Guangtao

Inventor before: Jin Shiyu

Inventor before: Hao Qinshun

Inventor before: Jiang Xin

Inventor before: Zhao Bo

Inventor before: Sun Yantao

Inventor before: Liang Hong

Inventor before: Yu Chunyang

Inventor before: Xia Xiuwei

Inventor before: Liu Xuemin