CN109556632A - 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 - Google Patents
一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 Download PDFInfo
- Publication number
- CN109556632A CN109556632A CN201811421552.4A CN201811421552A CN109556632A CN 109556632 A CN109556632 A CN 109556632A CN 201811421552 A CN201811421552 A CN 201811421552A CN 109556632 A CN109556632 A CN 109556632A
- Authority
- CN
- China
- Prior art keywords
- ins
- polarization
- gnss
- measurement
- error
- 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.)
- Granted
Links
- 230000010287 polarization Effects 0.000 title claims abstract description 126
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000001914 filtration Methods 0.000 title claims abstract description 20
- 238000005259 measurement Methods 0.000 claims abstract description 119
- 238000012937 correction Methods 0.000 claims abstract description 17
- 238000005516 engineering process Methods 0.000 claims abstract description 8
- 230000004927 fusion Effects 0.000 claims abstract description 7
- 230000003416 augmentation Effects 0.000 claims abstract description 6
- 238000004364 calculation method Methods 0.000 claims abstract description 5
- 230000005389 magnetism Effects 0.000 claims description 77
- 239000011159 matrix material Substances 0.000 claims description 75
- 239000013598 vector Substances 0.000 claims description 46
- 230000005291 magnetic effect Effects 0.000 claims description 30
- 238000013461 design Methods 0.000 claims description 9
- 238000005457 optimization Methods 0.000 claims description 6
- 238000005295 random walk Methods 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 8
- 238000012546 transfer Methods 0.000 description 5
- 229910052742 iron Inorganic materials 0.000 description 4
- 230000036544 posture Effects 0.000 description 4
- 238000009434 installation Methods 0.000 description 3
- 241001424688 Enceliopsis Species 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 239000011664 nicotinic acid Substances 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000002123 temporal effect Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000000149 argon plasma sintering Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 239000003302 ferromagnetic material Substances 0.000 description 1
- 230000005358 geomagnetic field Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 230000009897 systematic 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
- 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
-
- 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/165—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 combined with non-inertial navigation instruments
-
- 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/18—Stabilised platforms, e.g. by gyroscope
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
本发明涉及一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,选择初始对准的状态变量,建立组合导航系统误差方程;根据偏振传感器输出的偏振方位角与INS输出的方位角匹配融合建立偏振量测方程;根据磁强计输出的航向角与INS输出的航向角建立地磁量测方程;根据GNSS输出的速度、位置信息与INS输出的速度、位置信息匹配融合建立误差量测方程;利用增广技术建立统一的组合导航系统量测方程;设计卡尔曼滤波器估计组合导航系统的失准角、速度误差以及位置误差等物理量;对组合导航系统姿态、速度及位置进行反馈校正,提高初始对准估计精度。本发明具有精度高、计算量小、兼容性强的优点,并减少初始对准时间。
Description
技术领域
本发明涉及一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,可用于提高地球大气层内运载体(车辆、舰船和飞行器)的动基座初始对准精度,缩短初始对准时间。涉及一种航空、航天、航海、地面交通以及深海潜航等领域的初始对准方法。
背景技术
在进入导航状态前,导航系统需要进行初始对准,通过初始对准得知初始导航参数,包括姿态和速度。在动基座条件下,载体在运动过程中存在晃动、振动等多种形式的干扰。这些干扰因素会降低导航系统初始对准精度,延长对准时间。因此,动基座初始对准方法一直是组合导航技术领域的难点和热点问题。
目前,动基座初始对准方法主要包括两大类:一类是基于主/子惯性导航系统系统的传递对准方法;另一类是惯性导航系统系统与卫星、磁罗盘、星敏感器等导航设备进行组合初始对准方法。传递对准方法中,由于导弹载体存在结构挠性变形、主惯性导航系统与子惯性导航系统之间存在数据传输延迟等因素影响,初始对准精度及时间往往不能得到保证。而惯性导航系统系统与卫星、磁罗盘和星敏感器等导航设备进行组合初始对准方法,同样存在问题:其中,卫星在载体作机动时误差较大,且与惯性导航系统系统信号同步性不好;磁罗盘依赖于地磁场模型精度,特别是在地磁场异常的情况下,将出现较大误差,因此用于动基座初始对准效果并不理想;星敏感器可高精度估计载体姿态误差,但并不适用于在地球大气层内白昼时间段内的动基座初始对准。基于上述原因,惯性导航系统结合新型导航装置,设计更合适的信息匹配方式是动基座初始对准技术的发展趋势之一。
偏振光导航是一种仿生导航方式。太阳光线入射大气层时,大气中的粒子会使入射光线散射,造成太阳光线的偏振现象,沙蚁等生物可利用天空中的偏振光进行导航。根据仿生导航原理设计的偏振光传感器,可敏感到传感器量测方向的入射光最大偏振方向,输出偏振方位角。基于偏振方位角的偏振光导航具有自主性强、误差不随时间积累等优点,尤其适用于高精度的姿态确定。但偏振方位角对定位误差极不敏感,可达数十米。惯性导航系统的误差随时间积累,位置信息是发散的。因此偏振光传感器仅与惯性导航系统组合进行动基座初始对准会造成精度不高,甚至可能出现滤波结果发散的情况。
综上,目前常用的动基座初始对准方法存在对准精度低、对准时间长等缺点,而偏振光传感器、磁传感器对位置误差极不敏感,仅与惯性导航系统组合进行动基座初始对准效果同样不好。
现有技术中的相关专利有:
与专利号为201310069511.4“一种SINS/GPS/偏振光组合导航系统的动基座初始对准方法”的发明专利相比,本发明有以下区别:
(1)所建立的组合导航系统模型不同,本发明加入新的传感器磁强计,通过融合新的传感器数据,可进一步提高初始对准的精度;
(2)所建立的偏振机理模型不同,本专利获得的偏振量测方程与专利号为201310069511.4“一种SINS/GPS/偏振光组合导航系统的动基座初始对准方法”的发明专利完全不同,后者所建立的偏振机理模型采用单个偏振光传感器进行构建,建立的模型复杂,而且存在除法,导致噪声不再满足高斯分布,在状态估计阶段会存在问题;本发明采用双偏振光传感器的设计,构建的模型简单,解决了单一传感器噪声分布不再是高斯分布的问题。
发明内容
本发明的技术解决问题是:克服现有方法的不足,提供一种精度高、对准快、多传感器融合的基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法。
本发明的技术解决方案为:一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其实现步骤如下:
(1)选择失准角、速度误差、位置误差、陀螺仪零偏、加速度计零偏以及磁航向角误差作为INS/GNSS/偏振/地磁组合导航系统的状态变量,并建立初始对准的状态方程,其中,INS(Inertial Navigation System)为惯性导航系统,GNSS(Global NavigationSatellite System)为全球导航卫星系统;
(2)根据偏振传感器输出的偏振方位角与INS输出的方位角匹配融合建立偏振量测方程,得到基于偏振方位角的量测方程;
(3)根据磁强计输出的航向角与INS输出的航向角建立地磁量测方程,得到基于磁强计航向角误差的量测方程;
(4)根据GNSS输出的速度、位置信息与INS输出的速度、位置信息匹配融合建立速度误差与位置误差量测方程,得到基于速度误差与位置误差的量测方程;
(5)在步骤(2)、(3)和(4)建立的量测方程基础上,利用增广技术将上述3个步骤中的量测方程进行向量化,建立统一的INS/GNSS/偏振/地磁组合导航系统量测方程,在此基础上,对INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程进行离散化;
(6)根据步骤(5)建立的统一的INS/GNSS/偏振/地磁组合导航系统量测方程以及状态方程,设计卡尔曼滤波器估计INS/GNSS/偏振/地磁组合导航系统未知的状态;
(7)根据步骤(6)中估计得到的失准角、速度误差以及位置误差对INS/GNSS/偏振/地磁组合导航系统进行反馈校正,方法为基于INS获取的姿态、速度及位置上减去步骤(6)中估计得到的失准角、速度误差及位置误差,获取经反馈校正后的INS/GNSS/偏振/地磁组合导航系统姿态、速度及位置。
所述步骤(1)中,选择失准角、速度误差、位置误差、陀螺仪零偏、加速度计零偏以及磁航向角误差作为INS/GNSS/偏振/地磁组合导航系统的状态变量,并建立的初始对准的状态方程,所建立的初始对准状态方程为:
其中,F为INS/GNSS/偏振/地磁组合导航系统状态转移矩阵表示为:
A为标准的15维捷联惯性导航系统初始对准的状态转移矩阵,β为反相关时间系数,Om×n为m行n列全零向量。
X为INS/GNSS/偏振/地磁组合导航系统状态变量,G为INS/GNSS/偏振/地磁组合导航系统噪声分配矩阵,W为INS/GNSS/偏振/地磁组合导航系统噪声矢量:
其中,φE,φN,φU分别为导航系,即n系下的东向失准角、北向失准角和天向失准角;δVE,δVN,δVU分别为导航系下的东向、北向和天向速度误差,这里导航系采用当地地理坐标系,即以载体的质心为原点,当地东向为地理系x轴,北向为y轴,天向为z轴,x轴,y轴和z轴满足右手坐标系。δλ,δL,δh分别为经度、纬度和高度误差;εx,εy,εz为载体坐标系,即b系下三个轴向的陀螺常值漂移,这里b系定义为,其原点O与载体质心重合,x轴正向与载体正向同向,y轴沿载体纵轴指左,z轴垂直xOy构成的平面指上,坐标系满足右手坐标系;分别为b系下加速度常值漂移;为磁强计的航向角测量误差。
G为INS/GNSS/偏振/地磁组合导航系统噪声分配矩阵,W为INS/GNSS/偏振/地磁组合导航系统噪声矢量:
为陀螺仪三个轴向的随机游走,为加速度计三个轴向上的随机游走,为磁强计噪声。
所述步骤(2)中,根据偏振传感器输出的偏振方位角与INS输出的方位角匹配融合建立偏振量测方程,得到基于偏振方位角的量测方程为:
zpolar=H1X+υpolar
其中,υpolar为偏振传感器的量测噪声;zpolar为偏振量测量,表示为:
其中,sm为单位太阳矢量在模块系m系下的表示,模块系为偏振传感器模块所在的坐标系,定义与载体坐标系基本相同,原点为模块质心,一般情况下与载体坐标系重合;为计算导航系n′系到b系下的姿态转换矩阵,计算导航系n′系为实际导航过程用于计算导航解的导航坐标系,坐标原点与导航系统相同,x轴、y轴和z轴与理想导航系n系存在偏差角,该偏差角即为失准角;为地球系e系到理想导航系n系下的姿态转换矩阵,地球系原点与地心重合,xe轴指向本初子午线,ze轴沿极轴方向指向北极,ye轴在赤道平面内与xe、ze轴构成右手系,理想导航系即为“东北天”坐标系,其原点为载体所在点,N轴指向北极方向,E轴指向东,U轴指向天空,满足右手坐标系;se为单位太阳矢量在e系下的表示。
H1是以偏振方位角的量测矩阵,具体表示为:
其中,表示矢量的反对称阵形式。
所述步骤(3)中,根据磁强计输出的航向角与INS输出的航向角建立地磁量测方程,得到基于磁强计航向角误差的量测方程为:
zmag=H2X+υmag
其中,H2=[O1×15 1]为基于磁强计航向角的量测矩阵,维度为1×16,O1×15为1行15列全零向量;zmag为磁强计误差量测量;υmag为磁强计量测噪声。
所述步骤(4)中,根据GNSS输出的速度、位置信息与INS输出的速度、位置信息匹配融合建立速度误差与位置误差量测方程,得到基于速度误差与位置误差的量测方程为:
其中,zv,zp分别融合了INS与GNSS速度、位置信息的速度误差与位置误差的量测量;H3=[O3×3 I3×3 O3×10]为速度误差量测矩阵,维度为3×16,I3×3为3×3的单位矩阵;H4=[O3×5 I3×3 O3×8]为位置误差量测矩阵,维度为3×16;为速度误差量测噪声向量,分别为东北天三个方向的速度噪声;υp=[υλ υL υh]T为位置误差量测噪声,υλ、υL、υh分别为经度、纬度及高度位置量测噪声。
所述步骤(5)中,在步骤(2)、(3)和(4)建立的量测方程基础上,利用增广技术将上述3个步骤中的量测方程进行向量化,建立统一的INS/GNSS/偏振/地磁组合导航系统量测方程,在此基础上,对INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程离散化。所建立的统一的INS/GNSS/偏振/地磁组合导航系统量测方程为:
Z=HX+V
其中,H为INS/GNSS/偏振/地磁组合导航系统统一的量测矩阵,具体表示为:
Z为全部量测向量,具体表示为:
其中,υGNSS为GNSS测量的速度矢量,υINS为INS测量的速度矢量;pGNSS为GNSS测量的位置矢量,pINS为INS测量的位置矢量。
V为全部量测噪声,具体表示为:
因此,统一的INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程为:
Z=HX+V
针对INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程离散化处理,获得统一的INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程为:
Xk=Φk,k-1Xk-1+Γk-1Wk-1
Zk=HkXk+Vk
其中,Xk为第k时刻的状态变量;Φk,k-1=eFΔt为离散化后的状态转移矩阵,Δt=tk-tk-1为时间间隔;Γk-1=eGΔt为第k-1时刻离散化后的噪声状态转移矩阵;Wk-1为第k-1时刻状态噪声向量,均值为0,方差为:
Q=E[WWT];Zk为第k时刻观测量;Hk为第k时刻离散后的量测矩阵,其形式与H相同;Vk为第k时刻量测噪声向量,均值为0,方差为R=E[VVT]。
所述步骤(6)中,根据已建立的统一的INS/GNSS/偏振/地磁组合导航系统量测方程以及状态方程,设计卡尔曼滤波器估计INS/GNSS/偏振/地磁组合导航系统失准角、速度误差以及位置误差,所设计的卡尔曼滤波内容如下:
①时间更新:
状态一步预测方程:
其中,为k-1时刻的状态一步预测值,为k-1时刻的状态最优估计值。
一步预测均方误差阵方程:
其中,Pk/k-1为k时刻状态的误差协方差矩阵,Pk-1为k-1时刻的误差协方差矩阵,Qk-1为k-1时刻状态噪声的协方差矩阵。
②量测更新:
状态估计计算方程:
其中,为k时刻的状态最优估计,Kk为卡尔曼增益,其计算方法为:
其中,Rk为k时刻量测噪声的协方差矩阵。
估计均方误差阵方程:
其中,I为单位矩阵。
所述步骤(7)中,通过卡尔曼滤波得到的INS/GNSS/偏振/地磁组合导航系统失准角、速度误差以及位置误差,采用反馈校正的方式进行动基座初始对准进行反馈校正,其方法为:
(1)姿态校正方法
首先计算n′系至n系的转换矩阵:
则校正后的姿态矩阵为:
(2)速度校正方法
设校正后的东向、北向和天向速度为VadE、VadN、则速度校正可表示为:
其中,分别为INS输出的东向、北向和天向速度;
(3)位置校正方法
设校正后的纬度、经度和高度分别为Lad、λad、had,则位置校正表示为:
其中,LINS、λINS、hINS分别为INS输出的纬度、经度和高度信息。
本发明与现有技术相比的优点在于:本发明将偏振光传感器、磁强计与INS、GNSS相结合,融合了多种传感器,使数据量变得丰富,可提高载体初始对准的精度。其中,偏振光传感器输出的偏振方位角不随时间积累,且具有高度自主性,具备高精度姿态校正能力;磁强计具有简单、快速、自主性好等优点,并且其功耗低,产生磁航向角可与偏振方位角中的航向角相冗,提高系统鲁棒性;GNSS提供速度、位置信息,弥补了偏振方位角信息对位置误差不敏感及惯性导航系统下速度、位置误差随时间积累并发散的缺点,缩短对准时间。
附图说明
图1为本发明的设计流程图;
图2为双偏振传感器坐标关系图。
具体实施方式
下面结合附图及实施例对本发明进行详细说明。
如图1所示,本发明具体实施步骤如下:
第一步,选择失准角、速度误差、位置误差、陀螺仪零偏、加速度计零偏以及磁航向角误差作为INS/GNSS/偏振/地磁组合导航系统的状态变量,并建立的初始对准的状态方程。
所建立的初始对准的状态方程为:
其中,F为系统状态转移矩阵,具体表示为:
其中,A为标准的15维捷联惯性导航系统初始对准的状态转移矩阵,β为反相关时间系数。
X为INS/GNSS/偏振/地磁组合导航系统状态变量,G为INS/GNSS/偏振/地磁组合导航系统噪声分配矩阵,W为INS/GNSS/偏振/地磁组合导航系统噪声矢量:
其中,φE,φN,φU分别为东向、北向和天向失准角;δVE,δVN,δVU分别为东向、北向和天向速度误差;δλ,δL,δh分别为经度、纬度和高度误差;εx,εy,εz为载体坐标系即b系下陀螺常值漂移,载体坐标系原点O与载体质心重合,x轴正向与载体正向同向,y轴沿载体纵轴指左,z轴垂直xOy构成的平面指上,整个坐标系满足右手坐标系;分别为b系下加速度常值漂移;为磁强计的航向角测量误差。
为陀螺仪三个轴向的随机游走,为加速度计三个轴向上的随机游走,为磁强计噪声。
第二步,根据偏振传感器输出的偏振方位角与INS输出的方位角匹配融合建立偏振量测方程:
首先,根据偏振方位角定义可知,瑞利散射后的产生的偏振光与太阳矢量在模块系m系下的投影垂直,模块系为偏振传感器模块所在的坐标系,原点与模块质心重合,x轴指向模块正向,z轴指向模块正上方,y轴满足右手坐标系,故有:
其中,为偏振方位角,可由标定好的六通道偏振传感器计算出来:
其中,为标定后的传感器参数,包括安装误差和尺度因子等。 为基于六通道仿生偏振传感器的对数处理后的量测输出。
综合式(5)、(6),可得:
然后,确定太阳矢量在模块系与地理系下的坐标转换关系。太阳矢量在模块系下的向量sm表示为:
同样,太阳矢量在地理系下的向量se表示为:
其中,λe和ψe为地理系下的高度角和方位角。根据天文学可知,在已知载体所处地理位置及当地时间的情况下,可计算出上述两个角度。在INS/GNSS/偏振/地磁组合导航系统中,偏振光传感器所需的时间信息由卫星提供,位置信息由经过校正后的惯性导航系统位置信息提供。
因为(8)、(9)为太阳矢量在不同坐标系下的描述,故可建立坐标转换:
其中,为载体坐标系b系与模块系m系的转换关系,即为偏振传感器和载体之间的安装关系,为固定常值,可在对准前标定补偿,这里假定其为单位矩阵,载体坐标系原点O与载体质心重合,x轴正向与载体正向同向,y轴沿载体纵轴指左,z轴垂直xOy构成的平面指上,整个坐标系满足右手坐标系,模块系为偏振传感器模块所在的坐标系,原点为模块质心,定义与载体坐标系相同。为地球系e系到理想导航系n系下的姿态转换矩阵,地球系原点与地心重合,xe轴指向本初子午线,ze轴沿极轴方向指向北极,ye轴在赤道平面内与xe、ze轴构成右手系,理想导航系即为“东北天”坐标系,其原点为载体所在点,N轴指向北极方向,E轴指向东,U轴指向天空,满足右手坐标系。为位置矩阵,可根据当地地理纬度L和经度λ计算而得,具体如下:
姿态矩阵实际上存在计算误差,这里用n′表示计算导航系,理想导航系和计算导航系之间存在的姿态误差实际上就是失准角。针对小失准角情形时,可得:
其中,φ×为失准角的反对称矩阵形式:
其中,φi(i=E,N,U)分别为东向、北向和天向失准角。
联立式(10)、(12),并且令可得:
针对式(14),令等式右侧只与失准角有关,则有:
若A,B均为3×1向量,根据反对称阵叉乘性质有:
A×B=-B×A (16)
根据上述性质,式(15)可写为:
即:
然后,考虑两组互相垂直朝向的偏振传感器,如附图2所示:P1、P2分别为两垂直布置的偏振光传感器,α0表示其安装角度,这里S为太阳矢量点;θi(i=1,2)为太阳光射入第i个传感器的散射角;φi(i=1,2)为第i个传感器测得的偏振方位角;为相对于第i个传感器的太阳方位角。
记球面角如图所示,根据球面三角形ΔP1P2S的正弦定理和余弦定理可得:
其中,根据上述两式计算可得:
下面由两组偏振传感器在各自的模块系下可计算得到偏振方位角φ1和φ2,根据太阳矢量在模块系下的不同位置可以给出偏振方位角与球面角的计算关系式,可得:
考虑到太阳高度角和散射角的关系可得在模块系下的太阳高度角为:
记偏振方位角为则可得以偏振方位角为观测量的量测方程:
zpolar=H1X+υpolar (24)
其中,zpolar为偏振光传感器输出的偏振方位角。υpolar为偏振光传感器的量测噪声。
H1为以偏振方位角的量测矩阵,维度为3×16,具体表示为:
其中,表示矢量的反对称阵形式。
第三步,根据磁强计输出的航向角与INS输出的航向角建立地磁量测方程,建立以磁强计航向角测量误差为观测量的量测方程。
首先对磁强计航向角量测误差进行分析。当系统固定在载体上后,航向角测量结果会受到周围铁磁物质的影响,干扰磁场由硬铁磁场和软铁磁场两部分组成,产生罗差。通常罗差的表现形式有由硬铁磁场产生的半圆罗差,由软铁磁场产生的圆周罗差和象限罗差,可建立罗差方程:
δφM=A+BsinφM+CosφM+Dsin2φM+Ecos2φM (26)
φ=φM-δφM (27)
其中,δφM为罗差;φ为载体的实际航向;φM为传感器指示的航向;A为圆周落差;BsinφM+CcosφM为半圆罗差;Dsin2φM+Ecos2φM为象限罗差;另外,传感器的安装误差也可归于圆周罗差中。
由罗差原理分析及磁航向罗差公式可知,进行磁航向补偿即是要针对具体的环境测出磁航向误差公式中的误差系数A,B,C,D和E。基于最小二乘法的计算步骤为:首先,采用8位置误差测量方法,即在航向角360度范围内,取角距相隔45度的8个试验点进行磁航向误差测试,以此获得8组数据;然后,根据最小二乘原理,求出罗差系数A,B,C,D和E;最后,在得到补偿系数后,进行磁航向补偿运算,这样就可以得到较精确的航向角。
在得到航向角测量误差之后,建立以磁强计航向角测量误差为观测量的方程:
zmag=H2X+υmag (28)
其中,H2=[O1×15 1]为基于磁强计航向角的量测矩阵,维度为1×16,O1×15为1行15列全零向量;zmag为磁强计误差量测量;υmag为磁强计量测噪声。
第四步,根据GNSS输出的速度、位置信息与INS输出的速度、位置信息匹配融合,建立以速度误差、位置误差为观测量的量测方程。
其中,zv,zp分别融合了INS与GNSS速度、位置信息的速度误差与位置误差的量测量;H3=[O3×3 I3×3 O3×10]为速度误差量测矩阵,维度为3×16,I3×3为3×3的单位矩阵;H4=[O3×5 I3×3 O3×8]为位置误差量测矩阵,维度为3×16;为速度误差量测噪声向量,分别为东北天三个方向的速度噪声;υp=[υλ υL υh]T为位置误差量测噪声,υλ、υL、υh分别为经度、纬度及高度位置量测噪声。
第五步,在步骤二、三和四建立的量测方程基础上,利用增广技术将上述3个步骤中的量测方程进行向量化,建立统一的INS/GNSS/偏振/地磁组合导航系统量测方程,在此基础上,对INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程离散化。建立统一的INS/GNSS/偏振/地磁组合导航系统量测方程:
Z=HX+V (30)
其中,H为INS/GNSS/偏振/地磁组合导航系统统一的量测矩阵,具体表示为:
Z为全部量测向量,具体表示为:
其中,vGNSS为GNSS测量的速度矢量,vINS为INS测量的速度矢量;pGNSS为GNSS测量的位置矢量,pINS为INS测量的位置矢量。
V为全部量测噪声,具体表示为:
因此,统一的INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程为:
Z=HX+V (35)
针对INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程离散化处理,获得统一的INS/GNSS/偏振/地磁组合导航系统量测方程为:
Xk=Φk,k-1Xk-1+Γk-1Wk-1 (36)
Zk=HkXk+Vk (37)
其中,Xk为第k时刻的状态变量;Φk,k-1=eFΔt为离散化后的状态一步转移矩阵,Δt=tk-tk-1为时间间隔;Γk-1=eGΔt为第k-1时刻离散化后的噪声分配矩阵;Wk-1为第k-1时刻状态噪声向量,均值为0,方差为Q=E[WWT];Zk为第k时刻观测量;Hk为第k时刻离散后的量测矩阵,其形式与H相同;Vk为第k时刻量测噪声向量,均值为0,方差为R=E[VVT]。
第六步,根据步骤五建立的统一的INS/GNSS/偏振/地磁组合导航系统量测方程以及状态方程,设计卡尔曼滤波器估计INS/GNSS/偏振/地磁组合导航系统未知的状态:
①时间更新:
状态一步预测方程:
其中,为k-1时刻的状态一步预测值,为k-1时刻的状态最优估计值。
一步预测均方误差阵方程:
其中,Pk/k-1为k时刻状态的误差协方差矩阵,Pk-1为k-1时刻的误差协方差矩阵,Qk-1为k-1时刻状态噪声的协方差矩阵。
②量测更新:
状态估计计算方程:
其中,为k时刻的状态最优估计值,Kk为卡尔曼增益,其计算方法为:
其中,Rk为k时刻量测噪声的协方差矩阵。
估计均方误差阵方程:
其中,I为单位矩阵。
第七步,根据步骤六中估计得到的失准角、速度误差以及位置误差对INS/GNSS/偏振/地磁组合导航系统进行反馈校正:
设卡尔曼滤波计算的系统状态变量为:
则姿态校正、速度校正以及位置校正方法如下所述:
(1)姿态校正方法
首先计算平台坐标系至真实地理坐标系的转换矩阵:
则校正后的姿态矩阵为:
(2)速度校正方法
设校正后的东向、北向和天向速度为VadE、VadN、则速度校正可表示为:
其中,分别为惯性导航系统输出的东向、北向和天向速度。
(3)位置校正方法
设校正后的纬度、经度和高度分别为Lad、λad、Lad,则位置校正可表示为:
其中,LINS、λINS、hINS分别为惯性导航系统输出的纬度、经度和高度信息。
在导航系统进行反馈校正后,进入下一次导航计算过程,偏振光传感器、磁强计所需的时间信息可由卫星实时提供,所需的位置信息由经过反馈校正后的惯性导航系统位置信息提供。
总之,本发明将偏振光传感器、磁强计与INS、GNSS相结合,融合了多种传感器,使数据源变得丰富,多种数据源的传感器并且具备融合互补的特性,可提高初始对准的精度。此外,由于借助偏振光传感器直接与失准角建立量测关系,使得失准角的相关量直接可被作为观测值,可缩短对准时间,实现快速对准。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (8)
1.一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其特征在于,包括以下步骤:
(1)选择失准角、速度误差、位置误差、陀螺仪零偏、加速度计零偏以及磁航向角误差作为INS/GNSS/偏振/地磁组合导航系统的状态变量,并建立初始对准的状态方程;
(2)根据偏振传感器输出的偏振方位角与INS输出的方位角匹配融合建立偏振量测方程,得到基于偏振方位角的量测方程;
(3)根据磁强计输出的航向角与INS输出的航向角建立地磁量测方程,得到基于磁强计航向角误差的量测方程;
(4)根据GNSS输出的速度、位置信息与INS输出的速度、位置信息匹配融合建立速度误差与位置误差量测方程,得到基于速度误差与位置误差的量测方程;
(5)在步骤(2)、(3)和(4)建立的量测方程基础上,利用增广技术将上述3个步骤中的量测方程进行向量化,建立统一的INS/GNSS/偏振/地磁组合导航系统量测方程,在此基础上,对INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程离散化;
(6)根据步骤(5)建立的离散的INS/GNSS/偏振/地磁组合导航系统状态方程和量测方程,设计卡尔曼滤波器估计INS/GNSS/偏振/地磁组合导航系统未知的状态;
(7)根据步骤(6)中估计得到的失准角、速度误差以及位置误差对INS/GNSS/偏振/地磁组合导航系统进行反馈校正,方法为基于INS获取的姿态、速度及位置上减去步骤(6)中估计得到的失准角、速度误差及位置误差,获取经反馈校正后的INS/GNSS/偏振/地磁组合导航系统姿态、速度及位置。
2.根据权利要求1所述的一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其特征在于:所述步骤(1)中,初始对准的状态方程为:
其中,F为INS/GNSS/偏振/地磁组合导航系统状态转移矩阵,表示为:
其中,A为标准15维捷联惯性导航系统的状态转移矩阵,β为反相关时间系数,0m×n为m行n列的全0向量;
X为INS/GNSS/偏振/地磁组合导航系统状态变量,表示为:
其中,φE,φN,φU分别为导航系,即n系下的东向失准角、北向失准角和天向失准角;δVE,δVN,δVU分别为导航系下的东向、北向和天向速度误差,这里导航系采用当地地理坐标系,即以载体的质心为原点,当地东向为地理系x轴,北向为y轴,天向为z轴,x轴,y轴和z轴满足右手坐标系;δλ,δL,δh分别为经度、纬度和高度误差;εx,εy,εz为载体坐标系,即b系下三个轴向的陀螺常值漂移,这里b系定义为,其原点O与载体质心重合,x轴正向与载体正向同向,y轴沿载体纵轴指左,z轴垂直xOy构成的平面指上,坐标系满足右手坐标系;分别为b系下加速度常值漂移;为磁强计的航向角测量误差;
G为INS/GNSS/偏振/地磁组合导航系统噪声分配矩阵,W为INS/GNSS/偏振/地磁组合导航系统噪声矢量:
为陀螺仪三个轴向的随机游走,为加速度计三个轴向上的随机游走,为磁强计噪声。
3.根据权利要求1所述的一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其特征在于:所述步骤(2)中,根据偏振传感器输出的偏振方位角与INS输出的方位角匹配融合建立偏振量测方程,得到基于偏振方位角的量测方程为:
zpolar=H1X+υpolar
其中,υpolar为偏振传感器的量测噪声;zpolar为偏振量测量,数值通过下式计算获得,
其中,sm为单位太阳矢量在模块系m系下的表示,模块系为偏振传感器模块所在的坐标系,定义与载体坐标系相同,原点为模块质心,这里定义模块与载体坐标系重合;为计算导航系n′系到b系下的姿态转换矩阵,计算导航系n′系为实际导航过程用于计算导航解的导航坐标系,坐标原点与导航系统相同,x轴、y轴和z轴与理想导航系n系存在偏差角,该偏差角即为失准角;为地球系e系到理想导航系n系下的姿态转换矩阵,地球系原点与地心重合,xe轴指向本初子午线,ze轴沿极轴方向指向北极,ye轴在赤道平面内与xe、ze轴构成右手系,理想导航系即为东北天坐标系,其原点为载体所在点,N轴指向北极方向,E轴指向东,U轴指向天空,满足右手坐标系;se为单位太阳矢量在e系下的表示;
H1是以偏振方位角的量测矩阵,具体表示为:
其中,表示矢量的反对称阵形式。
4.根据权利要求1所述的一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其特征在于:所述步骤(3)中,根据磁强计输出的航向角与INS输出的航向角建立地磁量测方程,得到基于磁强计航向角误差的量测方程为:
zmag=H2X+υmag
其中,H2=[01×15 1]为基于磁强计航向角的量测矩阵;zmag为磁强计误差量测量;vmag为磁强计量测噪声。
5.根据权利要求1所述的一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其特征在于:所述步骤(4)中,根据GNSS输出的速度、位置信息与INS输出的速度、位置信息匹配融合建立速度误差与位置误差量测方程,得到基于速度误差与位置误差的量测方程为:
其中,zv,zp分别融合了INS与GNSS速度、位置信息的速度误差与位置误差的量测量;H3=[03×3 I3×3 03×10]为速度误差量测矩阵,维度为3×16,I3×3为3×3的单位矩阵;H4=[03×5I3×3 03×8]为位置误差量测矩阵,维度为3×16;为速度误差量测噪声向量,分别为东北天三个方向的速度噪声;υp=[υλ υL υh]T为位置误差量测噪声,υλ、υL、υh分别为经度、纬度及高度位置量测噪声。
6.根据权利要求1所述的一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其特征在于:所述步骤(5)中,在步骤(2)、(3)和(4)建立的量测方程基础上,利用增广技术将上述3个步骤中的量测方程进行向量化,建立统一的INS/GNSS/偏振/地磁组合导航系统量测方程,在此基础上,对INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程离散化,所建立的统一的INS/GNSS/偏振/地磁组合导航系统量测方程为:
Z=HX+V
其中,H为INS/GNSS/偏振/地磁组合导航系统统一的量测矩阵,具体表示为:
Z为全部量测向量,具体表示为:
其中,vGNSS为GNSS测量的速度矢量,vINS为INS测量的速度矢量;pGNSS为GNSS测量的位置矢量,pINS为INS测量的位置矢量;
V为全部量测噪声,具体表示为:
统一的INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程为:
Z=HX+V
针对INS/GNSS/偏振/地磁组合导航系统状态方程与量测方程离散化处理,获得统一的INS/GNSS/偏振/地磁组合导航系统状态方程和量测方程为:
Xk=Φk,k-1Xk-1+Γk-1Wk-1
Zk=HkXk+Vk
其中,Xk为第k时刻的状态变量;Φk,k-1=eFΔt为离散化后的状态一步转移矩阵,Δt=tk-tk-1为时间间隔;Γk-1=eGΔt为第k-1时刻离散化后的噪声分配矩阵;Wk-1为第k-1时刻状态噪声向量,均值为0,方差为:
Q=E[WWT];Zk为第k时刻观测量;Hk为第k时刻离散后的量测矩阵,其形式与H相同;Vk为第k时刻量测噪声向量,均值为0,方差为R=E[VVT]。
7.根据权利要求1所述的一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其特征在于:所述步骤(6)中,根据已建立的统一的INS/GNSS/偏振/地磁组合导航系统量测方程以及状态方程,设计卡尔曼滤波器估计INS/GNSS/偏振/地磁组合导航系统未知的状态,所设计的卡尔曼滤波内容如下:
①时间更新:
状态一步预测方程:
其中,为k-1时刻的状态一步预测值,为k-1时刻的状态最优估计值;
一步预测均方误差阵方程:
其中,Pk/k-1为k时刻状态的误差协方差矩阵,Pk-1为k-1时刻的误差协方差矩阵,Qk-1为k-1时刻状态噪声的协方差矩阵;
②量测更新:
状态估计计算方程:
其中,为k时刻的状态最优估计,Kk为卡尔曼滤波增益矩阵,其计算方法为:
其中,Rk为k时刻量测噪声的协方差矩阵;
估计均方误差阵方程:
其中,I为单位矩阵。
8.根据权利要求1所述的一种基于卡尔曼滤波的INS/GNSS/偏振/地磁组合导航对准方法,其特征在于:所述步骤(7)中,通过卡尔曼滤波得到的INS/GNSS/偏振/地磁组合导航系统失准角、速度误差以及位置误差,采用反馈校正的方式进行动基座初始对准进行反馈校正,其方法为:
(1)姿态校正方法
首先计算n′系至n系的转换矩阵:
则校正后的姿态矩阵为:
(2)速度校正方法
设校正后的东向、北向和天向速度为VadE、VadN、则速度校正可表示为:
其中,分别为INS输出的东向、北向和天向速度;
(3)位置校正方法
设校正后的纬度、经度和高度分别为Lad、λad、had,则位置校正表示为:
其中,LINS、λINS、hINS分别为INS输出的纬度、经度和高度信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811421552.4A CN109556632B (zh) | 2018-11-26 | 2018-11-26 | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811421552.4A CN109556632B (zh) | 2018-11-26 | 2018-11-26 | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109556632A true CN109556632A (zh) | 2019-04-02 |
CN109556632B CN109556632B (zh) | 2021-01-29 |
Family
ID=65867338
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811421552.4A Active CN109556632B (zh) | 2018-11-26 | 2018-11-26 | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109556632B (zh) |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110017849A (zh) * | 2019-04-18 | 2019-07-16 | 菲曼(北京)科技有限公司 | 一种基于gnss接收机和imu传感器的测绘一体机的倾斜测量方法 |
CN110146111A (zh) * | 2019-06-03 | 2019-08-20 | 西安精准测控有限责任公司 | 一种对中杆的初始对准方法 |
CN110398257A (zh) * | 2019-07-17 | 2019-11-01 | 哈尔滨工程大学 | Gps辅助的sins系统快速动基座初始对准方法 |
CN110579740A (zh) * | 2019-09-17 | 2019-12-17 | 大连海事大学 | 一种基于自适应联邦卡尔曼滤波的无人船组合导航方法 |
CN110672130A (zh) * | 2019-11-19 | 2020-01-10 | 北方工业大学 | 一种大失准角下惯性/偏振光组合导航系统ekf对准方法 |
CN110672131A (zh) * | 2019-11-19 | 2020-01-10 | 北方工业大学 | 一种大失准角下惯性/偏振光组合导航系统ukf对准方法 |
CN110779514A (zh) * | 2019-10-28 | 2020-02-11 | 北京信息科技大学 | 面向仿生偏振导航辅助定姿的分级卡尔曼融合方法及装置 |
CN111486865A (zh) * | 2019-01-29 | 2020-08-04 | 北京理工大学 | 传递对准滤波器、传递对准方法及应用其的制导飞行器 |
CN111504306A (zh) * | 2020-06-17 | 2020-08-07 | 哈尔滨工业大学 | 一种基于惯性导航的定位方法、装置及系统 |
CN111912405A (zh) * | 2019-05-10 | 2020-11-10 | 中国人民解放军火箭军工程大学 | 一种基于车载惯组与多普勒雷达的组合导航方法及系统 |
CN112197767A (zh) * | 2020-10-10 | 2021-01-08 | 江西洪都航空工业集团有限责任公司 | 一种在线改进滤波误差的滤波器设计方法 |
CN112229392A (zh) * | 2020-09-25 | 2021-01-15 | 福建华电可门发电有限公司 | 一种高冗余的室内煤场导航方法及系统 |
CN112284388A (zh) * | 2020-09-25 | 2021-01-29 | 北京理工大学 | 一种无人机多源信息融合导航方法 |
CN112556724A (zh) * | 2020-12-09 | 2021-03-26 | 湖北航天飞行器研究所 | 动态环境下的微型飞行器低成本导航系统初始粗对准方法 |
CN112684484A (zh) * | 2020-12-04 | 2021-04-20 | 山东大学 | 基于bds/ins数据融合的室外agv精准导航方法 |
CN112683267A (zh) * | 2020-11-30 | 2021-04-20 | 电子科技大学 | 一种附有gnss速度矢量辅助的车载姿态估计方法 |
CN112781617A (zh) * | 2020-12-28 | 2021-05-11 | 广州吉欧电子科技有限公司 | 误差估计方法、组合导航处理系统及存储介质 |
CN113834484A (zh) * | 2021-11-26 | 2021-12-24 | 北京航空航天大学 | 一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 |
CN113884102A (zh) * | 2020-07-04 | 2022-01-04 | 华为技术有限公司 | 传感器安装偏差角的标定方法、组合定位系统和车辆 |
CN114018258A (zh) * | 2021-11-05 | 2022-02-08 | 北京航空航天大学杭州创新研究院 | 基于偏振量测噪声方差自适应估计的仿生组合导航方法 |
CN114018257A (zh) * | 2021-11-05 | 2022-02-08 | 北京航空航天大学杭州创新研究院 | 一种偏振/惯性安装误差无依托自标定方法 |
CN114459473A (zh) * | 2022-02-16 | 2022-05-10 | 北方工业大学 | 一种错误数据注入攻击下的惯性/卫星/偏振组合导航方法 |
CN116255988A (zh) * | 2023-05-11 | 2023-06-13 | 北京航空航天大学 | 一种基于舰船动力学组合导航复合抗干扰自适应滤波方法 |
CN116817896A (zh) * | 2023-04-03 | 2023-09-29 | 盐城数智科技有限公司 | 一种基于扩展卡尔曼滤波的姿态解算方法 |
CN117268372A (zh) * | 2023-11-21 | 2023-12-22 | 北京理工大学前沿技术研究院 | 融合磁导航信息的ins/gnss组合导航方法和系统 |
CN117433564A (zh) * | 2023-12-05 | 2024-01-23 | 北京航空航天大学 | 一种基于太阳敏感器辅助的偏振传感器误差在线标定方法 |
WO2024092876A1 (zh) * | 2022-11-04 | 2024-05-10 | 中山大学 | 基于磁罗盘与测速仪的水下动基座高精度对准方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101000245A (zh) * | 2007-01-10 | 2007-07-18 | 北京航空航天大学 | 一种sins/gps/磁罗盘组合导航系统的数据融合方法 |
CN102012237A (zh) * | 2010-12-13 | 2011-04-13 | 西安北方捷瑞光电科技有限公司 | 一种棱镜式激光陀螺动态锁区测试方法 |
EP2426563A1 (fr) * | 2010-09-07 | 2012-03-07 | Commissariat à l'Énergie Atomique et aux Énergies Alternatives | Procédé de calibration d'un appareil à fonctionnement atomique |
CN103217159A (zh) * | 2013-03-06 | 2013-07-24 | 郭雷 | 一种sins/gps/偏振光组合导航系统建模及动基座初始对准方法 |
CN103323005A (zh) * | 2013-03-06 | 2013-09-25 | 郭雷 | 一种sins/gps/偏振光组合导航系统多目标优化抗干扰滤波方法 |
CN104655152A (zh) * | 2015-02-11 | 2015-05-27 | 北京航空航天大学 | 一种基于联邦滤波的机载分布式pos实时传递对准方法 |
CN105021188A (zh) * | 2015-06-09 | 2015-11-04 | 北京航空航天大学 | 一种双模式仿生偏振/地磁辅助组合导航系统 |
-
2018
- 2018-11-26 CN CN201811421552.4A patent/CN109556632B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101000245A (zh) * | 2007-01-10 | 2007-07-18 | 北京航空航天大学 | 一种sins/gps/磁罗盘组合导航系统的数据融合方法 |
EP2426563A1 (fr) * | 2010-09-07 | 2012-03-07 | Commissariat à l'Énergie Atomique et aux Énergies Alternatives | Procédé de calibration d'un appareil à fonctionnement atomique |
CN102012237A (zh) * | 2010-12-13 | 2011-04-13 | 西安北方捷瑞光电科技有限公司 | 一种棱镜式激光陀螺动态锁区测试方法 |
CN103217159A (zh) * | 2013-03-06 | 2013-07-24 | 郭雷 | 一种sins/gps/偏振光组合导航系统建模及动基座初始对准方法 |
CN103323005A (zh) * | 2013-03-06 | 2013-09-25 | 郭雷 | 一种sins/gps/偏振光组合导航系统多目标优化抗干扰滤波方法 |
CN104655152A (zh) * | 2015-02-11 | 2015-05-27 | 北京航空航天大学 | 一种基于联邦滤波的机载分布式pos实时传递对准方法 |
CN105021188A (zh) * | 2015-06-09 | 2015-11-04 | 北京航空航天大学 | 一种双模式仿生偏振/地磁辅助组合导航系统 |
Non-Patent Citations (2)
Title |
---|
卢鸿谦: "偏振光/地磁/GPS/SINS组合导航方法", 《宇航学报》 * |
杜涛: "抗干扰滤波方法及在偏振组合导航系统的应用研究", 《中国博士学位论文全文数据库 信息科技辑》 * |
Cited By (44)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111486865A (zh) * | 2019-01-29 | 2020-08-04 | 北京理工大学 | 传递对准滤波器、传递对准方法及应用其的制导飞行器 |
CN110017849A (zh) * | 2019-04-18 | 2019-07-16 | 菲曼(北京)科技有限公司 | 一种基于gnss接收机和imu传感器的测绘一体机的倾斜测量方法 |
CN110017849B (zh) * | 2019-04-18 | 2020-12-22 | 菲曼(北京)科技有限公司 | 一种基于gnss接收机和imu传感器的测绘一体机的倾斜测量方法 |
CN111912405A (zh) * | 2019-05-10 | 2020-11-10 | 中国人民解放军火箭军工程大学 | 一种基于车载惯组与多普勒雷达的组合导航方法及系统 |
CN110146111A (zh) * | 2019-06-03 | 2019-08-20 | 西安精准测控有限责任公司 | 一种对中杆的初始对准方法 |
CN110398257A (zh) * | 2019-07-17 | 2019-11-01 | 哈尔滨工程大学 | Gps辅助的sins系统快速动基座初始对准方法 |
CN110579740A (zh) * | 2019-09-17 | 2019-12-17 | 大连海事大学 | 一种基于自适应联邦卡尔曼滤波的无人船组合导航方法 |
CN110579740B (zh) * | 2019-09-17 | 2023-03-31 | 大连海事大学 | 一种基于自适应联邦卡尔曼滤波的无人船组合导航方法 |
CN110779514B (zh) * | 2019-10-28 | 2021-04-06 | 北京信息科技大学 | 面向仿生偏振导航辅助定姿的分级卡尔曼融合方法及装置 |
CN110779514A (zh) * | 2019-10-28 | 2020-02-11 | 北京信息科技大学 | 面向仿生偏振导航辅助定姿的分级卡尔曼融合方法及装置 |
CN110672131A (zh) * | 2019-11-19 | 2020-01-10 | 北方工业大学 | 一种大失准角下惯性/偏振光组合导航系统ukf对准方法 |
CN110672130A (zh) * | 2019-11-19 | 2020-01-10 | 北方工业大学 | 一种大失准角下惯性/偏振光组合导航系统ekf对准方法 |
CN110672131B (zh) * | 2019-11-19 | 2021-08-10 | 北方工业大学 | 一种大失准角下惯性/偏振光组合导航系统ukf对准方法 |
CN110672130B (zh) * | 2019-11-19 | 2021-09-07 | 北方工业大学 | 一种大失准角下惯性/偏振光组合导航系统ekf对准方法 |
CN111504306A (zh) * | 2020-06-17 | 2020-08-07 | 哈尔滨工业大学 | 一种基于惯性导航的定位方法、装置及系统 |
CN113884102A (zh) * | 2020-07-04 | 2022-01-04 | 华为技术有限公司 | 传感器安装偏差角的标定方法、组合定位系统和车辆 |
WO2022007437A1 (zh) * | 2020-07-04 | 2022-01-13 | 华为技术有限公司 | 传感器安装偏差角的标定方法、组合定位系统和车辆 |
CN112229392A (zh) * | 2020-09-25 | 2021-01-15 | 福建华电可门发电有限公司 | 一种高冗余的室内煤场导航方法及系统 |
CN112284388A (zh) * | 2020-09-25 | 2021-01-29 | 北京理工大学 | 一种无人机多源信息融合导航方法 |
CN112284388B (zh) * | 2020-09-25 | 2024-01-30 | 北京理工大学 | 一种无人机多源信息融合导航方法 |
CN112229392B (zh) * | 2020-09-25 | 2022-11-18 | 福建华电可门发电有限公司 | 一种高冗余的室内煤场导航方法及系统 |
CN112197767A (zh) * | 2020-10-10 | 2021-01-08 | 江西洪都航空工业集团有限责任公司 | 一种在线改进滤波误差的滤波器设计方法 |
CN112683267B (zh) * | 2020-11-30 | 2022-06-03 | 电子科技大学 | 一种附有gnss速度矢量辅助的车载姿态估计方法 |
CN112683267A (zh) * | 2020-11-30 | 2021-04-20 | 电子科技大学 | 一种附有gnss速度矢量辅助的车载姿态估计方法 |
CN112684484A (zh) * | 2020-12-04 | 2021-04-20 | 山东大学 | 基于bds/ins数据融合的室外agv精准导航方法 |
CN112556724A (zh) * | 2020-12-09 | 2021-03-26 | 湖北航天飞行器研究所 | 动态环境下的微型飞行器低成本导航系统初始粗对准方法 |
CN112781617B (zh) * | 2020-12-28 | 2023-10-03 | 广州吉欧电子科技有限公司 | 误差估计方法、组合导航处理系统及存储介质 |
CN112781617A (zh) * | 2020-12-28 | 2021-05-11 | 广州吉欧电子科技有限公司 | 误差估计方法、组合导航处理系统及存储介质 |
CN114018257A (zh) * | 2021-11-05 | 2022-02-08 | 北京航空航天大学杭州创新研究院 | 一种偏振/惯性安装误差无依托自标定方法 |
CN114018258A (zh) * | 2021-11-05 | 2022-02-08 | 北京航空航天大学杭州创新研究院 | 基于偏振量测噪声方差自适应估计的仿生组合导航方法 |
CN114018257B (zh) * | 2021-11-05 | 2024-05-24 | 北京航空航天大学杭州创新研究院 | 一种偏振/惯性安装误差无依托自标定方法 |
CN113834484B (zh) * | 2021-11-26 | 2022-03-08 | 北京航空航天大学 | 一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 |
CN113834484A (zh) * | 2021-11-26 | 2021-12-24 | 北京航空航天大学 | 一种基于非瑞利散射模型误差的惯导/偏振组合导航方法 |
CN114459473A (zh) * | 2022-02-16 | 2022-05-10 | 北方工业大学 | 一种错误数据注入攻击下的惯性/卫星/偏振组合导航方法 |
CN114459473B (zh) * | 2022-02-16 | 2023-11-21 | 北方工业大学 | 一种错误数据注入攻击下的惯性/卫星/偏振组合导航方法 |
WO2024092876A1 (zh) * | 2022-11-04 | 2024-05-10 | 中山大学 | 基于磁罗盘与测速仪的水下动基座高精度对准方法及系统 |
CN116817896A (zh) * | 2023-04-03 | 2023-09-29 | 盐城数智科技有限公司 | 一种基于扩展卡尔曼滤波的姿态解算方法 |
CN116817896B (zh) * | 2023-04-03 | 2024-04-16 | 盐城数智科技有限公司 | 一种基于扩展卡尔曼滤波的姿态解算方法 |
CN116255988B (zh) * | 2023-05-11 | 2023-07-21 | 北京航空航天大学 | 一种基于舰船动力学组合导航复合抗干扰自适应滤波方法 |
CN116255988A (zh) * | 2023-05-11 | 2023-06-13 | 北京航空航天大学 | 一种基于舰船动力学组合导航复合抗干扰自适应滤波方法 |
CN117268372B (zh) * | 2023-11-21 | 2024-02-20 | 北京理工大学前沿技术研究院 | 融合磁导航信息的ins/gnss组合导航方法和系统 |
CN117268372A (zh) * | 2023-11-21 | 2023-12-22 | 北京理工大学前沿技术研究院 | 融合磁导航信息的ins/gnss组合导航方法和系统 |
CN117433564B (zh) * | 2023-12-05 | 2024-03-01 | 北京航空航天大学 | 一种基于太阳敏感器辅助的偏振传感器误差在线标定方法 |
CN117433564A (zh) * | 2023-12-05 | 2024-01-23 | 北京航空航天大学 | 一种基于太阳敏感器辅助的偏振传感器误差在线标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109556632B (zh) | 2021-01-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109556632A (zh) | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 | |
CN109556631A (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 | |
CN107314718B (zh) | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 | |
CN108871336B (zh) | 一种车辆位置估算系统及方法 | |
CN101344391B (zh) | 基于全功能太阳罗盘的月球车位姿自主确定方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航系统及其实现方法 | |
CN110487301A (zh) | 一种雷达辅助机载捷联惯性导航系统初始对准方法 | |
CN106500693B (zh) | 一种基于自适应扩展卡尔曼滤波的ahrs算法 | |
CN103196445B (zh) | 基于匹配技术的地磁辅助惯性的载体姿态测量方法 | |
CN108225308A (zh) | 一种基于四元数的扩展卡尔曼滤波算法的姿态解算方法 | |
CN103900611B (zh) | 一种惯导天文高精度复合两位置对准及误差标定方法 | |
CN110672131B (zh) | 一种大失准角下惯性/偏振光组合导航系统ukf对准方法 | |
CN107894235B (zh) | 一种超高速飞行器自主导航系统的模型误差补偿方法 | |
Chen et al. | A new geomagnetic matching navigation method based on multidimensional vector elements of earth’s magnetic field | |
CN104697520B (zh) | 一体化无陀螺捷联惯导系统与gps系统组合导航方法 | |
CN107270898B (zh) | 基于mems传感器和vlc定位融合的双粒子滤波导航装置和方法 | |
CN107728182A (zh) | 基于相机辅助的柔性多基线测量方法和装置 | |
CN104698485A (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
Zhang et al. | Bio-inspired approach for long-range underwater navigation using model predictive control | |
Sun et al. | In-motion attitude and position alignment for odometer-aided SINS based on backtracking scheme | |
CN109000639B (zh) | 乘性误差四元数地磁张量场辅助陀螺的姿态估计方法及装置 | |
CN105910623B (zh) | 利用磁强计辅助gnss/mins紧组合系统进行航向校正的方法 | |
Wang et al. | A bioinspired navigation system for multirotor UAV by integrating polarization compass/magnetometer/INS/GNSS | |
Patel et al. | Multi-IMU based alternate navigation frameworks: Performance & comparison for UAS | |
CN105988129A (zh) | 一种基于标量估计算法的ins/gnss组合导航方法 |
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 |