CN113959462B - 一种基于四元数的惯性导航系统自对准方法 - Google Patents
一种基于四元数的惯性导航系统自对准方法 Download PDFInfo
- Publication number
- CN113959462B CN113959462B CN202111224735.9A CN202111224735A CN113959462B CN 113959462 B CN113959462 B CN 113959462B CN 202111224735 A CN202111224735 A CN 202111224735A CN 113959462 B CN113959462 B CN 113959462B
- Authority
- CN
- China
- Prior art keywords
- alignment
- inertial
- matrix
- angle
- backtracking
- 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)
Abstract
本发明提出一种基于四元数的惯性导航系统自对准的方法,包括以下步骤:基于凝固惯性系的粗对准技术执行惯性导航系统粗对准,基于卡尔曼滤波的精对准技术执行惯性导航系统精对准,基于优化迭代的回溯对准技术执行回溯对准;在回溯对准过程中,首先利用保存的惯性陀螺和加速度计的测量数据进行姿态反推,反推到起始时刻的初始角度信息,然后执行精对准滤波步骤,反复循环运算直到两次对准结果航向角的差值小于预设的精度偏差值时退出回溯对准;或者当回溯次数大于10次时退出回溯对准。
Description
技术领域
本发明属惯性导航技术领域,涉及一种基于四元数的惯性导航系统自对准方法。
背景技术
惯性导航系统在进入导航之前,必须进行初始对准,初始对准误差是惯性导航系统的主要误差源之一,它直接影响惯性导航系统的性能。初始对准时间是反映系统快速反应能力的重要技术指标,尤其对于军事应用领域,要求初始对准精度高、对准时间短,即精而快。然而,较高的对准精度往往需要较长的对准时间,因此如何解决对准精度和快速性之间的矛盾一直是初始对准的一项关键技术。
目前,通常是将初始对准划分为粗对准和精对准两个过程。在众多粗对准算法中,解析式粗对准是一种重要的方法,但在初始对准过程中,信号采集容易受到车辆振动、阵风、人员走动等外界环境干扰,产生较大的测量噪声,传统的解析粗对准方法在基座晃动条件下抗干扰能力差,甚至失效。其根本原因在于晃动干扰角速率远大于地球自转角速率,无法从陀螺测量中分离出有效的地球自转信息。为解决晃动下的初始对准问题,提出了基于凝固惯性系的粗对准方案,该方法可以有效抑制角运动干扰对对准精度的影响。
精对准的目的,是在粗对准的基础上精确估计失准角,以便得到更加准确的初始姿态矩阵。近年来,现代控制理论的一些方法在惯性导航系统中有了成功的应用,其中之一就是运用现代控制理论中的卡尔曼滤波进行惯性导航系统的初始对准。运用卡尔曼滤波的初始对准方法是在平台粗对准的基础上进行的,运用卡尔曼滤波将惯性导航系统失准角估计出来,然后根据估计结果将失准角消除掉,提高对准精度。
发明内容
为解决上述技术问题,本发明提出了一种基于四元数的惯性导航系统自对准的方法,所述方法包括以下步骤:
步骤1,基于凝固惯性系的粗对准技术执行惯性导航系统粗对准,包括:根据惯性陀螺和加速度计测得的角速度信息和比力信息,求解两个不同时刻的不共线矢量g(t1)和g(t2)在不同坐标系下的积分结果,进而求解对应时刻的姿态矩阵;并根据当前姿态矩阵与欧拉角的关系式:解算出当前的三个姿态角;
所述姿态角包括:横滚角、航向角和俯仰角;
所述不同坐标系包含:导航惯性坐标系和载体惯性坐标系;
步骤2,基于卡尔曼滤波的精对准技术执行惯性导航系统精对准,建立系统状态方程以及量测方程,并利用速度误差与失准角之间的关系完成三个失准角的误差估计,使用估计的失准角修正姿态矩阵;
步骤3,基于优化迭代的回溯对准技术执行回溯对准;首先利用保存的惯性陀螺和加速度计的测量数据进行姿态反推,反推到起始时刻的初始角度信息,然后按照步骤2执行精对准滤波,反复循环运算直到两次对准结果航向角的差值小于预设的精度偏差值时退出回溯对准;或者当回溯次数大于10次时退出回溯对准。
进一步的,步骤1包括子步骤:
步骤1.1,定义惯性凝固坐标系,在对准起始时刻,n0是将北天东导航系n相对惯性空间凝固所得的导航惯性坐标系;b0是将前上右载体系b相对惯性空间凝固所得的载体惯性坐标系;
步骤1.2,确定载体实时姿态矩阵与惯性系常值矩阵的关系式,其中惯性系常值矩阵作为待求矩阵;
步骤1.3,将当前时刻姿态矩阵代入姿态矩阵与欧拉角的关系式,求出横滚角、航向角和俯仰角。
进一步的,计算两个不同时刻的不共线矢量时,该两个时刻的时间差值大于等于30秒。
进一步的,步骤2包括子步骤:
步骤2.1,依据速度误差方程、失准角误差方程、陀螺误差模型及加速度计误差模型建立系统状态方程;
步骤2.2,建立精确对准系统量测方程;
步骤2.3,基于优化迭代方式执行回溯对准计算。
进一步的,步骤3包括子步骤:
步骤3.1,保存对准过程中陀螺的测量数据,以及加速度计的测量数据;
步骤3.2,执行姿态反推计算,包括依据地球自转角速度以及当前时刻的四元数反推中间时刻四元数;依据存储的陀螺角速度信息以及中间时刻四元数反推上一时刻的四元数;
步骤3.3,反推到对准起始时刻后,按照步骤2进行精对准滤波。
进一步的,所述预设的精度偏差值为0.005°。
采用本发明的方法,创新地提出一种基于四元数的惯性导航系统自对准技术,在完成粗对准以及精对准后,通过增加回溯对准环节,实现初始对准精度高、对准时间短的需求,提高惯性导航精度。
基于四元数的惯性导航系统自对准技术能够在短时间内实现高精度初始对准,解决对准精度和对准时间之间的矛盾难题。
附图说明
图1为重力加速度在惯性空间的旋转示意图。
图2为精对准水平姿态角和航向角的收敛情况。
图3为回溯对准横滚角、航向角以及俯仰角的收敛情况。
具体实施方式
本发明涉及一种基于四元数的惯性导航系统自对准技术,特别涉及一种抗晃动基座的惯性导航系统自对准技术,主要用途是实现惯性导航系统高精度自对准。
与现有技术相比,本发明在完成粗对准以及精对准后,通过增加回溯对准环节,实现对准时间不变的情况下提高初始对准精度的目的,解决对准精度和快速性之间的矛盾难题。
本发明的技术解决方案:一种基于四元数的惯性导航系统自对准技术,在完成粗对准以及精对准后,通过增加回溯对准环节,实现初始对准精度高、对准时间短的需求,具体方法通过以下步骤实现:
第一步,基于凝固惯性系的粗对准技术。
首先利用惯性凝固假设定义如下坐标系:
n0―导航惯性坐标系。在对准起始时刻,将北天东导航系n相对惯性空间凝固所得的惯性坐标系。
b0―载体惯性坐标系。在对准起始时刻,将前上右载体系b相对惯性空间凝固所得的惯性坐标系。
根据方向余弦矩阵的链乘原理,载体实时姿态矩阵可表示为:
式中为惯性系常值矩阵,作为待求矩阵;/>可通过陀螺输出求解;而其中,e代表地球坐标系,在载体位置无移动时为已知矩阵
式中t为对准经历时间,ωie代表地球自转角速度,L0代表起始纬度。
矩阵可根据陀螺测量数据/>进行姿态更新得到:
其中积分初值为
将作为待求矩阵,物理意义非常明确:重力矢量在b0系投影/>可由加速度计输出/>测量,即/>重力矢量在n0系的投影/>可根据对准位置按地球模型求解。在不同对准时刻t1和t2,从惯性系来看,重力矢量g(t)受地球自转影响,缓慢漂移。即在惯性坐标系n0中,/>与/>不共线,且存在关系
根据双矢量定姿原理,只要获得两个不同时刻的不共线矢量g(t1)和g(t2)在n0和b0系的观测值,就可以确定姿态矩阵
考虑矩阵和/>已知,则/>和/>可以求解
为了不丢失信息并滤除量测噪声,可对上式进行积分运算,得到两个不同时刻的积分结果,
利用TRIAD算法可求解姿态矩阵
将上式得到的矩阵带入到式(1-1)中即可求得当前时刻的姿态矩阵/>也即完成了粗对准。
第二步,基于卡尔曼滤波的精对准技术。
精对准技术即利用Kalman滤波器融合惯性速度误差信息完成失准角φ的估计,系统状态方程以及量测方程如下所示。
1)系统状态方程
考虑速度误差方程、失准角误差方程、陀螺及加速度计误差模型,系统状态方程为:
其中,为状态矢量,δvx,δvy,δvz分别代表北天东速度误差,φx,φy,φz分别代表XYZ三个方向的失准角大小,εx,εy,εz分别代表陀螺常值零偏,/>分别代表加速度计常值零偏,W(t)=[wax waywaz wgx wgy wgz]为噪声矢量,wax,way,waz分别代表加速度计随机噪声,wgx,wgy,wgz分别代表陀螺仪随机噪声,F(t)为状态矩阵,G(t)为噪声驱动矩阵。
F(t)和G(t)如下所示:
FN是速度误差方程和失准角误差方程对应的系统矩阵,其非零元素为:
FN(1,6)=g
FN(3,4)=-g
其中,分别代表北天东三个方向的速度信息,L,H分别代表纬度信息和高度信息,RM,RN分别代表子午圈曲率半径信息和卯酉圈曲率半径信息。G(t)为对应的噪声驱动矩阵:
2)系统量测方程
精对准量测方程为:
Zk+1=HXk+1,k+Vk+1 (1-11)
其中,Zk+1代表速度误差量测量,H为量测矩阵,Vk+1为量测噪声。
Zk+1的表达式如下所示:
H的表达式如下所示:
第三步,基于优化迭代的回溯对准技术。
1)数据保存
为进行优化迭代,需保存对准过程中陀螺的测量数据,以及加速度计的测量数据。
2)姿态反推
a)依据地球自转角速度以及当前时刻的四元数反推四元数/>
其中,
为旋转矢量Φ对应的四元数,且
Update_t为更新周期。
b)依据存储的陀螺角速度信息以及四元数反推上一时刻的四元数/>
其中,
为旋转矢量Φ对应的对偶四元数,且
为陀螺测量的三个轴向角速度数据。
3)正向对准
反推到对准起始时刻后,按照第二步进行精对准滤波,反复循环直到两次对准结果航向角的差值小于0.005°时则退出回溯对准,或者当回溯大于10次时退出回溯对准。
以下结合附图对本发明的具体实施方式作出详细说明。
第一步,基于凝固惯性系的粗对准技术。
首先利用惯性凝固假设定义如下坐标系:
n0―导航惯性坐标系。在对准起始时刻,将北天东导航系n相对惯性空间凝固所得的惯性坐标系。
b0―载体惯性坐标系。在对准起始时刻,将前上右载体系b相对惯性空间凝固所得的惯性坐标系。
根据方向余弦矩阵的链乘原理,载体实时姿态矩阵可表示为:
式中为惯性系常值矩阵,作为待求矩阵;/>可通过陀螺输出求解;而在载体位置无移动时为已知矩阵
式中t为对准经历时间,ωie代表地球自转角速度,L0代表起始纬度。
矩阵可根据陀螺数据/>进行姿态更新得到
其中积分初值为
将作为待求矩阵,物理意义非常明确:重力矢量在b0系投影/>可由加速度计输出/>测量,即/>重力矢量在n0系的投影/>可根据对准位置按地球模型求解。如图1所示,在不同对准时刻t1和t2,从惯性系来看,重力矢量g(t)受地球自转影响,沿图1所示的锥面缓慢漂移。即在惯性坐标系n0中,/>与/>不共线,且存在关系
根据双矢量定姿原理,只要获得两个不同时刻的不共线矢量g(t1)和g(t2)在n0和b0系的观测值,就可以确定姿态矩阵
考虑矩阵和/>已知,则/>和/>可以求解
为了不丢失信息并滤除量测噪声,可对上式进行积分运算,得到两个不同时刻的积分结果,
利用TRIAD算法可求解姿态矩阵
将上式得到的矩阵带入到式(1-1)中即可求得当前时刻的姿态矩阵/>也即完成了粗对准。
第二步,基于卡尔曼滤波的精对准技术。
精对准技术即利用Kalman滤波器融合惯性速度误差信息完成失准角φ的估计,系统状态方程以及量测方程如下所示。
1)系统状态方程
考虑速度误差方程、失准角误差方程、陀螺及加速度计误差模型,系统状态方程为:
其中,为状态矢量,δvx,δvy,δvz分别代表北天东速度误差,φx,φy,φz分别代表XYZ三个方向的失准角大小,εx,εy,εz分别代表陀螺常值零偏,/>分别代表加速度计常值零偏,W(t)=[wax waywaz wgx wgy wgz]为噪声矢量,wax,way,waz分别代表加速度计随机噪声,wgx,wgy,wgz分别代表陀螺仪随机噪声,F(t)为状态矩阵,G(t)为噪声驱动矩阵。
F(t)和G(t)如下所示:
FN是速度误差方程和失准角误差方程对应的系统矩阵,其非零元素为:
FN(1,6)=g
FN(3,4)=-g
其中,分别代表北天东三个方向的速度信息,L,H分别代表纬度信息和高度信息,RM,RN分别代表子午圈曲率半径信息和卯酉圈曲率半径信息。G(t)为对应的噪声驱动矩阵:
2)系统量测方程
精对准量测方程为:
Zk+1=HXk+1,k+Vk+1 (1-11)
其中,Zk+1代表速度误差量测量,H为量测矩阵,Vk+1为量测噪声。
Zk+1的表达式如下所示:
H的表达式如下所示:
第三步,基于优化迭代的回溯对准技术。
1)数据保存
为进行优化迭代,需保存对准过程中陀螺的测量数据,以及加速度计的测量数据。
2)姿态反推
a)依据地球自转角速度以及当前时刻的四元数反推四元数/>
其中,
为旋转矢量Φ对应的四元数,且
Update_t为更新周期。
b)依据存储的陀螺角速度信息以及四元数反推上一时刻的四元数/>
其中,
为旋转矢量Φ对应的对偶四元数,且
为陀螺测量的三个轴向角速度数据。
3)正向对准
反推到对准起始时刻后,按照第二步进行精对准滤波,反复循环直到两次对准结果航向角的差值小于0.005°时则退出回溯对准,或者当回溯大于10次时退出回溯对准。、
实施例一,
为了验证算法的准确性,利用试验数据进行了离线仿真验证,对准时间在275秒以内,粗对准时间为60秒。
第一步,利用基于凝固惯性系的粗对准技术完成惯性导航系统粗对准。
根据惯性陀螺和加速度计测得的角速度信息和比力信息按照公式(1-6)求解两个不同时刻的积分结果,其中,t1设定为30秒,t2设定为60秒。然后按照公式(1-7)求解姿态矩阵最后,按照公式(1-1)求解当前时刻的姿态矩阵/>并根据姿态矩阵/>与欧拉角的关系:
求解三个姿态角,横滚角(γ)、航向角(ψ)、俯仰角(θ)分别为:-0.2571°,-119.82097°,0.40511°。
第二步,利用基于卡尔曼滤波的精对准技术完成惯性导航系统精对准。
首先建立系统状态方程以及量测方程,并利用速度误差与失准角之间的关系完成三个失准角的误差估计,利用估计的失准角修正姿态矩阵Cb n,提高对准精度,精对准结果如图2所示。
第三步,利用基于优化迭代的回溯对准技术完成回溯对准。
首先利用保存的陀螺和加速度计的测量数据完成姿态反推至起始时刻,然后按照第二步进行精对准滤波,反复循环直到两次对准结果航向角的差值小于0.005°时则退出回溯对准,或者当回溯大于10次时退出回溯对准。回溯对准结果如图3所示,由试验结果可以看出,经过三次回溯迭代后,两次航向角对准结果的差值小于0.005°退出回溯对准,而三次回溯对准中横滚角和俯仰角差别不大。
最后应说明的是,以上实施方式仅用以说明本发明实施例的技术方案而非限制,尽管参照以上较佳实施方式对本发明实施例进行了详细说明,本领域的普通技术人员应当理解,可以对本发明实施例的技术方案进行修改或等同替换都不应脱离本发明实施例的技术方案的精神和范围。
Claims (5)
1.一种基于四元数的惯性导航系统自对准的方法,其特征在于,所述方法包括以下步骤:
步骤1,基于凝固惯性系的粗对准技术执行惯性导航系统粗对准,包括:根据惯性陀螺和加速度计测得的角速度信息和比力信息,求解两个不同时刻的不共线矢量g(t1)和g(t2)在不同坐标系下的积分结果,进而求解对应时刻的姿态矩阵;并根据当前姿态矩阵与欧拉角的关系式,解算出当前的三个姿态角;
所述姿态角包括:横滚角、航向角和俯仰角;
所述不同坐标系包含:导航惯性坐标系和载体惯性坐标系;
步骤2,基于卡尔曼滤波的精对准技术执行惯性导航系统精对准,建立系统状态方程以及量测方程,并利用速度误差与失准角之间的关系完成三个失准角的误差估计,使用估计的失准角修正姿态矩阵;
步骤3,基于优化迭代的回溯对准技术执行回溯对准;首先利用保存的惯性陀螺和加速度计的测量数据进行姿态反推,反推到起始时刻的初始角度信息,然后按照步骤2执行精对准滤波,反复循环运算直到两次对准结果航向角的差值小于预设的精度偏差值时退出回溯对准;或者当回溯次数大于10次时退出回溯对准;
步骤3包括子步骤:
步骤3.1,保存对准过程中陀螺的测量数据,以及加速度计的测量数据;
步骤3.2,执行姿态反推计算,包括依据地球自转角速度以及当前时刻的四元数反推中间时刻四元数;依据存储的陀螺角速度信息以及中间时刻四元数反推上一时刻的四元数;
步骤3.3,反推到对准起始时刻后,按照步骤2进行精对准滤波。
2.如权利要求1所述的方法,其特征在于,步骤1包括子步骤:
步骤1.1,定义惯性凝固坐标系,在对准起始时刻,n0是将北天东导航系n相对惯性空间凝固所得的导航惯性坐标系;b0是将前上右载体系b相对惯性空间凝固所得的载体惯性坐标系;
步骤1.2,确定载体实时姿态矩阵与惯性系常值矩阵的关系式,其中惯性系常值矩阵作为待求矩阵;
步骤1.3,将当前时刻姿态矩阵代入姿态矩阵与欧拉角的关系式,求出横滚角、航向角和俯仰角。
3.如权利要求2所述的方法,其特征在于,计算两个不同时刻的不共线矢量时,该两个时刻的时间差值大于等于30秒。
4.如权利要求1所述的方法,其特征在于,步骤2包括子步骤:
步骤2.1,依据速度误差方程、失准角误差方程、陀螺误差模型及加速度计误差模型建立系统状态方程;
步骤2.2,建立精确对准系统量测方程;
步骤2.3,基于优化迭代方式执行回溯对准计算。
5.如权利要求1所述的方法,其特征在于,所述预设的精度偏差值为0.005°。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111224735.9A CN113959462B (zh) | 2021-10-21 | 2021-10-21 | 一种基于四元数的惯性导航系统自对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111224735.9A CN113959462B (zh) | 2021-10-21 | 2021-10-21 | 一种基于四元数的惯性导航系统自对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113959462A CN113959462A (zh) | 2022-01-21 |
CN113959462B true CN113959462B (zh) | 2023-09-12 |
Family
ID=79465736
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111224735.9A Active CN113959462B (zh) | 2021-10-21 | 2021-10-21 | 一种基于四元数的惯性导航系统自对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113959462B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115855038B (zh) * | 2022-11-22 | 2024-01-09 | 哈尔滨工程大学 | 一种短时高精度姿态保持方法 |
CN115727846B (zh) * | 2023-01-09 | 2023-04-14 | 中国人民解放军国防科技大学 | 一种捷联惯导与卫导的多线程回溯式组合导航方法 |
Citations (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013059989A1 (zh) * | 2011-10-25 | 2013-05-02 | 国防科学技术大学 | 一种惯性导航系统的运动对准方法 |
CN103557871A (zh) * | 2013-10-22 | 2014-02-05 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
CN103575299A (zh) * | 2013-11-13 | 2014-02-12 | 北京理工大学 | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 |
CN105043415A (zh) * | 2015-07-13 | 2015-11-11 | 北京工业大学 | 基于四元数模型的惯性系自对准方法 |
CN105806363A (zh) * | 2015-11-16 | 2016-07-27 | 东南大学 | 基于srqkf的sins/dvl水下大失准角对准方法 |
CN106052715A (zh) * | 2016-05-23 | 2016-10-26 | 西北工业大学 | 单轴旋转捷联惯导系统回溯式自对准方法 |
CN106595652A (zh) * | 2016-11-30 | 2017-04-26 | 西北工业大学 | 车辆运动学约束辅助的回溯式行进间对准方法 |
CN107655493A (zh) * | 2017-09-06 | 2018-02-02 | 东南大学 | 一种光纤陀螺sins六位置系统级标定方法 |
CN109163735A (zh) * | 2018-09-29 | 2019-01-08 | 苏州大学 | 一种晃动基座正向-正向回溯初始对准方法 |
CN109443378A (zh) * | 2018-09-21 | 2019-03-08 | 苏州大学 | 速度辅助行进间回溯初始对准方法 |
CN110160523A (zh) * | 2019-05-20 | 2019-08-23 | 北京机电工程研究所 | 基于方位装订的初始对准方位角补偿方法及车载武器系统 |
CN110806220A (zh) * | 2019-11-23 | 2020-02-18 | 中国船舶重工集团公司第七一七研究所 | 一种惯导系统初始对准方法及装置 |
CN111102993A (zh) * | 2019-12-31 | 2020-05-05 | 中国人民解放军战略支援部队航天工程大学 | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 |
AU2020101268A4 (en) * | 2020-07-06 | 2020-08-13 | Harbin Engineering University | The initial alignment method for sway base |
CN111735474A (zh) * | 2020-06-14 | 2020-10-02 | 西北工业大学 | 一种基于数据回溯的动基座罗经对准方法 |
CN112697141A (zh) * | 2020-12-16 | 2021-04-23 | 北京航空航天大学 | 基于逆向导航的惯导/里程计动基座姿态与位置对准方法 |
CN112729332A (zh) * | 2020-11-17 | 2021-04-30 | 中国船舶重工集团公司第七0七研究所 | 一种基于旋转调制的对准方法 |
CN113405563A (zh) * | 2021-05-25 | 2021-09-17 | 北京机械设备研究所 | 一种惯性测量单元对准方法 |
CN113503892A (zh) * | 2021-04-25 | 2021-10-15 | 中船航海科技有限责任公司 | 一种基于里程计和回溯导航的惯导系统动基座初始对准方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8436283B1 (en) * | 2008-07-11 | 2013-05-07 | Davidson Technologies Inc. | System and method for guiding and controlling a missile using high order sliding mode control |
CN110487301B (zh) * | 2019-09-18 | 2021-07-06 | 哈尔滨工程大学 | 一种雷达辅助机载捷联惯性导航系统初始对准方法 |
-
2021
- 2021-10-21 CN CN202111224735.9A patent/CN113959462B/zh active Active
Patent Citations (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013059989A1 (zh) * | 2011-10-25 | 2013-05-02 | 国防科学技术大学 | 一种惯性导航系统的运动对准方法 |
CN103917850A (zh) * | 2011-10-25 | 2014-07-09 | 中国人民解放军国防科学技术大学 | 一种惯性导航系统的运动对准方法 |
CN103557871A (zh) * | 2013-10-22 | 2014-02-05 | 北京航空航天大学 | 一种浮空飞行器捷联惯导空中初始对准方法 |
CN103575299A (zh) * | 2013-11-13 | 2014-02-12 | 北京理工大学 | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 |
CN105043415A (zh) * | 2015-07-13 | 2015-11-11 | 北京工业大学 | 基于四元数模型的惯性系自对准方法 |
CN105806363A (zh) * | 2015-11-16 | 2016-07-27 | 东南大学 | 基于srqkf的sins/dvl水下大失准角对准方法 |
CN106052715A (zh) * | 2016-05-23 | 2016-10-26 | 西北工业大学 | 单轴旋转捷联惯导系统回溯式自对准方法 |
CN106595652A (zh) * | 2016-11-30 | 2017-04-26 | 西北工业大学 | 车辆运动学约束辅助的回溯式行进间对准方法 |
CN107655493A (zh) * | 2017-09-06 | 2018-02-02 | 东南大学 | 一种光纤陀螺sins六位置系统级标定方法 |
CN109443378A (zh) * | 2018-09-21 | 2019-03-08 | 苏州大学 | 速度辅助行进间回溯初始对准方法 |
CN109163735A (zh) * | 2018-09-29 | 2019-01-08 | 苏州大学 | 一种晃动基座正向-正向回溯初始对准方法 |
CN110160523A (zh) * | 2019-05-20 | 2019-08-23 | 北京机电工程研究所 | 基于方位装订的初始对准方位角补偿方法及车载武器系统 |
CN110806220A (zh) * | 2019-11-23 | 2020-02-18 | 中国船舶重工集团公司第七一七研究所 | 一种惯导系统初始对准方法及装置 |
CN111102993A (zh) * | 2019-12-31 | 2020-05-05 | 中国人民解放军战略支援部队航天工程大学 | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 |
CN111735474A (zh) * | 2020-06-14 | 2020-10-02 | 西北工业大学 | 一种基于数据回溯的动基座罗经对准方法 |
AU2020101268A4 (en) * | 2020-07-06 | 2020-08-13 | Harbin Engineering University | The initial alignment method for sway base |
CN112729332A (zh) * | 2020-11-17 | 2021-04-30 | 中国船舶重工集团公司第七0七研究所 | 一种基于旋转调制的对准方法 |
CN112697141A (zh) * | 2020-12-16 | 2021-04-23 | 北京航空航天大学 | 基于逆向导航的惯导/里程计动基座姿态与位置对准方法 |
CN113503892A (zh) * | 2021-04-25 | 2021-10-15 | 中船航海科技有限责任公司 | 一种基于里程计和回溯导航的惯导系统动基座初始对准方法 |
CN113405563A (zh) * | 2021-05-25 | 2021-09-17 | 北京机械设备研究所 | 一种惯性测量单元对准方法 |
Non-Patent Citations (1)
Title |
---|
捷联惯导系统动基座传递对准匹配方法;管叙军;《航空兵器》(第2期);3-5 * |
Also Published As
Publication number | Publication date |
---|---|
CN113959462A (zh) | 2022-01-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108180925B (zh) | 一种里程计辅助车载动态对准方法 | |
WO2020220729A1 (zh) | 基于角加速度计/陀螺/加速度计的惯性导航解算方法 | |
CN107655493B (zh) | 一种光纤陀螺sins六位置系统级标定方法 | |
CN113959462B (zh) | 一种基于四元数的惯性导航系统自对准方法 | |
CN111156994A (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
CN111121766B (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN111207745B (zh) | 一种适用于大机动无人机垂直陀螺仪的惯性测量方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN112857398B (zh) | 一种系泊状态下舰船的快速初始对准方法和装置 | |
CN110361031A (zh) | 一种基于回溯理论的imu全参数误差快速标定方法 | |
CN109489661B (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
Carratù et al. | IMU self-alignment in suspensions control system | |
CN113008229B (zh) | 一种基于低成本车载传感器的分布式自主组合导航方法 | |
CN112729332B (zh) | 一种基于旋转调制的对准方法 | |
US20200049504A1 (en) | Machine learning zero-rate level calibration | |
CN111207734B (zh) | 一种基于ekf的无人机组合导航方法 | |
CN110940357B (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN115574817B (zh) | 一种基于三轴旋转式惯导系统的导航方法及导航系统 | |
CN113932803B (zh) | 适用于高动态飞行器的惯性/地磁/卫星组合导航系统 | |
Hong et al. | Application of EKF for missile attitude estimation based on “SINS/CNS” integrated guidance system | |
CN112649001B (zh) | 一种小型无人机姿态与位置解算方法 | |
Fu et al. | Multiposition alignment for rotational INS based on real-time estimation of inner lever arms | |
CN112197767A (zh) | 一种在线改进滤波误差的滤波器设计方法 | |
CN112393741A (zh) | 基于有限时间滑模的sins/bds组合导航系统空中对准方法 | |
CN111007542A (zh) | 一种车载星基增强多模gnss/mimu组合导航中mimu安装误差角的计算方法 |
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 |