CN103917850B - 一种惯性导航***的运动对准方法 - Google Patents
一种惯性导航***的运动对准方法 Download PDFInfo
- Publication number
- CN103917850B CN103917850B CN201180074345.6A CN201180074345A CN103917850B CN 103917850 B CN103917850 B CN 103917850B CN 201180074345 A CN201180074345 A CN 201180074345A CN 103917850 B CN103917850 B CN 103917850B
- Authority
- CN
- China
- Prior art keywords
- delta
- inertial navigation
- navigation system
- omega
- integral
- Prior art date
- Legal status (The legal status 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 status listed.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 81
- 230000001133 acceleration Effects 0.000 claims abstract description 15
- 238000012545 processing Methods 0.000 claims abstract description 3
- 239000011159 matrix material Substances 0.000 claims description 64
- 238000004364 calculation method Methods 0.000 claims description 37
- 230000010354 integration Effects 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 7
- 230000009466 transformation Effects 0.000 claims description 5
- 230000008859 change Effects 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims 1
- 238000005259 measurement Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 6
- 238000013461 design Methods 0.000 description 4
- 238000001914 filtration Methods 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/183—Compensation of inertial measurements, e.g. for temperature effects
- G01C21/185—Compensation of inertial measurements, e.g. for temperature effects for gravity
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明涉及惯性导航***技术领域,尤其涉及一种惯性导航***的运动对准方法,该惯性导航***安装于运动载体上,包括:惯性导航***测量自身的转动信息和线加速度信息;惯性导航***同步接收外部辅助信息源提供的其在参考坐标系中的参考速度和位置信息;以及惯性导航***对转动信息和线加速度信息以及参考速度和位置信息进行数据处理,得到自身在当前时刻的体坐标系相对于参考坐标系的姿态。利用本发明,有效地解决了参考坐标系速度/位置辅助下的惯性导航***运动对准问题,在没有任何姿态先验初值的情况下实现了快速姿态对准。
Description
技术领域
本发明涉及惯性导航***技术领域,尤其涉及一种惯性导航***的运动对准方法,即如何在运动情况下借助速度/位置信息实现惯性导航***的姿态对准。
背景技术
在正式开始导航工作之前,惯性导航***(InertialNavigationSystem,INS)需要知道一些初始条件,例如初始姿态、初始速度和初始位置。确定初始条件的过程通常称作“对准”。初始速度和初始位置易于获得,因此对准一般特指确定INS的体坐标系相对于参考坐标系的姿态关系的过程。
常用参考坐标系包括当地水平坐标系、地球坐标系等。姿态对准的作用至关重要,对准的好坏直接决定了INS在后续导航阶段的精度水平。在舰载机、制导弹药、水下无人潜航器和地面机动车辆等应用中,要求INS能够在运动过程中进行对准。
INS运动对准需要在外部信息源的协助下完成。全球卫星定位***(GlobalPositioningSystem,GPS)是常见的外部信息源,它可以提供载体在当地水平坐标系或地球坐标系下的速度和位置信息。
目前运动对准的主流方法借鉴了静态或准静态情况下的实现思路,即通常包括粗对准和精对准两个阶段。粗对准用于得到粗略的初始姿态,为精对准提供初始值。精对准通常采用基于泰勒(Taylor)级数展开的非线性滤波方法,如一阶线性近似的扩展卡尔曼滤波(ExtendedKalmanFilter,EKF)等。采用EKF等非线性滤波方法进行精对准,需要知道较准确的惯性器件,例如陀螺和加速度计,以及外部速度/位置信息的噪声特性,而且要求粗对准提供的初始姿态误差不能过大,否则滤波器将不能在规定的时间内收敛到理想的精对准结果,有时甚至发散。可惜的是,在各种各样的载体运动情形中,粗对准得到的初始姿态的误差通常很大,特别是方位角误差。
因此,当前运动对准的研究重点主要集中在如何设计非线性大失准角误差模型或选用更复杂的滤波器,以应对不可避免的大初始方位角误差,但效果均不尽理想。
发明内容
有鉴于此,本发明的主要目的在于提供一种惯性导航***的运动对准方法,以解决参考坐标系速度/位置辅助下惯性导航***的运动对准问题,在没有任何姿态先验初值的情况下实现惯性导航***的快速姿态对准。
为达到上述目的,本发明提供了一种惯性导航***的运动对准方法,该惯性导航***安装于运动载体上,该方法包括:惯性导航***测量自身的转动信息和线加速度信息;惯性导航***同步接收由外部辅助信息源提供的(经由必要的杆臂补偿后)自身在参考坐标系中的参考速度和位置信息;以及惯性导航***对转动信息和线加速度信息以及参考速度和位置信息进行数据处理,得到自身在当前时刻的体坐标系相对于参考坐标系的姿态。
从上述技术方案可以看出,本发明具有以下有益效果:
1、本发明提供的惯性导航***的运动对准方法,基于特殊的速度和位置积分公式,分别设计实现了迭代形式的速度积分运动对准算法和位置积分运动对准算法,能够根据辅助的速度/位置信息,实时计算出惯性导航***的当前姿态,有效地解决了参考坐标系速度/位置辅助下惯性导航***的运动对准问题,在没有任何姿态先验初值的情况下实现了惯性导航***的快速姿态对准。
2、本发明提供的惯性导航***的运动对准方法,无需知道惯性器件及外部速度/位置信息的噪声特性,无需任何姿态初值,具有绝对的计算稳定性,不存在发散的情况,只要速度/位置辅助信息有效,能够在任意运动情况下实现姿态对准,大幅缩短载体导航前的准备时间。
3、本发明提供的惯性导航***的运动对准方法,在本发明实施例考虑的应用场合中,INS安装在运动载体上,INS在参考坐标系中的速度和位置信息由GPS或其他外部信息源(经由必要的杆臂补偿后)给出。
4、本发明提供的惯性导航***的运动对准方法,根据惯性器件误差是否在线补偿的要求,速度积分运动对准算法和位置积分运动对准算法的输出结果既可以直接用于惯性导航解算(精对准),也可以作为非线性滤波方法的姿态初值(粗对准)对导航参数和惯性器件误差进行联合估计与标校。
附图说明
图1是依照本发明实施例的速度积分运动对准算法和位置积分运动对准算法的输入输出关系示意图;
图2是依照本发明实施例的速度积分运动对准算法的方法流程图;
图3是依照本发明实施例利用速度积分运动对准算法和位置积分运动对准算法来计算姿态矩阵和的方法流程图;
图4是依照本发明实施例的速度积分运动对准算法中计算αv(tM)的方法流程图;
图5是依照本发明实施例的速度积分运动对准算法中计算βv(tM)的方法流程图;
图6是依照本发明实施例的速度积分运动对准算法和位置积分运动对准算法中计算K(tM)的方法流程图;
图7是依照本发明实施例的速度积分运动对准算法和位置积分运动对准算法中计算的方法流程图。
图8是依照本发明实施例的位置积分运动对准算法的方法流程图;
图9是依照本发明实施例的位置积分运动对准算法中计算αp(tM)的方法流程图;
图10是依照本发明实施例的位置积分运动对准算法中计算βp(tM)的方法流程图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,以下结合具体实施例,并参照附图,对本发明进一步详细说明。
本发明提供的惯性导航***的运动对准方法,根据外部信息源(如GPS)经由必要的杆臂补偿后提供的INS在参考坐标系中的参考速度和位置信息,并基于特殊的速度和位置积分公式,分别设计实现了迭代形式的速度积分运动对准和位置积分运动对准,能够根据辅助的速度/位置信息,实时计算出INS在当前时刻的体坐标系相对于参考坐标系的姿态。
本发明实施例用到的坐标系至少有以下几个:惯性坐标系(I),参考坐标系(N),地球坐标系(E)和体坐标系(B)。
不失一般性,本发明实施例中的参考坐标系是选择北天东(North-Up-East)指向的当地水平坐标系。对于其他参考坐标系(如地球坐标系),下面的描述将稍有变化,但这不影响对本发明主要思想的理解。
假定INS在[0,t]时间段内进行对准。本发明的运动对准方法基于如下积分公式设计实现
速度积分公式:
位置积分公式:
其中为从体坐标系到参考坐标系的姿态矩阵(正交且行列式为1),为姿态矩阵在初始时刻的取值,fb为加速度计测量到的比力, 为INS在参考坐标系中表示的对地速度,vn(0)为对地速度在初始时刻的取值,是参考坐标系中表示的地球角速度,gn是参考坐标系中表示的当地重力加速度,rn定义为对地速度的积分,即 其中 以当地地理坐标表示的INS位置 (经度,纬度,高度)。RE和RN分别是当地的卯酉圈曲率半径和子午圈曲率半径。若非特别说明,以上变量都是时间t的函数,为方便起见,时间t省略。
速度积分公式1或位置积分公式2均可以用来确定初始姿态矩阵分别称作“速度积分运动对准算法”和“位置积分运动对准算法”。我们需要设计数值算法近似计算公式1-公式2中的连续积分,积分近似计算的误差越小,的估计结果越好。注意:是一个常矩阵。初始姿态矩阵和当前时刻的姿态矩阵通过链式乘积规则相联系,即
其中,是位置和速度的函数,是陀螺测量的转动角速度的函数。根据公式3,如果右边三项能够分别获得,自然就得到了任意时刻的姿态矩阵。
下面将依次阐述速度积分运动对准算法和位置积分运动对准算法的设计详情,两者共同的步骤将统一在速度积分运动对准算法中阐述。
图1给出了依照本发明实施例的速度积分运动对准算法和位置积分运动对准算法的输入输出关系示意图。该方法的输入包括INS中陀螺测量到的角增量,加速度计测量到的速度增量,以及外部信息源提供的INS在参考坐标系中的速度和位置信息。本实施例中假定INS输出的是增量信息,对于输出信息为角速度和比力的INS,后面的计算会稍有不同。角增量和速度增量的通常以较高的频率输入(如200Hz),而外部速度和位置通常以较低的频率输入(如1Hz)。为了减小积分近似计算的误差,外部速度和位置最好以尽量高的频率输入。该方法对输入信息进行实时处理,输出为当前时刻INS体坐标系相对于参考坐标系的方向余弦矩阵,也可以根据实际要求转换为其他姿态参数,如四元数或欧拉角。
图2给出了依照本发明实施例的速度积分运动对准算法的方法流程图。考虑到实际的离散***实现,假定当前时刻t是更新间隔T的整数倍,即t=M×T,其中T为更新间隔(如0.01s),M为整数。更新的时间区间为[tktk+1],k=0,1,2,…,M一1,其中tk=kT。该方法流程依次包括:初始化,时间更新M=M+1,姿态矩阵和更新,向量αv(tM)计算,向量βv(tM)计算,矩阵K(tM)计算,初始姿态矩阵确定,最后根据链式乘积规则(即公式3)得到INS的当前姿态。该方法初始化包括设置当前时刻t=0以及对该方法中的相关向量清零,即M=0,αv(0)=β′v(0)=03×1,以及K(0)=04×4。
图3给出了依照本发明实施例的速度积分运动对准算法和位置积分运动对准算法计算姿态矩阵和的方法流程图。和的计算是并列关系,没有时间先后顺序。注意当M=0时,和均为单位矩阵。是参考坐标系相对于惯性坐标系角速度的函数。由于选择了(北天东)当地水平坐标系为参考坐标系,与速度和位置的关系如下
其中地球自转角速率Ω≈7.292115×10-5rad/s。考虑为小量,在一个更新时间区间内,参考坐标系相对惯性坐标系的旋转向量根据方向余弦矩阵和旋转向量之间的转化关系,
公式5
再由姿态矩阵的链式乘积规则,即公式3,我们有
由于INS体坐标系相对于惯性坐标系的变化较快,对应的旋转向量通常需要进行圆锥补偿。假定在一个更新时间区间内,陀螺先后两次采样,记作Δθ1,Δθ2,加速度计先后两次采样,记作Δv1,Δv2。INS体坐标系相对于惯性坐标系的旋转向量可近似为根据方向余弦矩阵和旋转向量之间的转化关系,
公式6
同样由姿态矩阵的链式乘积规则,即公式3,我们有
可以看出,的计算用到了外部辅助的速度和位置信息。的计算则假定更新时间区间内有两次INS采样,对于其他子样数目的情形,只需在计算时作相应改动即可。
图4给出了依照本发明实施例的速度积分运动对准算法中计算αv(tM)的方法流程图。根据速度积分公式1中给出的定义,αv(tM)涉及到近似计算变换后的比力的积分利用一次更新时间区间T内的先后两次角增量和速度增量采样,并进行相应的划摇补偿,αv(tM)可以根据下式迭代计算
注意当M=0时,αv(0)=03×1。对于其他子样数目的情形,划摇补偿u的计算将有所不同。
图5给出了依照本发明实施例的速度积分运动对准算法中计算βv(tM)的方法流程图。当地重力加速度gn是位置的函数,可根据重力场模型计算得到,而βv(tM)的计算用到了外部速度和位置信息。根据速度积分公式1中给出的定义,βv(tM)涉及到近似计算两个积分:和假定更新区间内近似线性变化,gn近似常值,βv(tM)可以根据下面的公式8迭代计算:
注意当M=0时,β′v(0)=03×1。
图6给出了依照本发明实施例的速度积分运动对准算法和位置积分运动对准算法中计算K(tM)的方法流程图。首先来看速度积分算法,定义如下4×4矩阵
其中使用了两个特殊的四元数乘法矩阵。对于三维向量r,四元数乘法矩阵的定义如下
其中r×为r的反对称矩阵。假定被积函数在更新区间内近似常值,K(tM)可以根据下式迭代计算
注意当M=0时,K(0)=04×4。
对于位置积分算法,上述过程基本相同,不同之处在于用βp替代βv,αp替代αv,具体包括:定义如下4×4矩阵其中使用了两个特殊的四元数乘法矩阵;对于三维向量r,四元数乘法矩阵的定义如下:
假定被积函数在更新区间内近似常值,K(tM)能够根据下式迭代计算
其中当M=0时,K(0)=04×4。
图7给出了依照本发明实施例的速度积分运动对准算法和位置积分运动对准算法中计算的方法流程图。对于速度积分算法,可以证明:满足的初始姿态矩阵所对应的姿态四元数是矩阵K的最小特征值所对应的特征向量,记作q。在标准算法库中可找到成熟算法用来求解4×4矩阵K(tM)的特征向量,计算负担不大。将q写成[sηT]T,根据方向余弦矩阵和四元数之间的转化关系,我们有
以上只给出了一种借助四元数求解的特殊方法,当然也可以用其他方法求解。最后根据链式乘积规则(即公式3)得到INS的当前姿态
对于位置积分算法,上述过程基本相同,不同之处在于用βp替代βv,αp替代αv,具体包括:满足的初始姿态矩阵所对应的姿态四元数是矩阵K的最小特征值所对应的特征向量,记作q;在标准算法库中能够找到成熟算法用来求解4×4矩阵K(tM)的特征向量,将q写成[sηT]T,根据方向余弦矩阵和四元数之间的转化关系,得到
图8给出了依照本发明实施例的位置积分运动对准算法的方法流程图,其基本结构与速度积分运动对准算法的内部信息流程图大体相同。内部信息流程依次包括:初始化,时间更新M=M+1,姿态矩阵和更新,向量αp(tM)计算,向量βp(tM)计算,矩阵K(tM)计算,初始姿态矩阵确定,最后根据链式乘积规则(即公式3)得到INS的当前姿态。方法初始化包括设置当前时刻t=0以及对方法中的相关向量清零,即M=0,αv(0)=β′v(0)=03×1,up(0)=ur(0)=uv(0)=ug(0)=03×1以及K(0)=04×4。
图9给出了依照本发明实施例的位置积分运动对准算法中计算αp(tM)的方法流程图。根据位置积分公式2中给出的定义,αp(tM)涉及到近似计算变换后的比力的双重积分利用一次更新时间区间内的先后两次角增量和速度增量采样,并进行相应的卷轴补偿,αp(tM)可以根据下面的公式14迭代计算:
注意当M=0时,αp(0)=03×1。对于其他子样数目的情形,卷轴补偿u的计算将有所不同。
图10给出了依照本发明实施例的位置积分运动对准算法中计算βp(tM)的方法流程图。根据位置积分公式2中给出的定义,βp(tM)涉及到近似计算一个单重积分:以及两个双重积分: 和 假定更新区间内近似线性变化,gn近似常值,βp(tM)可以根据下面的公式15迭代计算:
注意当M=0时,β′p(0)=03×1。
以上所述的具体实施例,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (19)
1.一种惯性导航***的运动对准方法,该惯性导航***安装于运动载体上,其特征在于,该方法包括:
惯性导航***测量自身的转动信息和线加速度信息;
惯性导航***同步接收由外部辅助信息源提供的其在参考坐标系中的参考速度和位置信息;以及
惯性导航***对转动信息和线加速度信息以及参考速度和位置信息进行数据处理,得到自身在当前时刻的体坐标系相对于参考坐标系的姿态,包括:所述惯性导航***利用速度积分运动对准算法或位置积分运动对准算法对转动信息和线加速度信息以及参考速度和位置信息进行计算,得到姿态矩阵和以及初始姿态矩阵然后通过链式乘积规则得到自身在当前时刻t的体坐标系相对于参考坐标系的姿态,其中n代表参考坐标系,b代表体坐标系,0代表初始时刻,tM=M×T,T代表时间间隔,M为整数。
2.根据权利要求1所述的惯性导航***的运动对准方法,其特征在于,所述惯性导航***包括三轴陀螺和三轴加速度计,其中三轴陀螺用于测量转动角增量或角速度,三轴加速度计用于测量速度增量或比力。
3.根据权利要求1所述的惯性导航***的运动对准方法,其特征在于,所述惯性导航***利用速度积分运动对准算法或位置积分运动对准算法对转动信息和线加速度信息以及参考速度和位置信息进行计算的过程中,
采用的速度积分公式为:
采用的位置积分公式为:
其中,为从体坐标系到参考坐标系的姿态矩阵,其正交且行列式为1,为姿态矩阵在初始时刻的取值,fb为加速度计测量到的比力,vn=[vNvUvE]T为惯性导航***在参考坐标系中表示的对地速度,vn(0)为对地速度在初始时刻的取值,是参考坐标系中表示的地球角速度,gn是参考坐标系中表示的当地重力加速度,rn定义为对地速度的积分 其中 以当地地理坐标表示的惯性导航***位置 λ,L,h分别代表经度,纬度,高度;RE和RN分别是当地的卯酉圈曲率半径和子午圈曲率半径。
4.根据权利要求3所述的惯性导航***的运动对准方法,其特征在于,所述惯性导航***利用速度积分运动对准算法或位置积分运动对准算法对转动信息和线加速度信息以及参考速度和位置信息进行计算,得到姿态矩阵和包括:
是参考坐标系相对于惯性坐标系角速度的函数,选择北天东水平坐标系为参考坐标系,与速度和位置的关系如下:
其中地球自转角速率Ω≈7.292115×10-5rad/s,考虑为小量,在一个更新时间区间内,参考坐标系相对惯性坐标系的旋转向量根据方向余弦矩阵和旋转向量之间的转化关系
再由姿态矩阵的链式乘积规则,得到
由于惯性导航***的体坐标系相对于惯性坐标系的变化较快,对应的旋转向量通常需要进行圆锥补偿;假定在一个更新时间区间内,陀螺先后两次采样,记作Δθ1,Δθ2,加速度计先后两次采样,记作Δv1,Δv2;惯性导航***体坐标系相对于惯性坐标系的旋转向量可近似为根据方向余弦矩阵和旋转向量之间的转化关系
同样由姿态矩阵的链式乘积规则,得到
5.根据权利要求4所述的惯性导航***的运动对准方法,其特征在于,所述和的计算是并列关系,没有时间先后顺序,且当M=0时和均为单位矩阵。
6.根据权利要求4所述的惯性导航***的运动对准方法,其特征在于,所述惯性导航***利用速度积分运动对准算法对转动信息和线加速度信息以及参考速度和位置信息进行计算,得到初始姿态矩阵包括:
计算向量αv(tM);
计算向量βv(tM);
计算矩阵K(tM);以及
计算
7.根据权利要求6所述的惯性导航***的运动对准方法,其特征在于,所述计算向量αv(tM)包括:
根据公式1中的即αv(tM)涉及到近似计算变换后的比力的积分利用一次更新时间区间T内的先后两次角增量和速度增量采样,并进行相应的划摇补偿,αv(tM)能够根据下式迭代计算
其中当M=0时,αv(0)=03×1。
8.根据权利要求6所述的惯性导航***的运动对准方法,其特征在于,所述计算向量βv(tM)包括:
重力加速度gn是位置的函数,能够根据重力场模型计算得到,而βv(tM)的计算用到了外部速度和位置信息,根据速度积分公式1中给出的定义,βv(tM)涉及到近似计算两个积分:和假定更新区间内近似线性变化,gn近似常值,βv(tM)能够根据下式迭代计算
其中当M=0时,β′v(0)=03×1。
9.根据权利要求6所述的惯性导航***的运动对准方法,其特征在于,所述计算矩阵K(tM)包括:
定义如下4×4矩阵其中使用了两个特殊的四元数乘法矩阵;对于三维向量r,四元数乘法矩阵的定义如下
假定被积函数在更新区间内近似常值,K(tM)能够根据下式迭代计算
其中当M=0时,K(0)=04×4。
10.根据权利要求6所述的惯性导航***的运动对准方法,其特征在于,所述计算包括:
满足的初始姿态矩阵所对应的姿态四元数是矩阵K的最小特征值所对应的特征向量,记作q;在标准算法库中能够找到成熟算法用来求解4×4矩阵K(tM)的特征向量,将q写成[sηT]T,s和η分别代表四元数q的标量部分和向量部分,根据方向余弦矩阵和四元数之间的转化关系,得到
11.根据权利要求4所述的惯性导航***的运动对准方法,其特征在于,所述惯性导航***利用位置积分运动对准算法对转动信息和线加速度信息以及参考速度和位置信息进行计算,得到初始姿态矩阵包括:
计算向量αp(tM);
计算向量βp(tM);
计算矩阵K(tM);以及
计算
12.根据权利要求11所述的惯性导航***的运动对准方法,其特征在于,所述计算向量αp(tM)包括:
根据位置积分公式2中给出的定义,αp(tM)涉及到近似计算变换后的比力的双重积分利用一次更新时间区间内的先后两次角增量和速度增量采样,并进行相应的卷轴补偿,αp(tM)能够根据下式迭代计算
其中当M=0时,αp(0)=03×1;对于其他子样数目的情形,卷轴补偿u的计算将有所不同。
13.根据权利要求11所述的惯性导航***的运动对准方法,其特征在于,所述计算向量βp(tM)包括:
根据位置积分公式2中给出的定义,βp(tM)涉及到近似计算一个单重积分:以及两个双重积分:和假定更新区间内近似线性变化,gn近似常值,βp(tM)可以根据下式迭代计算
其中当M=0时,β′p(0)=03×1。
14.根据权利要求11所述的惯性导航***的运动对准方法,其特征在于,所述计算矩阵K(tM),其计算过程与采用速度积分运动对准算法计算矩阵K(tM)的过程基本相同,不同之处在于用βp替代βv,αp替代αv,具体包括:
定义如下4×4矩阵 其中使用了两个特殊的四元数乘法矩阵;对于三维向量r,四元数乘法矩阵的定义如下:
假定被积函数在更新区间内近似常值,K(tM)能够根据下式迭代计算
其中当M=0时,K(0)=04×4。
15.根据权利要求11所述的惯性导航***的运动对准方法,其特征在于,所述计算其计算过程与采用速度积分运动对准算法计算的过程基本相同,不同之处在于用βp替代βv,αp替代αv,具体包括:
满足的初始姿态矩阵所对应的姿态四元数是矩阵K的最小特征值所对应的特征向量,记作q;在标准算法库中能够找到成熟算法用来求解4×4矩阵K(tM)的特征向量,将q写成[sηT]T,s和η分别代表四元数q的标量部分和向量部分,根据方向余弦矩阵和四元数之间的转化关系,得到
16.根据权利要求1所述的惯性导航***的运动对准方法,其特征在于,所述外部辅助信息源是能够提供所需速度和位置信息的设备或方式。
17.根据权利要求16所述的惯性导航***的运动对准方法,其特征在于,所述外部辅助信息源是全球卫星定位***GPS。
18.根据权利要求16所述的惯性导航***的运动对准方法,其特征在于,根据运动对准的不同精度要求,所述外部辅助信息源是以精确测量的方式或者是以近似估算的方式提供所需的速度和位置信息。
19.根据权利要求16所述的惯性导航***的运动对准方法,其特征在于,所述外部辅助信息源经由杆臂补偿后向惯性导航***提供参考坐标系中的速度和位置信息。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2011/081268 WO2013059989A1 (zh) | 2011-10-25 | 2011-10-25 | 一种惯性导航***的运动对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103917850A CN103917850A (zh) | 2014-07-09 |
CN103917850B true CN103917850B (zh) | 2016-01-20 |
Family
ID=48167044
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201180074345.6A Expired - Fee Related CN103917850B (zh) | 2011-10-25 | 2011-10-25 | 一种惯性导航***的运动对准方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN103917850B (zh) |
WO (1) | WO2013059989A1 (zh) |
Families Citing this family (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104316059B (zh) * | 2014-11-05 | 2017-08-25 | 中国科学院嘉兴微电子与***工程中心 | 由里程计获得车辆经纬度的航位推算导航定位方法及*** |
CN105021212B (zh) * | 2015-07-06 | 2017-09-26 | 中国人民解放军国防科学技术大学 | 一种初始方位信息辅助下潜航器快速传递对准方法 |
CN105222764B (zh) * | 2015-09-29 | 2019-06-14 | 江西日月明测控科技股份有限公司 | 一种对惯性角速度传感器进行地球自转补偿的方法 |
CN105300407B (zh) * | 2015-10-09 | 2018-10-23 | 中国船舶重工集团公司第七一七研究所 | 一种用于单轴调制激光陀螺惯导***的海上动态启动方法 |
CN105806340B (zh) * | 2016-03-17 | 2018-09-07 | 武汉际上导航科技有限公司 | 一种基于窗口平滑的自适应零速更新算法 |
GB2550854B (en) | 2016-05-25 | 2019-06-26 | Ge Aviat Systems Ltd | Aircraft time synchronization system |
CN106908853B (zh) * | 2017-03-15 | 2018-09-18 | 中国人民解放军国防科学技术大学 | 基于相关分析与经验模分解的捷联式重力仪误差矫正方法 |
CN107677292B (zh) * | 2017-09-28 | 2019-11-15 | 中国人民解放军国防科技大学 | 基于重力场模型的垂线偏差补偿方法 |
CN110319851B (zh) * | 2018-03-30 | 2022-03-01 | 北京百度网讯科技有限公司 | 传感器的校正方法、装置、设备及存储介质 |
CN110646012A (zh) * | 2018-06-27 | 2020-01-03 | 北京自动化控制设备研究所 | 一种惯导***单位置初始对准最优方法 |
CN109724597B (zh) * | 2018-12-19 | 2021-04-02 | 上海交通大学 | 一种基于函数迭代积分的惯性导航解算方法及*** |
CN110285838B (zh) * | 2019-08-02 | 2022-12-13 | 中南大学 | 基于重力矢量时间差分的惯性导航设备对准方法 |
CN110411444B (zh) * | 2019-08-22 | 2024-01-09 | 深圳赛奥航空科技有限公司 | 一种地面下采掘移动设备用惯性导航定位***与定位方法 |
CN110926499B (zh) * | 2019-10-19 | 2023-09-01 | 北京工业大学 | 基于李群最优估计的sins捷联惯性导航***晃动基座自对准方法 |
CN110955256B (zh) * | 2019-12-03 | 2023-04-25 | 上海航天控制技术研究所 | 一种适用于潜射导弹的水下高精度姿态控制方法 |
CN111256732B (zh) * | 2020-03-01 | 2023-03-14 | 西北工业大学 | 一种用于水下双目视觉的目标姿态误差测量方法 |
CN112229421B (zh) * | 2020-09-16 | 2023-08-11 | 北京工业大学 | 基于李群最优估计的捷联惯性导航晃动基座粗对准方法 |
CN112945274B (zh) * | 2021-02-05 | 2022-11-18 | 哈尔滨工程大学 | 一种舰船捷联惯导***航行间粗对准方法 |
CN113091769A (zh) * | 2021-03-30 | 2021-07-09 | Oppo广东移动通信有限公司 | 姿态校准方法、装置、存储介质及电子设备 |
CN113483786B (zh) * | 2021-07-13 | 2023-08-11 | 中国船舶重工集团有限公司 | 一种无人潜航器导航定位***的残余误差测试方法 |
CN113959462B (zh) * | 2021-10-21 | 2023-09-12 | 北京机电工程研究所 | 一种基于四元数的惯性导航***自对准方法 |
CN114018255B (zh) * | 2021-11-03 | 2023-06-27 | 湖南国天电子科技有限公司 | 一种水下滑翔机的智能组合导航方法、***、设备和介质 |
CN114111798A (zh) * | 2021-12-07 | 2022-03-01 | 东南大学 | 一种基于仿射因子补偿的改进iccp方法 |
CN114353832A (zh) * | 2021-12-31 | 2022-04-15 | 天翼物联科技有限公司 | 一种无人船行进间粗对准方法、***、装置及存储介质 |
CN114577204B (zh) * | 2022-02-09 | 2024-01-02 | 中科禾华(扬州)光电科技有限公司 | 基于神经网络的捷联惯导***抗干扰自对准方法和装置 |
CN114462154A (zh) * | 2022-03-25 | 2022-05-10 | 东南大学 | 一种基于FBG+二阶Markov的传递对准方法 |
CN115574838A (zh) * | 2022-09-30 | 2023-01-06 | 中国人民解放军战略支援部队信息工程大学 | 一种组合导航***的自动对准方法 |
CN115752512A (zh) * | 2022-11-22 | 2023-03-07 | 哈尔滨工程大学 | 一种惯性基组合导航三轴不重合角标定方法及*** |
CN116481535B (zh) * | 2023-02-02 | 2024-06-25 | 中国科学院力学研究所 | 一种利用惯导数据修正飞行弹道数据的计算方法 |
CN116539029B (zh) * | 2023-04-03 | 2024-02-23 | 中山大学 | 一种水下动基座的基座定位方法、装置、存储介质及设备 |
CN117848389B (zh) * | 2024-03-08 | 2024-05-17 | 浙江航天润博测控技术有限公司 | 导航对准方法、导航设备及导航*** |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6088653A (en) * | 1996-12-31 | 2000-07-11 | Sheikh; Suneel I. | Attitude determination method and system |
GB2391732B (en) * | 2002-05-16 | 2005-09-07 | Furuno Electric Co | Attitude sensing apparatus for determining the attitude of a mobile unit |
CN101629826A (zh) * | 2009-07-01 | 2010-01-20 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航***粗对准方法 |
CN101672649B (zh) * | 2009-10-20 | 2011-08-03 | 哈尔滨工程大学 | 一种基于数字低通滤波的船用光纤捷联***系泊对准方法 |
CN101706284B (zh) * | 2009-11-09 | 2011-11-16 | 哈尔滨工程大学 | 提高船用光纤陀螺捷联惯导***定位精度的方法 |
CN101750066B (zh) * | 2009-12-31 | 2011-09-28 | 中国人民解放军国防科学技术大学 | 基于卫星定位的sins动基座传递对准方法 |
CN101915579A (zh) * | 2010-07-15 | 2010-12-15 | 哈尔滨工程大学 | 一种基于ckf的sins大失准角初始对准新方法 |
-
2011
- 2011-10-25 WO PCT/CN2011/081268 patent/WO2013059989A1/zh active Application Filing
- 2011-10-25 CN CN201180074345.6A patent/CN103917850B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN103917850A (zh) | 2014-07-09 |
WO2013059989A1 (zh) | 2013-05-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103917850B (zh) | 一种惯性导航***的运动对准方法 | |
CN106289246B (zh) | 一种基于位置和姿态测量***的柔性杆臂测量方法 | |
CN102692225B (zh) | 一种用于低成本小型无人机的姿态航向参考*** | |
CN105737828B (zh) | 一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航***初始化方法 | |
CN100516775C (zh) | 一种捷联惯性导航***初始姿态确定方法 | |
CN103344259B (zh) | 一种基于杆臂估计的ins/gps组合导航***反馈校正方法 | |
CN106405670B (zh) | 一种适用于捷联式海洋重力仪的重力异常数据处理方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN103217159B (zh) | 一种sins/gps/偏振光组合导航***建模及动基座初始对准方法 | |
CN105318876A (zh) | 一种惯性里程计组合高精度姿态测量方法 | |
CN106507913B (zh) | 用于管道测绘的组合定位方法 | |
CN102853837B (zh) | 一种mimu和gnss信息融合的方法 | |
CN103941274B (zh) | 一种导航方法及导航终端 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN102169184A (zh) | 组合导航***中测量双天线gps安装失准角的方法和装置 | |
CN110285815B (zh) | 一种可在轨全程应用的微纳卫星多源信息姿态确定方法 | |
CN103364817B (zh) | 一种基于r-t-s平滑的pos***双捷联解算后处理方法 | |
CN103217174B (zh) | 一种基于低精度微机电***的捷联惯导***初始对准方法 | |
CN111380516B (zh) | 基于里程计测量信息的惯导/里程计车辆组合导航方法及*** | |
CN103712621B (zh) | 偏振光及红外传感器辅助惯导***定姿方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
CN102519485A (zh) | 一种引入陀螺信息的二位置捷联惯性导航***初始对准方法 | |
CN103278165A (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160120 Termination date: 20201025 |