CN102221366B - 一种基于模糊变地球自转角速度的快速精对准方法 - Google Patents
一种基于模糊变地球自转角速度的快速精对准方法 Download PDFInfo
- Publication number
- CN102221366B CN102221366B CN 201110058569 CN201110058569A CN102221366B CN 102221366 B CN102221366 B CN 102221366B CN 201110058569 CN201110058569 CN 201110058569 CN 201110058569 A CN201110058569 A CN 201110058569A CN 102221366 B CN102221366 B CN 102221366B
- Authority
- CN
- China
- Prior art keywords
- earth
- alignment
- error
- angular velocity
- rotational
- 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
Images
Landscapes
- Navigation (AREA)
Abstract
本发明的目的在于提供一种基于模糊变地球自转角速度的快速精对准方法,包括以下步骤:确定载体的初始位置参数,采集加速度计和陀螺仪输出,确定粗略的初始姿态矩阵,根据计算地球自转角速度进行卡尔曼滤波一步迭代计算,确定精对准时间,判断是否精对准是否结束,若结束则采用卡尔曼滤波技术估计出的失准角,并用失准角来修正***的捷联姿态矩阵,完成精确初始对准,若未结束则返回进行修正直至精对准结束,之后同样采用卡尔曼滤波技术估计出的失准角,并用失准角来修正***的捷联姿态矩阵,完成精确初始对准。本发明不需要增加任何外观测设备,无需提供辅助位置转台,工程实现容易,有效提高了捷联惯性导航***的精对准的快速性。
Description
技术领域
本发明涉及的是一种导航领域的对准方法,具体地说是用于捷联惯性***的初始姿态确定的方法。
背景技术
捷联惯性导航***(Strapdown Inertial Navigation System简称SINS)的基本原理是根据牛顿提出的相对惯性空间的力学定律,利用加速度计、陀螺仪测量载体惯性空间的线运动和角运动参数,在给定的运动初始条件下,由计算机进行积分运算,连续、实时地提供位置、速度和姿态信息。根据SINS的基本原理,SINS在导航定位解算之前必须获得初始信息,包括初始位置、速度和姿态。SINS的初始位置和速度信息较初始姿态容易获得,初始姿态确定的精度就是SINS进入导航工作状态时的初始精度。因此,SINS开始工作时进行快速精确的初始姿态的确定是十分重要的一步。
现有的捷联惯导***初始姿态确定分为粗对准和精对准两个阶段。粗对准阶段就是在静基座条件下,将陀螺仪和加速度计输出直接引入导航计算机,计算出载体的初始姿态。用此方法时,常常忽略陀螺仪和加速度计的误差和外部干扰因素,然而这些因素会导致误差,因此初始姿态计算精度不高。精对准阶段是在粗对准的基础上进行,利用现代控制理论的状态空间法,对陀螺仪和加速度计输出的数据进行处理。计算出导航坐标系与真实导航坐标系的失准角,建立准确的初始姿态矩阵。捷联惯性导航***要求对准精度高,对准时间短。
以速度误差作为观测量的静基座精对准***的可观测性和可观测度差,是制约其对准精度和快速性的重要原因,特别是方位角的观测度低,导致方位失准角的估计效果很差。关于快速对准,已有的文献的常规思路都是如何提高方位角的可观测度,如增加方位传感器或者进行多位置对准等。如专利号:ZL200510130615.7的发明专利:一种捷联惯性导航***的任意双位置初始对准方法;如专利号:ZL200810064146.7的发明专利:基于滤波的光纤陀螺捷联惯导***两位置初始对准方法;是在对准过程中利用位置转台进行多位置对准来提高***的可观性和可观度,虽然这些方法已经不需要难以实现的精密位置转台了,但还是需要在位置转台上进行,限制了工程应用。如专利号:200810019357.9的发明专利:捷联惯性导航***的快速精对准方法;是通过增加磁传感器和倾角传感器来提高捷联惯导***的可观性,但是该方法利用的方位传感器一般都是地磁传感器,这种地磁传感很容易收外部的干扰,尤其载体是磁导体时,地磁传感很难正常工作,很难实际使用。因此在实际工程应用中,找到一种能够提高惯性导航***的对准精度和反应能力的方法,对提高整个捷联导航***的性能具有非常重要的军事意义和实用价值。
发明内容
本发明的目的在于提供实用性好、精度高、对准时间短的一种基于模糊变地球自转角速度的快速精对准方法。
本发明的目的是这样实现的:
本发明一种基于模糊变地球自转角速度的快速精对准方法包括以下步骤:
(1)通过外部设备确定载体的初始位置参数,并将其装订至导航计算机;
(2)SINS预热准备,采集加速度计和陀螺仪输出;
(3)利用采集到的加速度计和陀螺仪输出,通过标准的解析法进行粗对准,确定粗略的初始姿态矩阵;
(4)粗对准结束后进入精对准阶段,令计算地球自转角速度ωe=Ωe,Ωe表示真实地球自转速度;
(5)根据加速度计的输出和粗对准获得初始姿态,以及计算地球自转角速度进行卡尔曼滤波一步迭代计算;
(6)确定精对准时间tf,使tf的取值大于滤波的收敛时间且小于惯性导航***能够允许的最大时间。
(7)判断精对准tf计时是否结束,若精对准已经结束则令计算地球自转角速度ωe=Ωe,采用卡尔曼滤波技术估计出的失准角,并用失准角来修正***的捷联姿态矩阵,完成精确初始对准;若精对准未结束,则根据卡尔曼滤波估计误差方差Pk计算两个误差距离和,其中 为东向误差角估计误差的方差、为方位误差角估计误差的方差、hΔφD为方位角的期望稳定误差,通过模糊推理的方法估算出计算地球自转角速度ωe=nΩe,返回步骤(5)进行卡尔曼迭代计算直至精对准结束,令计算地球自转角速度ωe=Ωe,采用卡尔曼滤波技术估计出的失准角,并用失准角来修正***的捷联姿态矩阵,完成精确初始对准。
本发明的优势在于:不需要增加任何外观测设备,仅需要对捷联惯性导航***的精对准算法进行更新;无需提供辅助位置转台,工程实现容易;有效提高了捷联惯性导航***的精对准的快速性。
附图说明
图1是模糊推理的输入隶属度函数;
图2是模糊推理的输出隶属度函数;
图3是捷联惯性导航***精对准结构图;
图4是本发明的流程图;
图5是不同地球自转角速度时惯导的东向误差角估计误差对比曲线;
图6是不同地球自转角速度时惯导的北向误差角估计误差对比曲线;
图7是不同地球自转角速度时惯导的方位东向误差角估计误差对比曲线;
图8是模糊推理估出的地球自转角速度与不同地球自转角速度时惯导的东向误差角估计误差对比曲线;
图9是模糊推理估出的地球自转角速度与不同地球自转角速度时惯导的北向误差角估计误差对比曲线;
图10是模糊推理估出的地球自转角速度与不同地球自转角速度时惯导的方位误差角估计误差对比曲线。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
实施方式1:
结合图1~10,本发明包括以下步骤:
(1)通过外部设备确定载体的初始位置参数,并将其装订至导航计算机;
(2)SINS预热准备,采集加速度计和陀螺仪输出;
(3)利用采集到的加速度计和陀螺仪输出,通过标准的解析法进行粗对准,确定粗略的初始姿态矩阵;
(4)粗对准结束后进入精对准阶段,令计算地球自转角速度ωe=Ωe,Ωe表示真实地球自转速度;
(5)根据加速度计的输出和粗对准获得初始姿态,以及计算地球自转角速度进行卡尔曼滤波一步迭代计算;
(6)确定精对准时间tf,使tf的取值大于滤波的收敛时间且小于惯性导航***能够允许的最大时间。
(7)判断精对准tf计时是否结束,若精对准已经结束则令计算地球自转角速度ωe=Ωe,采用卡尔曼滤波技术估计出的失准角,并用失准角来修正***的捷联姿态矩阵,完成精确初始对准;若精对准未结束,则根据卡尔曼滤波估计误差方差Pk计算两个误差距离和其中 为东向误差角估计误差的方差、为方位误差角估计误差的方差、hΔφD为方位角的期望稳定误差,通过模糊推理的方法估算出计算地球自转角速度ωe=nΩe,返回步骤(5)进行卡尔曼迭代计算直至精对准结束,令计算地球自转角速度ωe=Ωe,采用卡尔曼滤波技术估计出的失准角,并用失准角来修正***的捷联姿态矩阵,完成精确初始对准。
本发明还包括如下特征:
1、步骤5中用到的***状态方程和量测方程
建立精对准***的状态方程和观测方程
在东北天坐标系中,显然有其中Ωe表示真实地球自转速度,表示当地的纬度, 为了研究捷联惯性***静基座下的初始对准,考虑到陀螺随机漂移误差和加速度计的随机偏差,忽略了位置误差和垂直速度误差,根据修正Bar-Itzhachk和Bermant的惯性误差模型,得到***的动态方程为:
Z(t)=H(t)X(t)+V(t) (2)
式(1)、(2)中,X(t)为***的状态向量,Z(t)为***的观测向量;A(t)为***状态转移矩阵,H(t)为***的观测矩阵;W(t),V(t)分别为***的过程噪声向量和观测噪声向量,其均值都为零的高斯白噪声。
***的状态向量为:
***的噪声向量为:
式(3)、(4)中,δvE、δvN表示***东向和北向的速度误差,φE、φN、φD表示数学平台与导航平台的东向、北向和方位失准角,表示x轴和y轴的加速度计的误差,εx、εy、εz表示xyz轴上的陀螺仪的误差,表示***东向和北向的速度误差的白噪声,表示东向、北向和方位失准角的白噪声。
***的状态转移矩阵为:
***的观测向量为:
Z(t)=[δvE δvN]T (6)
***的观测噪声向量为:
式(5)Cij为载体坐标系相对导航坐标系的姿态矩阵的第i行和第j列元素,g为当地的地球重力角速度。
2、粗对准和精对准之间的关系
通过步骤3进行粗对准计算出来的姿态矩阵的准确性比较低,也就是说实际的导航坐标系和粗对准计算出的导航坐标系并不重合,存在一个小的偏差,它的余弦矩阵为我们定义经过粗对准后的姿态矩阵为,那么精确的载体坐标系与导航坐标系的方向余弦矩阵为:
式(8)中p代表粗对准后的数学平台。
3、卡尔曼滤波状态估计
在特征1、2的基础上利用标准的卡尔曼滤波方法进行迭代计算,可以估算出失准角φ。具体过程如下:
首先对***方程式(1)和观测方程式(2)进行离散化,得到
Xk=Φk,k-1Xk-1+Wk-1 (10)
Zk=HkXk+Vk (11)
式中Xk为***的状态序列,Zk为***的观测序列;Φk,k-1为***状态转移矩阵,Hk为***的观测矩阵;Wk-1,Vk分别为***的过程噪声序列和观测噪声序列,其均值都为零的高斯白噪声序列。***过程噪声Wk-1的方差为Qk-1,***观测噪声Vk的方差为Rk。
然后进行Kalman滤波:
状态一步预测:
状态估计:
滤波增益矩阵:
一步预测误差方差矩阵:
估计误差方差矩阵:
滤波初始值的选择可以参考关于用标准kalman滤波来完成初始对准的文献。
误差角φ的估计误差方差矩阵:Mk=CPkCT (17)
式(17)中C表示误差角观测矩阵,Pk表示kalman估计误差方差矩阵,
C=[03×2 I3×3 03×5]。
所以
定义两个误差距离
表示k时刻东向误差角估计误差的方差,表示k时刻北向误差角估计误差的方差,表示k时刻方位误差角估计误差的方差,表示水平误差与方位误差之间的耦合估计误差的方差,表示k时刻东向误差角与方位误差角的距离,表示k时刻方位误差角到稳态值的距离,h表示方位误差角稳态误差的权值,ΔφD为方位角的稳定误差。由于水平误差角的收敛速度与收敛误差相似,所以与也相近。
定义计算地球自转角速度:
ωe=nΩe (21)
式(21)中Ωe表示真实地球自转角速度,n表示增加地球自转角速度的权值。
设量化指标的论域空间为Ai(i=1,2)。设具有相同的论域空间,即有A1=A2,在论域上定义输入变量模糊子集为:SP(正小)、MP(正中)、LP(正大),选定模糊子集的隶属函数为高斯型函数:如图1所示。式中:c及σ为表示模糊推理***量化输入的分布参数(设计参数),经过模糊推理后,得到的模糊值sj∈[0,1]。
同样,在模糊推理***的输出空间[0,1],定义相同的模糊子集SP(正小)、MP(正中)、LP(正大),采用三角函数作为隶属函数,如图2所示。
在将上述的距离变量进行模糊化之后,采用如下的模糊推理法则进行推理推出权值
规则1:if s1=SP and s2=SP then N=SP;
规则2:if s1=SP and s2=MP then N=MP;
……
根据专家经验采用如表1所示的模糊规则表进行推理。
表1模糊规则表
本发明利用模糊推理的方式实时的估算出合适的计算地球自转角速度,不仅加快了方位误差角的收敛速度,而且保证了水平误差和方位误差的稳态精度。对准的流程图如图4所示,精对准***的结构图如图3所示,该精对准方法,既不需要增加任何传感器,也不需要位置的转台,只要需要修改捷联惯导***的初始对准的软件就可以极大的提高精对准的速度,容易工程实现。
现对本发明的有益效果说明如下:
(1)改变地球自转角速度的影响
计算地球自转角速度为ωe=nΩe,现分别取n=1,100,1000,5000时,也就是分别将计算地球自转角速度提高至1倍,100倍,1000倍,5000倍。图5-7分别为将计算地球自转角速度提高至1倍,100倍,1000倍,5000倍时东向误差、北向误差、方位误差仿真图(为了便于观察由增加计算地球自转角速度而引起的误差,将***噪声和观测噪声去除)。可以看出随权值n增大,水平误差(图5、6)的收敛速度没有太多的改变,但是方位误差(图7)的收敛速度却快速的提高。不过当权值n=5000时,水平误差和方位误差都会发生振荡。这说明提高计算地球自转角速度能够提高初始对准的快速性,不过不是计算地球自转角速度越大越好,计算地球自转角速度大到一定程度时,稳态误差会发生振荡和发散。这就是本发明要根据误差距离实时估算计算地球自转角速度的原因,只有这样才能保证方位误差收敛的快速性和稳态误差的平稳性。
(2)利用模糊推理的方法确定权值n对收敛速度的影响。
计算地球自转角速度到底增加到多少时,能够保证水平误差和方位误差不会发生振荡或发散,同时能够保证最快的收敛速度呢?这个问题很难确切的回答,***在不同的阶段需要不同的计算地球自转角速度才能保证最优误差特性,而且不同***的特性和不同噪声特性,为了获得最优误差特性,在不同的阶段所需要的计算地球自转角速度也不尽相同。因此最优的误差特性很难得到,但可通过次优的方法估出计算地球自转角速度。本发明通过定义两个误差距离和根据这两个距离通过模糊推理的方式实时估算出权值n,比较好的解决了这个问题。图8-10分别是通过模糊推理的方法估算权值n和固定权值的的比较图(为了便于观察由增加计算地球自转角速度而引起的误差,将***噪声和观测噪声去除)。从这些图中可以看出,通过模糊推理的方式估算出权值n方法使得水平误差(图8、9)的收敛速度明显提高,而且方位误差(图10)的收敛速度极快,45秒就完全收敛且稳态误差平稳,没有发生发散和振荡。
Claims (1)
1.一种基于模糊方法改变地球自转角速度的快速精对准方法,其特征是:
(1)通过外部设备确定载体的初始位置参数,并将其装订至导航计算机;
(2)SINS预热准备,采集加速度计和陀螺仪输出;
(3)利用采集到的加速度计和陀螺仪输出,通过标准的解析法进行粗对准,确定粗略的初始姿态矩阵;
(4)粗对准结束后进入精对准阶段,令计算地球自转角速度ωe=Ωe,Ωe表示真实地球自转速度;
(5)根据加速度计的输出和粗对准获得的初始姿态,以及计算地球自转角速度进行卡尔曼滤波迭代计算;
(6)确定精对准时间tf,使tf的取值大于卡尔曼滤波的收敛时间且小于SINS能够允许的最大时间;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110058569 CN102221366B (zh) | 2011-03-11 | 2011-03-11 | 一种基于模糊变地球自转角速度的快速精对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110058569 CN102221366B (zh) | 2011-03-11 | 2011-03-11 | 一种基于模糊变地球自转角速度的快速精对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102221366A CN102221366A (zh) | 2011-10-19 |
CN102221366B true CN102221366B (zh) | 2013-07-03 |
Family
ID=44777986
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110058569 Expired - Fee Related CN102221366B (zh) | 2011-03-11 | 2011-03-11 | 一种基于模糊变地球自转角速度的快速精对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102221366B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020117675A1 (en) | 2018-12-03 | 2020-06-11 | DSi Digital, LLC | Data interaction platforms utilizing dynamic relational awareness |
CN110398257B (zh) * | 2019-07-17 | 2022-08-02 | 哈尔滨工程大学 | Gps辅助的sins***快速动基座初始对准方法 |
CN112362083B (zh) * | 2020-11-17 | 2022-08-09 | 中北大学 | 基于牛顿迭代法的姿态失准角现场快速标定补偿方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101216321A (zh) * | 2008-01-04 | 2008-07-09 | 南京航空航天大学 | 捷联惯性导航***的快速精对准方法 |
EP2026037A2 (en) * | 2007-08-14 | 2009-02-18 | Honeywell International Inc. | Navigation system and corresponding method for gyrocompass alignment using dynamically calibrated sensor data and an iterative extended kalman filter |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050240347A1 (en) * | 2004-04-23 | 2005-10-27 | Yun-Chun Yang | Method and apparatus for adaptive filter based attitude updating |
-
2011
- 2011-03-11 CN CN 201110058569 patent/CN102221366B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2026037A2 (en) * | 2007-08-14 | 2009-02-18 | Honeywell International Inc. | Navigation system and corresponding method for gyrocompass alignment using dynamically calibrated sensor data and an iterative extended kalman filter |
CN101216321A (zh) * | 2008-01-04 | 2008-07-09 | 南京航空航天大学 | 捷联惯性导航***的快速精对准方法 |
Non-Patent Citations (2)
Title |
---|
LIN Zhao等.Study on attitude algorithm for initial alignment of SINS on dynamic base.《Proceeding of the 2006 IEEE International Conference on Mechatronics and Automatics》.2006, * |
李东明等.一种新的捷联惯导***初始对准方法.《中国惯性技术学报》.2005,第13卷(第2期), * |
Also Published As
Publication number | Publication date |
---|---|
CN102221366A (zh) | 2011-10-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101246022B (zh) | 基于滤波的光纤陀螺捷联惯导***两位置初始对准方法 | |
CN101514900B (zh) | 一种单轴旋转的捷联惯导***初始对准方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导***初始航向的姿态获取方法 | |
CN102706366B (zh) | 一种基于地球自转角速率约束的sins初始对准方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导***大方位失准角初始对准方法 | |
CN100547352C (zh) | 适合于光纤陀螺捷联惯性导航***的地速检测方法 | |
CN110398257A (zh) | Gps辅助的sins***快速动基座初始对准方法 | |
CN105509739A (zh) | 采用固定区间crts平滑的ins/uwb紧组合导航***及方法 | |
CN103900574B (zh) | 一种基于迭代容积卡尔曼滤波姿态估计方法 | |
CN103900613B (zh) | 一种基于磁力计n阶距检测的mems***误差估计方法 | |
CN102937450B (zh) | 一种基于陀螺测量信息的相对姿态确定方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN106052716A (zh) | 惯性系下基于星光信息辅助的陀螺误差在线标定方法 | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN105806363A (zh) | 基于srqkf的sins/dvl水下大失准角对准方法 | |
CN107703757A (zh) | 微陀螺仪***的超扭曲滑模控制方法 | |
CN103674064B (zh) | 捷联惯性导航***的初始标定方法 | |
CN107576327A (zh) | 基于可观测度分析的可变结构综合导航***设计方法 | |
CN103245357A (zh) | 一种船用捷联惯导***二次快速对准方法 | |
CN103697878A (zh) | 一种单陀螺单加速度计旋转调制寻北方法 | |
Zhang et al. | A novel INS/USBL integrated navigation scheme via factor graph optimization | |
Sun et al. | A robust indirect Kalman filter based on the gradient descent algorithm for attitude estimation during dynamic conditions | |
CN102221366B (zh) | 一种基于模糊变地球自转角速度的快速精对准方法 | |
CN103901459B (zh) | 一种mems/gps组合导航***中量测滞后的滤波方法 | |
Kim et al. | Drift error analysis caused by RLG dither axis bending |
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: 20130703 Termination date: 20200311 |