CN103743414B - 一种里程计辅助车载捷联惯导***行进间初始对准方法 - Google Patents
一种里程计辅助车载捷联惯导***行进间初始对准方法 Download PDFInfo
- Publication number
- CN103743414B CN103743414B CN201410001825.5A CN201410001825A CN103743414B CN 103743414 B CN103743414 B CN 103743414B CN 201410001825 A CN201410001825 A CN 201410001825A CN 103743414 B CN103743414 B CN 103743414B
- Authority
- CN
- China
- Prior art keywords
- phi
- vehicle
- omega
- sins
- attitude
- 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
- 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)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
本发明公开一种里程计辅助车载捷联惯导***行进间初始对准方法,包括粗对准和精对准两部分。本发明可以有效地解决车辆行进间初始对准问题,既不需要车辆作特殊机动或停车,也不需要借助路标点等外界辅助信息,仅靠里程计就能辅助捷联惯导***实现快速高精度对准。
Description
技术领域
本发明属于惯性导航初始对准技术领域,具体涉及一种里程计辅助车载捷联惯导***行进间初始对准方法。
背景技术
车载捷联惯导***进入导航工作之前需要进行初始对准,精确性和快速性是初始对准的两个重要性能指标。现代战争中为了增强战车的生存能力,要求车载捷联惯导***能够在运动状态下完成初始对准,这对于提高车辆快速机动能力具有重要意义。车辆运动时受运动加速度干扰影响,在短时间内完成初始对准一直是初始对准领域研究的热点之一。车辆行进间对准通常需要利用外部设备(在陆用导航领域,通常使用GPS或里程计)提供载体运动信息实现对惯性导航***的补偿与修正。GPS信号容易受遮挡且战时不可利用,里程计能够测量车辆在地面行驶速度和距离,具有完全自主和信号不易受干扰的特点,因而被广泛采用。
车载捷联惯导***中,为了提高车辆快速机动能力,发动机开启后惯导***要能够迅速进入导航工作状态。当车辆受到晃动干扰(如人员走动、货物卸载等会造成车体发生较为明显的晃动),参考矢量(特别是地球自转角速度)的测量精度会明显下降。传统解析式初始对准算法在这种条件下对准精度会受到影响,甚至无法完成粗对准。
发明内容
发明目的:为解决现有技术中存在的不足,本发明提供了一种里程计辅助车载捷联惯导***行进间初始对准方法。
技术方案:本发明的一种里程计辅助车载捷联惯导***行进间初始对准方法,依次包括粗对准模块和精对准模块两部分,
所述的粗对准模块包括以下步骤:
(11)车辆发动机开启、人员上下车辆做准备工作,惯性测量单元实时地同步采集车辆角速率和比力信息;
(12)运行***程序,开始进行快速粗对准;
(13)粗对准结束后,得到捷联惯导***初始姿态矩阵,车辆开始启动,里程计实时采集车辆运动信息;
所述的精对准模块包括以下步骤:
(21)捷联惯导***利用粗对准得到的姿态矩阵进行速度、位置以及姿态导航解算,同时里程计根据捷联惯导***提供的初始车辆姿态矩阵进行航位推算,计算得到较为准确的速度、姿态信息;
(22)将里程计航位推算得到的速度、姿态信息作为量测基准,与捷联惯导解算得到的速度、姿态相减作差,以所得差值作为卡尔曼滤波的量测值,列写卡尔曼滤波的状态方程和量测方程;
(23)将状态方程和量测方程离散化,根据给定状态初值以及估计误差初值利用导航计算机递推得到任意时刻的状态估计值,反馈修正捷联惯导***,完成初始对准。
进一步的,所述粗对准模块应用惯性凝固假设,将比力信息投影到载体惯性坐标系中,得到重力加速度相对惯性空间随地球旋转而引起的方向变化信息,对其积分可以克服车辆发动机振动以及人员上下车等引起的随机干扰影响,求解得到粗略姿态矩阵
进一步的,所述精对准模块应用卡尔曼滤波估计***误差,里程计与捷联惯导***中的陀螺仪进行航位推算,将航位推算得到的车辆速度和姿态信息作为卡尔曼滤波量测基准,与捷联惯导解算得到的速度、姿态相减,误差值作为卡尔曼滤波器输入,估计得到***误差后反馈修正捷联惯导***,求解得到精确姿态矩阵
进一步的,所述步骤(22)中的卡尔曼滤波的状态方程为:
其中,t为时间变量,F(t)是***状态转移矩阵,W(t)是***过程噪声序列,状态向量取为 状态向量中对应的变量分别为捷联惯导位置误差向量δp、速度误差向量δvn、数学平台误差向量φ、陀螺仪常值漂移向量加速度计常值偏置向量里程计航位推算位置误差向量δpD、航位推算数学平台误差向量φD和里程计刻度系数误差δkD;
式中,wa、wg分别为加速度计和陀螺仪在载体坐标系下的噪声,即是均值为0、方差为Q(t)、呈正态分布的白噪声;
式中,vE、vN、vU分别表示捷联解算得车辆东向、北向、天向速度值;L表示捷联解算得车辆所在点纬度值;h表示捷联解算得车辆所在点高度值;RM和RN分别表示子午面曲率半径和卯酉圈曲率半径;ωie表示地球自转角速度;vDE、vDN、vDU分别表示航位推算得车辆东向、北向、天向速度值;LD表示航位推算得车辆所在点纬度值;hD表示航位推算得车辆所在点高度值;表示捷联惯导姿态更新矩阵;表示航位推算姿态更新矩阵;
fE为加速度计所测比力分量在导航坐标系中东向投影分量;
fN为加速度计所测比力分量在导航坐标系中北向投影分量;
fU为加速度计所测比力分量在导航坐标系中天向投影分量。
进一步的,所述步骤(22)中的卡尔曼滤波的量测方程的计算过程如下:
利用航位推算获得的车辆速度、姿态辅助捷联惯导***完成精对准。将捷联惯导输出的速度、姿态与航位推算获得的对应信息相减作为辅助对准的量测,即:
Z=[ψS-ψD,θS-θD,γS-γD,vSE-vDE,vSN-vDN,vSU-vDU]T
式中,ψS、θS和γS分别为捷联惯导输出车辆航向角、俯仰角和横摇角,ψD、θD和γD分别为里程计航位推算输出航向角、俯仰角和横摇角,vSE、vSN和vSU分别为捷联惯导输出车辆速度,vDE、vDN和vDU分别为里程计输出车辆速度;
根据捷联惯导、航位推算的姿态角误差与数学平台失准角之间关系,可以推导获得量测方程为:
结合***状态X,可将辅助对准的量测方程写成如下形式:
Z(t)=H(t)X(t)+V(t)
其中,H(t)表示量测矩阵,可以由状态方程和量测方程之间关系直接求得,V(t)为量测噪声向量,其方差为R(t),记捷联惯导姿态更新矩阵里程计航位推算更新矩阵
有益效果:本发明的一种里程计辅助车载捷联惯导行进间初始对准方法,与现有技术相比具有以下优点:
(1)以惯性空间中不同时刻的重力加速度作为参考矢量的解析粗对准算法,对晃动干扰有着较好的适应性,本发明能够克服车辆晃动等引起的角运动干扰影响,通过短时间静止可以迅速建立粗略姿态矩阵缩短***准备时间。
(2)由于捷联惯导***速度误差随时间不断积累,捷联姿态矩阵误差会随导航时间增加而变差,里程计速度测量误差稳定,将里程计与陀螺仪进行航位推算,可以得到更加精确的姿态矩阵,本发明利用航位推算得到的速度和姿态作为卡尔曼滤波量测基准信息,和传统的以速度误差为量测的卡尔曼滤波方法相比,此方法的对准精度更高。
(3)由于作为速度、姿态基座的信息更为准确,和传统的以速度误差为量测的卡尔曼滤波方法相比,滤波收敛速度更快,有效地缩短了对准时间。
综上所述,本发明可以有效地解决车辆行进间初始对准问题,既不需要车辆作特殊机动或停车,也不需要借助路标点等外界辅助信息,仅靠里程计就能辅助捷联惯导***实现快速高精度对准,具有自主性高、抗干扰性强、机动性好等突出优点,对于战场环境下武器***的快速反应、机动作战具有重要意义。
附图说明
图1为本发明中的行进间初始对准流程图;
图2为本发明的粗对准原理图;
图3为本发明的精对准结构图;
图4为初始对准效果图,其中实线代表本方法,点线代表传统的速度组合卡尔曼滤波方法。
具体实施方式
下面对本发明技术方案结合附图和实施例进行详细说明。
如图1至图4所示,本发明的一种里程计辅助车载捷联惯导***行进间初始对准方法,包括以下步骤:车辆发动机开启,人员上下车辆做准备工作,惯性测量单元实时同步采集角速率信息和比力信息;启动***程序,开始进行粗对准;40s粗对准结束后,发动车辆开始运动,利用得到的粗略姿态矩阵以及采集得到的里程计路程增量信息进行航位推算,得到车辆速度、姿态信息,同时捷联惯导***利用陀螺仪和加速度计信息进行速度、位置以及姿态等导航解算;里程计航位推算得到的车辆速度、姿态信息作为卡尔曼滤波器量测基准,与捷联惯导解算出的速度、姿态信息相减作差,以此差值作为卡尔曼滤波器量测值,进行卡尔曼滤波估计得到捷联惯导***速度、姿态误差,通过闭环反馈修正捷联惯导误差,得到准确的车辆姿态信息,完成初始对准任务。
本发明具体包括以下步骤:
步骤一、开启发动机,车辆进入启动准备阶段,此时捷联惯导***进入工作状态,实时同步地采集三轴陀螺仪的角速度信息和三轴加速度计的比力信息,完成车载捷联惯导***的预热准备工作后车辆继续静止40s,进行粗对准;
步骤二、为了消除振动、晃动等引起的干扰加速度影响,选用基于重力加速度解析粗对准方法,完成粗对准,得到粗略姿态矩阵;
步骤三、此方法应用惯性凝固假设,将比力信息投影到载体惯性坐标系中,得到重力加速度相对于惯性空间随地球旋转而引起的方向变化信息,将其积分,消除部分干扰加速度,求解得到粗略姿态矩阵;
步骤三中的具体方法如下:
定义3个新的坐标系:经线地球坐标系(e0系)、经线地心惯性坐标系(i0系)和载体惯性坐标系
经线地球坐标系(e0系),轴与地球自转轴重合,轴在赤道平面内指向对准开始时刻惯组所在点经线,轴在赤道平面内,轴构成右手坐标系,与地球固连,随地球一同转动;
经线地心惯性坐标系(i0系),该坐标系是在粗对准的起始时刻将经线地球坐标系在惯性空间凝固后形成的坐标系;
载体惯性坐标系该坐标系是在粗对准的起始时刻将载体坐标系在惯性空间凝固后形成的坐标系;
捷联姿态矩阵可表示为:式中,为经线地球坐标系e0到导航坐标系n的转换矩阵,可由车辆所在地地理位置精确求得,为经线惯性坐标系i0到经线地球坐标系e0的转换矩阵,该矩阵为时间t的函数,为载体坐标系b到载体惯性坐标系的转换矩阵,可利用陀螺仪输出通过姿态跟踪算法实时求解,为载体惯性坐标系与经线地心惯性坐标系i0之间的转换矩阵,该矩阵不随时间变化且与载体的运动状态无关,为一常值矩阵,因此可以通过在这两个惯性空间内分别测量两个不共线矢量来求取,该矩阵的求取是此算法的关键之处。
1)矩阵和矩阵的求解
矩阵为e0系到n系的转换矩阵。可由对准过程中车辆所在地纬度精确求得;
矩阵为i0系到e0系的转换矩阵,可由对准时间精确求得,t0表示对准初始时刻点;
2)矩阵的求解
由系的定义知对准开始时刻系与b系重合,即因此可以利用陀螺仪输出的b系相对系的角速度信息,通过四元数更新求解。
3)矩阵的求解
矩阵为系到i0系的转换矩阵,该矩阵是常值矩阵。在惯性坐标系中观察地球重力加速度时,由于地球自转的作用其运动轨迹构成一个圆锥面。所以在不同时刻重力矢量在惯性坐标系内是不共线的。只要求得两个不同时刻的以及与其相对应的即可根据双矢量定姿原理求取矩阵。
车辆静止时,存在发动机振动以及人员等干扰影响。此时加速度计的输出在载体惯性坐标内的投影为:
式中,加速度计输出比力包括三部分:重力加速度gb,车辆发动机振动等引起的干扰加速度加速度计零位偏置,即
式(2)中加速度计零位偏置很小,可以忽略这部分影响,在Δtk=tk-t0内对式(1)进行积分得:
记 将式(2)带入式(3)中有:
当车辆存在发动机振动引起的环境干扰时,一般可视这种干扰误差为周期性变化量,在较长一段时间内这种干扰加速度正负积分相互抵消,于是:
记 式(4)可以简化为:
由于
在Δtk=tk-t0内,对式(7)进行积分得:
可以根据加速度计输出积分求得,在式(6)中取两个不同时刻,t1时刻和t2时刻(t1<t2),由双矢量定姿原理得:
式(9)中两向量作叉乘,得:
因此,可按照式(11)求解:
该算法巧妙地应用惯性凝固假设,建立了载体坐标系使车体相对坐标系的姿态阵初值成为单位矩阵,从而使更新成为可能。通过积分可以将车辆振动引起的线速度平滑掉,能够取得比较好的对准效果,航向角误差基本能够控制在2°范围以内,满足粗对准精度要求;
步骤四、粗对准结束后,得到粗略姿态矩阵,启动车辆,利用里程计输出路程增量以及陀螺仪输出角速率进行航位推算。与捷联惯导相比,航位推算时载体系运动速度为直接测量值,其误差有界且能保证较高的精度,从长期效果来看航位推算的速度误差发散速度远小于惯导***,导航精度更高。
下面给出航位推算姿态更新算法:
由于惯导速度误差随时间不断积累,捷联姿态矩阵误差会随导航时间增加而变差。里程计测量误差比较稳定,利用里程计与捷联惯导***中的陀螺仪进行高精度航位推算可以得到更加精确的姿态矩阵,从而可以提高航位推算精度;
与捷联惯导姿态四元数更新算法类似,航位推算的姿态四元数更新算法为:
式中:是tk时刻的姿态四元数,是tk-1时刻的姿态四元数,是以n系为参考坐标系时b系从tk-1时刻到tk时刻的变换四元数,它的计算需要用到b系相对于n系的转动角速度设ηk是从tk-1时刻到tk时刻b系相对于n系的角速度变换所对应的等效旋转矢量,则有:
式中:利用里程计的输出进行姿态更新与捷联惯导姿态更新的主要不同之处在于的计算。设航位推算的速度为 航位推算纬度和高度分别为LD和hD,则的计算公式为:
下面给出航位推算速度、位置更新算法:
假设里程计安装坐标系与捷联惯导坐标重合(安装误差已经补偿),根据里程计输出得到载体系下载车速度,利用航位推算的姿态矩阵将其转换到导航坐标系下,可推导获得速度解算算法:
式中:为第k时刻导航系中载体速度,ΔSk为第k时刻里程计测得的位移增量。
利用姿态矩阵将里程计输出的路程增量由载体坐标系转换到导航坐标系,即采用路程增量变换法,推导获得位置解算算法:
式中:LDk-1、λDk-1和hDk-1以及LDk、λDk和hDk分别为k-1时刻和k时刻航位推算的纬度、经度和高度;
步骤五、导航计算机根据陀螺仪和加速计敏感的角速度和加速度进行捷联解算,分别得到车辆的速度与姿态,将捷联解算得到的车辆速度、姿态信息与里程计航位推算得到的速度、姿态信息相减作为卡尔曼滤波器的量测信息;
步骤六、以此差值作为卡尔曼滤波的量测量,列写卡尔曼滤波的状态方程和量测方程;
1)状态方程
其中,t为时间变量,F(t)是***状态转移矩阵,W(t)是***过程噪声序列,状态向量取为 状态向量中对应的变量分别为捷联惯导位置误差向量δp、速度误差向量δvn、数学平台误差向量φ、陀螺仪常值漂移向量加速度计常值偏置向量里程计航位推算位置误差向量δpD、航位推算数学平台误差向量φD和里程计刻度系数误差δkD;
式中,wa、wg分别为加速度计和陀螺仪在载体坐标系下的噪声,是均值为0、方差为Q(t)、呈正态分布的白噪声;
vE、vN、vU分别表示捷联解算得车辆东向、北向、天向速度值;L表示捷联解算得车辆纬度值;h表示捷联解算得车辆高度值;RM和RN分别表示子午面曲率半径和卯酉圈曲率半径;ωie表示地球自转角速度;vDE、vDN、vDU分别表示航位推算得车辆东向、北向、天向速度值;LD表示航位推算得车辆纬度值;hD表示航位推算得车辆高度值;表示捷联惯导姿态更新矩阵;表示航位推算姿态更新矩阵。
fE为加速度计所测比力分量在导航坐标系中东向投影分量;
fN为加速度计所测比力分量在导航坐标系中东向投影分量;
fU为加速度计所测比力分量在导航坐标系中东向投影分量。
2)量测方程
利用航位推算获得的车辆速度、姿态辅助捷联惯导***完成精对准。将捷联
惯导输出的速度、姿态与航位推算获得的对应信息相减作为辅助对准的量测,即:
Z=[ψS-ψD,θS-θD,γS-γD,vSE-vDE,vSN-vDN,vSU-vDU]T
式中,ψS、θS和γS分别为捷联惯导输出车辆航向角、俯仰角和横摇角,ψD、θD和γD分别为里程计航位推算输出航向角、俯仰角和横摇角,vSE、vSN和vSU分别为捷联惯导输出车辆速度,vDE、vDN和vDU分别为里程计输出车辆速度;
根据捷联惯导、航位推算的姿态角误差与数学平台失准角之间关系,可以推导获得量测方程为:
结合***状态X,可将辅助对准的量测方程写成如下形式
Z(t)=H(t)X(t)+V(t)
其中,H(t)表示量测矩阵,可以由状态方程和量测方程之间关系直接求得,V(t)为量测噪声向量,其方差为R(t),记捷联惯导姿态更新矩阵里程计航位推算更新矩阵
步骤七、将卡尔曼滤波的状态方程和量测方程离散化,完成初始对准,进入导航状态。
将状态方程和量测方程离散化:
Xk+1=Φk+1,kXk+Wk
Zk=HkXk+Vk
(1)Φk+1,k的计算方法
式中,滤波器计算周期为T,对于时变连续***,将计算周期T分隔成N个时间间隔ΔT,即T=NΔT,按各个ΔT时间间隔中***阵近似为常值矩阵来计算。
(2)Qk的计算方法
应用标准卡尔曼滤波方程,Xk的估计按下述方法求解:
只要给定初值和P0,根据k时刻的量测Zk,就可以递推算得k时刻的状态估计
实施例:
在一组仿真环境下,对发明进行Matlab仿真实验:
模拟车辆启动过程,车载惯导***在振动环境下进行粗对准,40s粗对准完成后,车辆以0.5m/s2的加速度加速启动20s,然后以10m/s的速度作近似匀速运动,精对准时间为10min。
车辆在发动机开启环境下主要受到发动机的高频振动引起的速度变化影响,建立数学模型:
x,y,z分别表示车辆右、前、上三个位置,根据车辆发动机特性,设置参数如下:ARHx=0.1m/s,ARHy=0.1m/s,ARHz=0.2m/s;fRHx=50Hz,fRHy=50Hz,fRHz=100Hz;为[02π]上服从均匀分布的随机相位。
车辆所处的地理经度λ=118.4°,纬度L=32.1°;陀螺仪常值漂移为0.01°/h,随机漂移为0.01°/h;加速度计常值偏置为1×10-4g,随机偏置为1×10-4g;里程计刻度系数误差为0.3%。
如上所述,尽管参照特定的优选实施例已经表示和表述了本发明,但其不得解释为对本发明自身的限制。在不脱离所附权利要求定义的本发明的精神和范围前提下,可对其在形式上和细节上作出各种变化。
Claims (3)
1.一种里程计辅助车载捷联惯导***行进间初始对准方法,其特征在于依次包括粗对准和精对准两部分,
所述的粗对准包括以下步骤:
(11)车辆发动机开启,人员上下车辆做准备工作,惯性测量单元实时地同步采集车辆角速率和比力信息;
(12)运行***程序,开始进行快速粗对准;
(13)粗对准结束后,得到捷联惯导***初始姿态矩阵,车辆开始启动,里程计实时采集车辆运动信息;
所述的精对准包括以下步骤:
(21)捷联惯导***利用粗对准得到的姿态矩阵进行速度、位置以及姿态导航解算,同时里程计根据捷联惯导***提供的初始车辆姿态矩阵进行航位推算,计算得到准确的速度、姿态信息;
(22)将里程计航位推算得到的速度、姿态信息作为量测基准,与捷联惯导***解算得到的速度、姿态相减作差,以所得差值作为卡尔曼滤波的量测值,列写卡尔曼滤波的状态方程和量测方程;
卡尔曼滤波的状态方程为:
其中,t为时间变量,F(t)是***状态转移矩阵,W(t)是***过程噪声序列,状态向量取为状态向量中对应的变量分别为捷联惯导位置误差向量δp、速度误差向量δvn、数学平台误差向量φ、陀螺仪常值漂移向量加速度计常值偏置向量里程计航位推算位置误差向量δpD、航位推算数学平台误差向量φD和里程计刻度系数误差δkD;
式中,wa、wg分别为加速度计和陀螺仪在载体坐标系下的噪声,即是均值为0、方差为Q(t)、呈正态分布的白噪声;
式中,vE、vN、vU分别表示捷联解算得车辆东向、北向、天向速度值;L表示捷联解算得车辆所在点纬度值;h表示捷联解算得车辆所在点高度值;RM和RN分别表示子午面曲率半径和卯酉圈曲率半径;ωie表示地球自转角速度;vDE、vDN、vDU分别表示航位推算得车辆东向、北向、天向速度值;LD表示航位推算得车辆所在点纬度值;hD表示航位推算得车辆所在点高度值;表示捷联惯导姿态更新矩阵;表示航位推算姿态更新矩阵;
fE为加速度计所测比力分量在导航坐标系中东向投影分量;
fN为加速度计所测比力分量在导航坐标系中北向投影分量;
fU为加速度计所测比力分量在导航坐标系中天向投影分量;
上述卡尔曼滤波的量测方程的计算过程如下:
利用航位推算获得的车辆速度、姿态辅助捷联惯导***完成精对准,将捷联惯导输出的速度、姿态与航位推算获得的对应信息相减作为辅助对准的量测信息,即:
Z=[ψS-ψD,θS-θD,γS-γD,vSE-vDE,vSN-vDN,vSU-vDU]T
式中,ψS、θS和γS分别为捷联惯导输出车辆航向角、俯仰角和横摇角,ψD、θD和γD分别为里程计航位推算输出航向角、俯仰角和横摇角,vSE、vSN和vSU分别为捷联惯导输出车辆速度,vDE、vDN和vDU分别为里程计输出车辆速度;
根据捷联惯导、航位推算的姿态角误差与数学平台失准角之间关系,可以推导获得量测方程为:
结合***状态X,可将辅助对准的量测方程写成如下形式:
Z(t)=H(t)X(t)+V(t)
其中,H(t)表示量测矩阵,可以由状态方程和量测方程之间关系直接求得,V(t)为量测噪声向量,其方差为R(t),记捷联惯导姿态更新矩阵里程计航位推算更新矩阵
(23)将状态方程和量测方程离散化,根据给定状态初值以及估计误差初值利用导航计算机递推得到任意时刻的状态估计值,反馈修正捷联惯导***,完成初始对准。
2.根据权利要求1所述的里程计辅助车载捷联惯导***行进间初始对准方法,其特征在于:所述粗对准应用惯性凝固假设,将比力信息投影到载体惯性坐标系中,得到重力加速度相对惯性空间随地球旋转而引起的方向变化信息,对其积分可以克服车辆发动机振动以及人员上下车等引起的随机干扰影响,求解得到粗略姿态矩阵
3.根据权利要求1所述的里程计辅助车载捷联惯导***行进间初始对准方法,其特征在于:所述精对准应用卡尔曼滤波估计***误差,里程计与捷联惯导***中的陀螺仪进行航位推算,将航位推算得到的车辆速度和姿态信息作为卡尔曼滤波量测基准,与捷联惯导***解算得到的速度、姿态相减,误差值作为卡尔曼滤波器输入,估计得到***误差后反馈修正捷联惯导***,求解得到精确姿态矩阵
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410001825.5A CN103743414B (zh) | 2014-01-02 | 2014-01-02 | 一种里程计辅助车载捷联惯导***行进间初始对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410001825.5A CN103743414B (zh) | 2014-01-02 | 2014-01-02 | 一种里程计辅助车载捷联惯导***行进间初始对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103743414A CN103743414A (zh) | 2014-04-23 |
CN103743414B true CN103743414B (zh) | 2016-07-06 |
Family
ID=50500456
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410001825.5A Active CN103743414B (zh) | 2014-01-02 | 2014-01-02 | 一种里程计辅助车载捷联惯导***行进间初始对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103743414B (zh) |
Families Citing this family (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102014211175A1 (de) | 2014-06-11 | 2015-12-17 | Continental Teves Ag & Co. Ohg | Verfahren und System zur Initialisierung eines Sensorfusionssystems |
CN104567888A (zh) * | 2014-12-25 | 2015-04-29 | 大连楼兰科技股份有限公司 | 基于速度在线修正的惯性导航车辆姿态测量方法 |
CN104864868B (zh) * | 2015-05-29 | 2017-08-25 | 湖北航天技术研究院总体设计所 | 一种基于近距离地标测距的组合导航方法 |
CN105203129B (zh) * | 2015-10-13 | 2019-05-07 | 上海华测导航技术股份有限公司 | 一种惯导装置初始对准方法 |
CN105444764A (zh) * | 2015-11-24 | 2016-03-30 | 大连楼兰科技股份有限公司 | 一种基于车辆里程计辅助的姿态测量方法 |
CN105698822B (zh) * | 2016-03-15 | 2018-06-29 | 北京航空航天大学 | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 |
CN105806365B (zh) * | 2016-03-15 | 2019-06-07 | 北京航空航天大学 | 一种基于自抗扰控制的车载惯导行进间快速初始对准方法 |
CN107621266B (zh) * | 2017-08-14 | 2020-12-15 | 上海宇航***工程研究所 | 基于特征点跟踪的空间非合作目标相对导航方法 |
CN107830873B (zh) * | 2017-11-01 | 2021-04-02 | 北京航空航天大学 | 一种基于单轴水平旋转惯导与里程计组合的高精度车辆定位定向方法 |
CN108180925B (zh) * | 2017-12-15 | 2020-09-01 | 中国船舶重工集团公司第七0七研究所 | 一种里程计辅助车载动态对准方法 |
CN108680183B (zh) * | 2018-03-29 | 2020-06-09 | 中国有色金属长沙勘察设计研究院有限公司 | 一种导航定位精度的评估方法 |
CN109059913B (zh) * | 2018-08-27 | 2021-08-03 | 立得空间信息技术股份有限公司 | 一种用于车载导航***的零延迟组合导航初始化方法 |
CN109571464B (zh) * | 2018-11-16 | 2021-12-28 | 楚天智能机器人(长沙)有限公司 | 一种基于惯性和二维码导航的机器人初始对准方法 |
CN109798890B (zh) * | 2019-02-01 | 2021-09-17 | 上海戴世智能科技有限公司 | 用于车用组合惯性导航***在无观测值条件下的启动方法、车用组合惯性导航***和车辆 |
CN109974697B (zh) * | 2019-03-21 | 2022-07-26 | 中国船舶重工集团公司第七0七研究所 | 一种基于惯性***的高精度测绘方法 |
CN110349420B (zh) * | 2019-07-01 | 2020-12-18 | 福建睿思特科技股份有限公司 | 一种基于数据分析的智能路况管理*** |
CN111323050B (zh) * | 2020-03-19 | 2021-06-18 | 哈尔滨工程大学 | 一种捷联惯导和多普勒组合***标定方法 |
CN111536969B (zh) * | 2020-04-16 | 2022-12-13 | 哈尔滨工程大学 | 一种基于初始姿态角自对准的小径管道机器人定位方法 |
CN113834499A (zh) * | 2021-08-26 | 2021-12-24 | 北京航天发射技术研究所 | 一种车载惯组与里程计行进间对准方法及*** |
CN113790740A (zh) * | 2021-09-17 | 2021-12-14 | 重庆华渝电气集团有限公司 | 一种惯导行进间对准的方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101187562A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 船用光纤陀螺捷联***初始姿态确定方法 |
CN101413800A (zh) * | 2008-01-18 | 2009-04-22 | 南京航空航天大学 | 导航/稳瞄一体化***的导航、稳瞄方法 |
CN102445176A (zh) * | 2011-09-14 | 2012-05-09 | 中国科学院力学研究所 | 高速列车运行姿态参数测量*** |
-
2014
- 2014-01-02 CN CN201410001825.5A patent/CN103743414B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101187562A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 船用光纤陀螺捷联***初始姿态确定方法 |
CN101413800A (zh) * | 2008-01-18 | 2009-04-22 | 南京航空航天大学 | 导航/稳瞄一体化***的导航、稳瞄方法 |
CN102445176A (zh) * | 2011-09-14 | 2012-05-09 | 中国科学院力学研究所 | 高速列车运行姿态参数测量*** |
Also Published As
Publication number | Publication date |
---|---|
CN103743414A (zh) | 2014-04-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103743414B (zh) | 一种里程计辅助车载捷联惯导***行进间初始对准方法 | |
CN108180925B (zh) | 一种里程计辅助车载动态对准方法 | |
CN108731670B (zh) | 基于量测模型优化的惯性/视觉里程计组合导航定位方法 | |
CN102809377B (zh) | 飞行器惯性/气动模型组合导航方法 | |
CN111156994B (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
CN113945206A (zh) | 一种基于多传感器融合的定位方法及装置 | |
CN106871928B (zh) | 基于李群滤波的捷联惯性导航初始对准方法 | |
CN106595652B (zh) | 车辆运动学约束辅助的回溯式行进间对准方法 | |
CN104061899B (zh) | 一种基于卡尔曼滤波的车辆侧倾角与俯仰角估计方法 | |
CN103245359B (zh) | 一种惯性导航***中惯性传感器固定误差实时标定方法 | |
CN106767797B (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
CN109596144B (zh) | Gnss位置辅助sins行进间初始对准方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导***以及控制方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN101900573B (zh) | 一种实现陆用惯性导航***运动对准的方法 | |
CN105698822A (zh) | 基于反向姿态跟踪的自主式惯性导航行进间初始对准方法 | |
CN105783943A (zh) | 一种基于无迹卡尔曼滤波的极区环境下舰船大方位失准角传递对准方法 | |
CN105806365A (zh) | 一种基于自抗扰控制的车载惯导行进间快速初始对准方法 | |
CN104764467A (zh) | 空天飞行器惯性传感器误差在线自适应标定方法 | |
CN105091907A (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN104913781A (zh) | 一种基于动态信息分配的非等间隔联邦滤波方法 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
CN111678514A (zh) | 一种基于载体运动条件约束和单轴旋转调制的车载自主导航方法 | |
Gao et al. | An integrated land vehicle navigation system based on context awareness | |
CN104634348B (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 |