CN106814383B - 一种适用于多种模式下的高精度pos快速对准方法 - Google Patents
一种适用于多种模式下的高精度pos快速对准方法 Download PDFInfo
- Publication number
- CN106814383B CN106814383B CN201710032696.XA CN201710032696A CN106814383B CN 106814383 B CN106814383 B CN 106814383B CN 201710032696 A CN201710032696 A CN 201710032696A CN 106814383 B CN106814383 B CN 106814383B
- Authority
- CN
- China
- Prior art keywords
- alignment
- matrix
- time
- pos
- carrier
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO 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/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining 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
本发明提供一种适用于多种模式下的高精度POS快速对准方法,包括判断POS系统处于静止状态或运动状态,相应选择对准模式为静对准或者动对准;进行静对准或者动对准,同时继续检测系统的运动状态,静对准时采用基于惯性系的对准方式对姿态矩阵进行分解,动对准时采用基于快速卡尔曼滤波的对准方式;判断对准是否成功,若对准成功则反馈对准结果,若对准失败则根据检测到的载体运动状态调整对准模式,重新对准。本发明适用于陆地、航空、航海等多种工作模式下的高精度定位定姿系统的初始对准,使得系统能够快速有效的获取准确的初始航向和姿态信息。
Description
技术领域
本发明涉及陆地、航空和航海等多种模式下的高精度定位定姿技术领域,尤其涉及一种适用于陆地/航空/航海等多种模式下的高精度定位定姿系统(POS)动态快速对准技术。
背景技术
高精度定位定姿系统是集GPS定位和惯性导航技术于一体的系统,通过采用卡尔曼滤波技术实现数据的融合,POS系统将充分发挥GPS和INS各自的优点,能够为处于陆地/航空/航海模式下的载荷提供实时、高精度的位置、航向、姿态和速度等信息,能为运动载荷的导航和制导提供重要的信息。
随着科技的进步和社会的发展,人们对地理空间信息的获取和更新速度提出了更高的需求,传统的测绘方式已经不能满足这一需求,测绘科技工作者必须寻求更高效、可靠的空间信息获取技术。在这种需求下,移动测量系统应运而生,能够实现陆地、航空、航海等多种模式下的地理空间信息获取,给测绘行业带来了一场信息技术革命。
移动测量系统的运用需要高精度的POS系统提供高精度、可靠的导航信息,目前国外一些公司,如加拿大的Applanix、美国Z/I Imaging和德国IGI等已经开发出相应的机载和车载POS产品并应用于航空摄影和地面空间数据的采集,但其对华实施产品禁运和相关技术封锁。随着我国对惯性测量技术、高精度GPS接收机研究的不断深入,特别是随着我国北斗卫星定位技术的不断发展,研究具有自主知识产权的高精度定位定姿测量系统,并将其用于城市空间地理信息的获取和国土测量等领域中,不但为我国大规模生产实践、国民经济建设、社会发展、人们生活提供必要的基础地理信息,还可使我国在导航技术中有所突破,摆脱对国外技术的依赖。
发明内容
POS系统的动态快速对准技术是保证系统可靠、高效运转的重要技术,针对这一技术难题,本发明在捷联惯导误差模型研究的基础上,提出了一种适用于陆地/航空/航海/多种模式下的高精度POS动态快速对准技术。
本发明采用的技术方案提供一种适用于多种模式下的高精度POS快速对准方法,包括以下步骤:
步骤1,判断POS系统处于静止状态或运动状态,相应选择对准模式为静对准或者动对准;步骤2,根据步骤1中选择结果,相应进行静对准或者动对准,同时继续检测系统的运动状态;
设惯性坐标系标记为i,地球坐标系标记为e,导航坐标系标记为n,载体坐标系标记为b,
静对准时,采用基于惯性系的对准方式,包括将姿态矩阵分解如下式:
式中,ib0指初始对准t0时刻的载体坐标系,为t时刻惯性系与n系之间的变换矩阵,由载体的地理位置及粗对准时间t确定;为t时刻b系与ib0系之间的变换矩阵,利用陀螺输出的b系相对ib0系的角运动信息确定;为ib0系与i系之间的变换矩阵,由重力加速度与加速度计输出之间的转换关系求得;
动对准时,采用基于快速卡尔曼滤波的对准方式;
步骤3,判断对准是否成功,若对准成功则反馈对准结果,若对准失败则根据检测到的载体运动状态调整对准模式,重新对准。
而且,采用基于快速卡尔曼滤波的对准方式时,在基于SINS/GPS离散模型转移矩阵Φk/k-1和Φk/k-1和系统状态向量误差方差矩阵Pk-1计算一步预测误差方差矩阵时,先计算矩阵B=Φk/k-1Pk-1,再计算矩阵计算B=Φk/k-1Pk-1时,通过直接展开Φk/k-1Pk-1来表示B的每一个元素。
而且,当POS系统在静态过程中上电启动,若在步骤3中判断对准失败,判定是否执行静态对准的时间已超过预设的时间阈值,若是则转入动对准模式。
而且,变换矩阵求取如下,
其中,t表示对准时间,ωie表示地球自转角速度矢量,λ表示载体所在位置的经度,L表示载体所在位置的纬度,表示e系相对于i系的旋转矩阵,表示n系相对于e系的位置矩阵。
而且,变换矩阵通过捷联惯导姿态更新算法求得。
而且,变换矩阵求取如下,
取t0<tu≤tv<td,其中t0为粗对准开始时刻、td为粗对准结束时刻,
其中,表示时刻t0到tu加速度计输出的比力增量在ib0系的投影、表示时刻tv到td加速度计输出的比力增量在ib0系的投影、表示时刻t0到tu加速度计输出的比力增量在i系的投影、表示时刻tv到td加速度计输出的比力增量在i系的投影。
本发明具有下列优点和积极效果:
1)本发明适用于陆地、航空、航海等多种工作模式下的高精度定位定姿系统的初始对准,
使得系统能够快速有效的获取准确的初始航向和姿态信息,具有重要的市场价值;
2)对准时间短,精度高,系统计算量小;
3)可根据系统运动状态自主选择最优的对准方式,自主性好。
附图说明
图1是本发明实施例的流程图。
具体实施方式
以下结合附图和实施例对本发明技术方案进行具体描述。
本发明所提供技术方案,是根据POS系统上电时的运动状态,自动选取对准的方式,以适应陆地/航空/航海等多种模式的应用需求,具体实施时POS系统通过工装与相应载体固连。
当POS系统在静态过程中上电启动时,系统在传统解析式粗对准的基础上,将初始对准姿态矩阵进行分解,使得粗对准具有跟踪载体角运动的功能(具体可参见后续公式(3),(6),(15)),降低晃动对系统对准的影响,获得的是粗对准结束时刻的姿态矩阵。
当POS系统在运动过程中开机或者重新启动时,需要利用动基座对准技术,本方案利用GPS轨迹的航迹角对惯导初始方位进行粗对准,一般误差能够控制在10度以内,由于粗对准对水平姿态角的初始值精度要求不高,而载体的水平姿态角一般不大,不妨将其初始化为零,惯导系统的速度初值由GPS提供,这样构成一个小失准角的SINS/GPS对准系统。在利用卡尔曼滤波进行组合导航解算是为了提高解算速度。本方案采用直接展开法,摒弃了程序循环控制计算方法,直接展开法虽然增加了少许程序长度和降低了通用性,但是极大减少了乘法运算次数和程序循环控制开销,有利于减少数值舍入累积误差,直接展开法还考虑了协方差阵的对称性,提高了数值稳定性。
进一步,特殊地,可以当POS系统在静态过程中上电启动,静态对准时间不满足系统需求时,系统将在静态粗对准的基础上迅速转入动基座对准模式,提高对准精度,减少对准时间。
因此,本发明的基本工作原理是:
本发明首先根据POS系统上电前几秒采集的IMU和GNSS数据判断系统的初始状态,并根据相应的状态选择对准模式进行初始对准,并在对准的过程中实时监测系统的运动状态,并根据检测结果对系统的对准模式进行相应的调整。系统在静态模式时,采用基于惯性坐标系的对准技术,快速准确获取载体的初始姿态信息;系统在动态模式时,采用基于快速卡尔曼滤波的动对准技术,快速有效地获取载体的精确姿态角信息。
参见图1,实施例包括以下步骤:
1)判断POS系统处于静止状态或运动状态,相应选择对准模式为静对准或者动对准;POS系统通过工装与载体固连,运动状态一致;
2)根据步骤1)中选择结果,相应进行静对准或者动对准,同时继续检测系统的运动状态;
A.静对准时,采用基于惯性系的对准方式,具体步骤如下:
传统解析式粗对准中,姿态矩阵的计算如下式:
式中,下标中的“i”和“e”分别表示惯性坐标系(i系)和地球坐标系(e系),gn和为重力加速度矢量和地球旋转矢量在导航坐标系(n系)中的投影,gb和为重力加速度矢量和地球旋转矢量在载体坐标系(b系)中的投影。
如果载体出现较大幅值的晃动干扰,上述粗对准方法可能产生很大误差,为减小晃动对对准的影响,将姿态矩阵分解如下式:
式中,ib0指初始对准t0时刻的载体坐标系,为t时刻惯性系(i系)与n系之间的变换矩阵,可由载体的地理位置及粗对准时间t确定;为t时刻b系与ib0系之间的变换矩阵,利用陀螺输出的b系相对ib0系的角运动信息,通过捷联惯导姿态更新算法可以求得该矩阵;为ib0系与i系之间的变换矩阵,该矩阵是个常值阵,可由重力加速度与加速度计输出之间的转换关系求得。
a)求解变换矩阵
变换矩阵可由n系相对于e系的位置矩阵和e系相对于i系转过的角度ωiet求得,即
式中,t表示对准时间,ωie表示地球自转角速度矢量,λ表示载体所在位置的经度,L表示载体所在位置的纬度,表示e系相对于i系的旋转矩阵。
b)求解变换矩阵
变换矩阵可通过陀螺采样输出,利用现有技术的捷联惯导姿态更新算法可求得。假设tk时刻和tk+1时刻的变换矩阵分别为和其对应的变换四元数分别为和显然有和其中I表示单位矩阵。再假设tk时刻至tk+1时刻陀螺输出的角增量为Δθk,则利用等效旋转矢量单子样算法可得b系相对于ib0系从tk时刻至tk+1时刻的变换四元数为:
从而可进行四元数更新解算
最后,假设四元数矢量其中q0、q1、q2和q3表示四元数,是表示两个3维空间矢量转换关系的一种方式。则由变换四元数和变换矩阵之间的关系可计算得tk时刻的变换矩阵
变换矩阵的更新解算使得粗对准具有了跟踪载体角运动的功能,获得粗对准结束时刻的姿态矩阵。
c)求解变换矩阵
变换矩阵是个常值矩阵,当载车静止时,该矩阵可由重力加速度在i系的投影gi与加速度计输出在ib0系的投影之间的转换关系求得,即
其中,表示初始对准t0时刻的载体坐标系相对于惯性系(i系)的转换矩阵,另外有:
公式(8)和公式(9)中,表示加速度计输出量在载体系(b系)中的投影,gn表示重力加速度在导航系(n系)中的投影,表示惯性系相对于载体系的转换矩阵。
公式(7)中取两个不同时刻tl时刻和tm时刻(tl<tm)的变换方程,类似于(1)式的方法可得:
当tl时刻与tm时刻很接近时,上式中tl和tm时刻惯性系下的重力加速度分量和几乎平行,为了降低计算误差应使tl适当远离tm。公式(10)中,和表示tl时刻与tm时刻加速度输出量在系中的分量。
由于惯性器件噪声等随机干扰的存在,应对(7)式在tl时刻和tm时刻附近积分,以降低干扰的影响。设tk时刻至tk+1时刻陀螺输出的角增量为Δθk,加速度计输出的比力速度增量为Δvk,类似于捷联惯导速度更新算法,利用速度单子样算法由(8)式可得在ib0系上投影的速度更新算法:
其中,表示时刻tr到tk加速度计输出的比力增量在ib0系的投影,tr≤tk;表示时刻tr到tk加速度计输出的比力增量在ib0系的投影;另外,将(3)式代入(9)式并从tr时刻至tk时刻积分可得
公式(12)中,g表示重力加速度,表示时刻tr到tk加速度计输出的比力增量在i系的投影,表示导航系(n系)相对于惯性系(i系)的转换矩阵。取t0<tu≤tv<td,其中t0为粗对准开始时刻、td为粗对准结束时刻,tu、tv为期间的两个时刻,则将(7)式两边都积分可得
式中表示时刻t0到tu加速度计输出的比力增量在ib0系的投影、表示时刻tv到td加速度计输出的比力增量在ib0系的投影、表示时刻t0到tu加速度计输出的比力增量在i系的投影、表示时刻tv到td加速度计输出的比力增量在i系的投影,并类似于(1)式的方法可得
d)求解粗对准姿态矩阵
将(3)式、(6)式和(15)式代入(2)式即可求得粗对准姿态矩阵
B.动对准时,采用基于快速卡尔曼滤波的对准方式,具体步骤如下:
a)建立空中动基座对准状态方程如下:
式中,x表示状态向量,表示x的一阶微分,系统状态矩阵Ff
公式(17)中,和表示在导航坐标系(n系)中加速度计输出的比力在x、y、z三个轴向的分量。
b)选择航向、姿态和速度6维状态向量,建立空中动基座对准量测方程如下:
公式(18)中,表示航向、俯仰和横滚,δνn表示速度矢量,T表示向量或者矩阵的转置。
空中动基座对准速度量测方程为
其中,
c)对POS系统进行快速卡尔曼滤波,具体过程如下:
在SINS/GPS离散模型转移矩阵Φk/k-1的225个元素中,仅有71个非零元素(包含13个1元素),因此在利用转移矩阵Φk/k-1和系统状态向量误差方差矩阵Pk-1计算时存在大量的乘0和部分的乘1过程,然而这两种无实质意义的乘法操作都是可以省略的。
SINS/GPS离散模型转移矩阵Φk/k-1可参见相关文献:严恭敏.车载自主定位定向系统研究[D].西安:西北工业大学博士学位论文,2006,5.
改进计算方法的思路是将一步预测误差方差矩阵的计算分为两步,先计算前两矩阵相乘且记为矩阵B=Φk/k-1Pk-1,再计算矩阵计算B=Φk/k-1Pk-1时,通过直接展开Φk/k-1Pk-1来表示B的每一个元素,例如,在SINS/GPS中实际编程时B(1,1)直接写成:
式中,B(1,1)表示矩阵元素的临时变量,Φk/k-1(i,j)表示矩阵Φk/k-1第i行第j列元素,Pk-1(i,j)表示矩阵Pk-1第i行第j列元素。计算时,考虑到C是对称矩阵,则只需先展开上三角矩阵(或下三角矩阵),再利用对称性给另一半矩阵直接赋值即可。
3)判断对准是否成功,若对准成功则反馈对准结果,若对准失败则根据检测到的载体运动状态调整对准模式,重新对准:
由于POS系统内部反馈机制,对准过程完成后,对准函数会反馈对准状态,POS系统会根据对准状态判断对准成功与否。实施例根据POS系统输出的对准状态标志(对准状态字)判断系统对准是否成功,若对准成功则将对准结果反馈给POS系统,若对准失败则根据检测到的载体运动状态调整对准模式,重新对准。此时可以仍然是静止状态则相应选择对准模式为静对准,运动状态则相应选择对准模式为动对准。进一步地,当POS系统在静态过程中上电启动,此时也可以判定是否执行静态对准的时间已超过系统需求(超过预设的时间阈值),若是则可直接转入动基座对准模式。
以上内容是结合实施例对本发明所做的进一步详细说明,不能认定本发明的具体实施只限于这些说明。本领域的技术人员应该理解,在不脱离由所附权利要求书限定的情况下,可以在细节上进行各种修改,都应当视为属于本发明的保护范围。
Claims (6)
1.一种适用于多种模式下的高精度POS快速对准方法,其特征在于,包括以下步骤:
步骤1,判断POS系统处于静止状态或运动状态,相应选择对准模式为静对准或者动对准;
步骤2,根据步骤1中选择结果,相应进行静对准或者动对准,同时继续检测系统的运动状态;
设惯性坐标系标记为i,地球坐标系标记为e,导航坐标系标记为n,载体坐标系标记为b,
静对准时,采用基于惯性系的对准方式,包括将姿态矩阵分解如下式:
<mrow>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<mi>n</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>C</mi>
<mi>i</mi>
<mi>n</mi>
</msubsup>
<msubsup>
<mi>C</mi>
<msub>
<mi>i</mi>
<mrow>
<mi>b</mi>
<mn>0</mn>
</mrow>
</msub>
<mi>i</mi>
</msubsup>
<msubsup>
<mi>C</mi>
<mi>b</mi>
<msub>
<mi>i</mi>
<mrow>
<mi>b</mi>
<mn>0</mn>
</mrow>
</msub>
</msubsup>
</mrow>
式中,ib0指初始对准t0时刻的载体坐标系,为t时刻惯性系与n系之间的变换矩阵,由载体的地理位置及粗对准时间t确定;为t时刻b系与ib0系之间的变换矩阵,利用陀螺输出的b系相对ib0系的角运动信息确定;为ib0系与i系之间的变换矩阵,由重力加速度与加速度计输出之间的转换关系求得;
动对准时,采用基于快速卡尔曼滤波的对准方式;
步骤3,判断对准是否成功,若对准成功则反馈对准结果,若对准失败则根据检测到的载体运动状态调整对准模式,重新对准。
2.根据权利要求1所述适用于多种模式下的高精度POS快速对准方法,其特征在于:采用基于快速卡尔曼滤波的对准方式时,在基于SINS/GPS离散模型转移矩阵Φk/k-1和系统状态向量误差方差矩阵Pk-1计算一步预测误差方差矩阵时,先计算矩阵B=Φk/k-1Pk-1,再计算矩阵计算B=Φk/k-1Pk-1时,通过直接展开Φk/k-1Pk-1来表示B的每一个元素。
3.根据权利要求1或2所述适用于多种模式下的高精度POS快速对准方法,其特征在于:当POS系统在静态过程中上电启动,若在步骤3中判断对准失败,判定是否执行静态对准的时间已超过预设的时间阈值,若是则转入动对准模式。
4.根据权利要求1或2所述适用于多种模式下的高精度POS快速对准方法,其特征在于:变换矩阵求取如下,
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>C</mi>
<mi>i</mi>
<mi>n</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>C</mi>
<mi>e</mi>
<mi>n</mi>
</msubsup>
<msubsup>
<mi>C</mi>
<mi>i</mi>
<mi>e</mi>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>cos</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mi>&lambda;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&lambda;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&lambda;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&lambda;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mi>&lambda;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>L</mi>
<mi> </mi>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mi>&lambda;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mi>i</mi>
<mi>e</mi>
</mrow>
</msub>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi> </mi>
<mi>L</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,t表示对准时间,ωie表示地球自转角速度矢量,λ表示载体所在位置的经度,L表示载体所在位置的纬度,表示e系相对于i系的旋转矩阵,表示n系相对于e系的位置矩阵。
5.根据权利要求1或2所述适用于多种模式下的高精度POS快速对准方法,其特征在于:变换矩阵通过捷联惯导姿态更新算法求得。
6.根据权利要求1或2所述适用于多种模式下的高精度POS快速对准方法,其特征在于:变换矩阵求取如下,
取t0<tu≤tv<td,其中t0为粗对准开始时刻、td为粗对准结束时刻,
<mrow>
<msubsup>
<mi>C</mi>
<msub>
<mi>i</mi>
<mrow>
<mi>b</mi>
<mn>0</mn>
</mrow>
</msub>
<mi>i</mi>
</msubsup>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>0</mn>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>v</mi>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>d</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>0</mn>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>i</mi>
</msubsup>
<mo>&times;</mo>
<msubsup>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>v</mi>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>d</mi>
</msub>
<mo>)</mo>
</mrow>
<mi>i</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>0</mn>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>i</mi>
<mrow>
<mi>b</mi>
<mn>0</mn>
</mrow>
</msub>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>v</mi>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>d</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>i</mi>
<mrow>
<mi>b</mi>
<mn>0</mn>
</mrow>
</msub>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>0</mn>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>u</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>i</mi>
<mrow>
<mi>b</mi>
<mn>0</mn>
</mrow>
</msub>
</msubsup>
<mo>&times;</mo>
<msubsup>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mi>v</mi>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>d</mi>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>i</mi>
<mrow>
<mi>b</mi>
<mn>0</mn>
</mrow>
</msub>
</msubsup>
<mo>)</mo>
</mrow>
<mi>T</mi>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,表示时刻t0到tu加速度计输出的比力增量在ib0系的投影、表示时刻tv到td加速度计输出的比力增量在ib0系的投影、表示时刻t0到tu加速度计输出的比力增量在i系的投影、表示时刻tv到td加速度计输出的比力增量在i系的投影。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710032696.XA CN106814383B (zh) | 2017-01-16 | 2017-01-16 | 一种适用于多种模式下的高精度pos快速对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710032696.XA CN106814383B (zh) | 2017-01-16 | 2017-01-16 | 一种适用于多种模式下的高精度pos快速对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106814383A CN106814383A (zh) | 2017-06-09 |
CN106814383B true CN106814383B (zh) | 2018-01-12 |
Family
ID=59111290
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710032696.XA Active CN106814383B (zh) | 2017-01-16 | 2017-01-16 | 一种适用于多种模式下的高精度pos快速对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106814383B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115507847A (zh) * | 2022-11-07 | 2022-12-23 | 北京晨晶电子有限公司 | 多模式惯性导航系统以及导航信息获取方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101246022B (zh) * | 2008-03-21 | 2010-06-09 | 哈尔滨工程大学 | 基于滤波的光纤陀螺捷联惯导系统两位置初始对准方法 |
CN101629826A (zh) * | 2009-07-01 | 2010-01-20 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法 |
CN102621565B (zh) * | 2012-04-17 | 2013-12-04 | 北京航空航天大学 | 一种机载分布式pos的传递对准方法 |
CN103245360B (zh) * | 2013-04-24 | 2015-09-09 | 北京工业大学 | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 |
CN103471616B (zh) * | 2013-09-04 | 2016-01-27 | 哈尔滨工程大学 | 一种动基座sins大方位失准角条件下初始对准方法 |
CN104501838B (zh) * | 2015-01-20 | 2017-08-29 | 上海华测导航技术股份有限公司 | 捷联惯导系统初始对准方法 |
-
2017
- 2017-01-16 CN CN201710032696.XA patent/CN106814383B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN106814383A (zh) | 2017-06-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
García Carrillo et al. | Combining stereo vision and inertial navigation system for a quad-rotor UAV | |
Sun et al. | Robust IMU/GPS/VO integration for vehicle navigation in GNSS degraded urban areas | |
CN109885080B (zh) | 自主控制系统及自主控制方法 | |
CN101846734B (zh) | 农用机械导航定位方法、系统及农用机械工控机 | |
CN102169184A (zh) | 组合导航系统中测量双天线gps安装失准角的方法和装置 | |
CN106052685A (zh) | 一种两级分离融合的姿态和航向估计方法 | |
CN108955671B (zh) | 一种基于磁偏角、磁倾角的卡尔曼滤波导航方法 | |
CN112902956A (zh) | 一种手持式gnss/mems-ins接收机航向初值获取方法、电子设备、存储介质 | |
Gao et al. | An integrated land vehicle navigation system based on context awareness | |
TW202016506A (zh) | 一種衛星姿態資料融合系統及其方法 | |
CN113670334B (zh) | 一种飞行汽车的初始对准方法和装置 | |
Kumar | Integration of inertial navigation system and global positioning system using kalman filtering | |
Engelsman et al. | Information-aided inertial navigation: A review | |
CN106814383B (zh) | 一种适用于多种模式下的高精度pos快速对准方法 | |
CN112325878A (zh) | 基于ukf与空中无人机节点辅助的地面载体组合导航方法 | |
Huang et al. | Research on UAV flight performance test method based on dual antenna GPS/INS integrated system | |
Forno et al. | Techniques for improving localization applications running on low-cost IoT devices | |
Wang et al. | Novel in-flight coarse alignment of low-cost strapdown inertial navigation system for unmanned aerial vehicle applications | |
CN107702718B (zh) | 一种基于瞬间可观测度模型的机载pos机动优化方法与装置 | |
Fourati et al. | A quaternion-based Complementary Sliding Mode Observer for attitude estimation: application in free-ranging animal motions | |
Qian et al. | Novel integration strategy for GNSS-aided inertial integrated navigation | |
Saini et al. | Implementation of Multi-Sensor GPS/IMU Integration Using Kalman Filter for Autonomous Vehicle | |
CN102818570B (zh) | 利用sins/图像匹配组合导航进行火星捕获的方法 | |
Wu et al. | An automatic driving algorithm for outdoor wheeled unmanned vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |