CN101261130B - 一种船用光纤捷联惯导系统传递对准精度评估方法 - Google Patents
一种船用光纤捷联惯导系统传递对准精度评估方法 Download PDFInfo
- Publication number
- CN101261130B CN101261130B CN2008100642915A CN200810064291A CN101261130B CN 101261130 B CN101261130 B CN 101261130B CN 2008100642915 A CN2008100642915 A CN 2008100642915A CN 200810064291 A CN200810064291 A CN 200810064291A CN 101261130 B CN101261130 B CN 101261130B
- Authority
- CN
- China
- Prior art keywords
- dtri
- epsiv
- error
- overbar
- delta
- 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
本发明提供的是一种船用光纤捷联惯导系统传递对准精度评估方法。以DGPS作为参考系统,提供载体的速度和位置信息,建立相应的误差模型,采用卡尔曼固定区域平滑的方法对传递对准结束这一时刻的对准误差进行平滑估计,确定惯导系统传递对准的精度,完成对传递对准精度的评估。本发明利用光纤捷联惯导系统的传递对准误差将在导航信息中反映出来这一原理,以DGPS作为参考系统,提供载体的速度和位置信息,建立相应的误差模型,采用卡尔曼固定区域平滑的方法对传递对准结束这一时刻的对准误差进行平滑估计,即可确定惯导系统传递对准的精度,即完成对传递对准精度的评估。
Description
(一)技术领域
本发明涉及的是一种对船用光纤捷联惯性导航系统传递对准的对准精度进行评估方法。
(二)背景技术
捷联式惯性导航系统将惯性传感器固联在载体上,直接测量载体的加速度和角速度,以计算的数学平台来代替实体平台,与平台式惯性导航系统相比,捷联式惯性导航系统省略了精密的稳定平台和控制机构,使系统的设计极大简化。捷联惯导系统完全依靠自身的惯性敏感元件,不依赖任何外界信息测量导航参数,它是一种自主式导航系统,已经得到了广泛的运用,尤其在军事领域得到了广泛运用。
通常舰船的局部基准、舰载武器等都装有捷联惯导系统,在系统进入导航工作前都必须完成传递对准,传递对准技术是一种快速的初始对准方法,目前已经得到了大量运用。捷联惯导的传递对准的对准精度是影响导航精度的最重要的因素,对传递对准对准精度的评估有助于揭示对准精度对导航精度的影响,然而捷联惯导的运用环境使得对其初始对准精度评估无法再沿袭传统使用的与已知位置进行直接对比的方法进行直接观测,因此寻求一种有效的对传递对准对准精度进行评估的方法具有重要意义。
(三)发明内容
本发明的目的在于提供一种能有效的对传递对准对准精度进行评估的船用光纤捷联惯导系统传递对准精度评估方法。
本发明的目的是这样实现的:
以DGPS作为参考系统,提供载体的速度和位置信息,建立相应的误差模型,采用卡尔曼固定区域平滑的方法对传递对准结束这一时刻的对准误差进行平滑估计,确定惯导系统传递对准的精度,完成对传递对准精度的评估,其步骤包括:
1、完成捷联惯导系统以及DGPS的预热准备,完成捷联子惯导的传递对准;
2、进行导航解算,同步采集光纤捷联惯导和DGPS输出的速度和位置信息,采集时间为2-5分钟,并保存采集得到的数据;
3、建立光纤捷联惯导精度评估的误差模型;
4、根据建立的误差模型和保存的导航数据,利用卡尔曼滤波固定区域平滑公式对传递对准的对准误差进行平滑估计,完成对光纤捷联惯导传递对准对准精度的评估。
本发明还可以包括:
1、所述的建立光纤捷联惯导精度评估的误差模型的状态方程和量测方程写成向量形式为:
其中:
其中,cij(i=1,2,3;j=1,2,3)为子惯导捷联矩阵Cb n中的元素。
2、所述的利用卡尔曼滤波固定区域平滑公式对传递对准的对准误差进行平滑估的递推公式为:
式中,为tk时刻的状态的平滑值,Pk/n为tk时刻的平滑误差的均方差阵,Pk,Pk+1/k分别是tk时刻状态的估计值、估计误差均方阵以及一步预测误差均方阵;Kk sb为平滑增益阵,它与由滤波器确定的估计误差均方阵Pk和一步预测误差方差均方阵Pk+1/k有关,而与平滑器的平滑误差均方阵Pk/n无关,Pk,Pk+1/k均由卡尔曼滤波方程决定;j=0;最小方差估计为平滑是从k=n-1开始,计算到k=0,由逐步向后反向递推,依次得到
目前对准精度的评估通常采用光学或者直接与已知位置进行比较的方法,由于舰船光纤捷联惯导系统通常要在动基座条件下完成对准,这种评估方法已经难以实行。为克服现有技术的不足,提供发明提供了一种基于DGPS(差分GPS)的对船用光纤捷联惯导系统传递对准进行精度评估的方法。利用光纤捷联惯导系统的传递对准误差将在导航信息中反映出来这一原理,以DGPS作为参考系统,提供载体的速度和位置信息,建立相应的误差模型,采用卡尔曼固定区域平滑的方法对传递对准结束这一时刻的对准误差进行平滑估计,即可确定惯导系统传递对准的精度,即完成对传递对准精度的评估。
(四)附图说明
图1为固定区域平滑东向失准角精度评估仿真曲线;
图2为固定区域平滑北向失准角精度评估仿真曲线;
图3为固定区域平滑天向失准角精度评估仿真曲线。
(五)具体实施方式
下面结合附图举例对本发明做更详细地描述:
1、船用光纤捷联惯导系统预热准备,DGPS准备。
2、光纤捷联惯导传递对准。
3、捷联惯导进入导航状态,同步采集光纤捷联惯导和DGPS输出的速度和位置信息,采集时间约为2-5分钟左右,并保存采集得到的数据;
4、建立如下的评估用误差模型:
选用船用光纤捷联惯导的速度和位置参数与参考系统DGPS的速度及位置参数作比较,并且用所得的比较结果构造量测量的办法来设计平滑滤波器,通过卡尔曼滤波中的平滑处理技术估计出捷联惯导传递对准结束时刻的对准误差。
由于参考系统的导航精度比捷联惯导的高,所形成的量测量主要是是惯导的误差信息,为此仅对惯导的误差作估计,设计卡尔曼滤波器和平滑处理器所选的状态变量为:
共12维,分别是光纤捷联惯导系统的三个对准误差φe,φn,φu;导航坐标系(东北天地理坐标系)中的东向和北向的速度误差δve,δvn;经度和纬度位置误差δλ;3个陀螺漂移εx,εy,εz;3个加速度计零偏▽x,▽y,▽z。根据捷联惯导系统误差方程编排,可以写出在导航坐标系中系统的状态方程为:
用εe,εn,εu表示光纤捷联惯导载体坐标系中的陀螺漂移转换到导航坐标系中的投影;wεx,wεy,wεz为惯导载体坐标系中的陀螺随机漂移;▽e,▽n,▽u为惯导载体坐标系中的加速度计零偏转换到导航坐标系中的投影;w▽x,w▽y,w▽z为惯导载体坐标系中的加速度计随机噪声分量;它们之间存在着如下关系:
记:
则:
Cb n为惯导载体坐标系到导航坐标系的转换矩阵。
以DGPS为参考系统,用捷联惯导速度和位置与DGPS的速度和位置差作为观测量,观测量为:
Z=[δve δvn δpe δpn]T
它们和各项误差的关系为:
其中,δveDGPS、δvnDGPS、δpeDGPS、δpnDGPS为主惯导测量误差。
将状态方程和量测方程写成向量形式为:
其中:
其中,cij(i=1,2,3;j=1,2,3)为子惯导捷联矩阵Cb n中的元素。
5、根据建立的误差模型和保存的导航数据,利用卡尔曼滤波固定区域平滑公式对传递对准的对准误差进行平滑估计,完成对船用光纤捷联惯导传递对准精度的评估。用到的固定区域平滑公式如下:
利用固定的时间区间[0,n]中所得到的所有量测信息 来估计这个区间中每个时刻的状态Xk(k=0,1,…n),这种平滑称为固定区域平滑[50],平滑的输出为该算法也称为RTS算法。在进行平滑估计之前,需要进行基本卡尔曼滤波估计,基本卡尔曼滤波的滤波方程如下:
基本卡尔曼滤波结束以后,进行反向的平滑估计,递推公式如下:
式中,为tk时刻的状态的平滑值,Pk/n为tk时刻的平滑误差的均方差阵,Pk,Pk+1/k分别是tk时刻状态的估计值、估计误差均方阵以及一步预测误差均方阵。Kk sb为平滑增益阵,它与由滤波器确定的估计误差均方阵Pk和一步预测误差方差均方阵Pk+1/k有关,而与平滑器的平滑误差均方阵Pk/n无关,Pk,Pk+1/k均由卡尔曼滤波方程决定。平滑使用了包括滤波信息在内的更大信息量,所以估计精度高很多,在对传递对准精度进行评估的问题中,对传递对准结束这一时刻的对准精度进行评估,因此在这里j=0。最小方差估计为平滑是从k=n-1开始,计算到k=0,由逐步向后反向递推,依次得到
在固定区域平滑算法中,必须存储滤波过程中的每一步的状态估计、估计误差均方差阵、一步预测均方差阵和状态转移矩阵信息,固定区间越长,使用的量测信息越多。但是平滑值以时刻tn的滤波值作为初值,逐步作后向递推,在tk+1到tk的平滑递推过程中,使用的是tk时刻的滤波信息,平滑值依赖于估计值,若滤波已经达到比较满意的精度,则平滑精度也可以达到比较满意的程度。
(五)仿真验证
为了验证该技术的有效性,进行了仿真验证。假设传递对准结束时水平姿态误差和航向姿态误差都为10′;光纤捷联惯导的陀螺常值漂移均为0.1°/h;加速度计零偏均为10-4g;同时载体在10s-20s之间水平加速度为0.1gm/s2,g为重力加速度;初始纬度初始经度λ=126.6705°;假设舰船的运动模型如下:
设舰船的纵摇角为θ,横摇角为ψ,航向角为γ,舰船作三轴摇摆运动:
其中ψm=5°,θm=5°,λm=5°,ωψ=2π/6(rad/s),ωθ=2π/8(rad/s),ωγ=2π/10(rad/s),初始相角:ψ0=0°,θ0=0°,γ0=0°。
定义平滑的相对误差为平滑估计值和真值之差与真值比值的绝对值,平滑结果如表1所示,仿真说明该评估方法是实际可行的。
表1光纤捷联惯导精度评估的相对误差
Claims (1)
1.一种船用光纤捷联惯导系统传递对准精度评估方法,其特征是:以DGPS作为参考系统,提供载体的速度和位置信息,建立相应的误差模型,采用卡尔曼固定区域平滑的方法对传递对准结束这一时刻的对准误差进行平滑估计,确定惯导系统传递对准的精度,完成对传递对准精度的评估,其步骤包括:
(1)完成捷联惯导系统以及DGPS的预热准备,完成捷联子惯导的传递对准;
(2)进行导航解算,同步采集光纤捷联惯导和DGPS输出的速度和位置信息,采集时间为2-5分钟,并保存采集得到的数据;
(3)建立光纤捷联惯导精度评估的误差模型;
选用船用光纤捷联惯导的速度和位置参数与参考系统DGPS的速度及位置参数作比较,并且用所得的比较结果构造量测量的办法设计平滑滤波器,通过卡尔曼滤波中的平滑处理技术估计出捷联惯导传递对准结束时刻的对准误差;
设计卡尔曼滤波器和平滑处理器所选的状态变量为:
共13维,分别是光纤捷联惯导系统的三个对准误差φe,φn,φu;导航坐标系中的东向和北向的速度误差δve,δvn;经度和纬度位置误差δλ;3个陀螺漂移εx,εy,εz;3个加速度计零偏根据捷联惯导系统误差方程编排,在导航坐标系中系统的状态方程为:
用εe,εn,εu表示光纤捷联惯导载体坐标系中的陀螺漂移转换到导航坐标系中的投影;wεx,wεy,wεz为惯导载体坐标系中的陀螺随机漂移; 为惯导载体坐标系中的加速度计零偏转换到导航坐标系中的投影; 为惯导载体坐标系中的加速度计随机噪声分量;它们之间存在着如下关系:
为惯导载体坐标系到导航坐标系的转换矩阵;
以DGPS为参考系统,用捷联惯导速度和位置与DGPS的速度和位置差作为观测量,观测量为:
Z=[δve δvn δpe δpn]T
它们和各项误差的关系为:
其中,δveDGPS、δvnDGPS、δpeDGPS、δpnDGPS为主惯导测量误差;
将状态方程和量测方程写成向量形式为:
其中:
(4)根据建立的误差模型和保存的导航数据,利用卡尔曼滤波固定区域平滑公式对传递对准的对准误差进行平滑估计,完成对光纤捷联惯导传递对准对准精度的评估;
所述的利用卡尔曼滤波固定区域平滑公式对传递对准的对准误差进行平滑估计的递推公式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008100642915A CN101261130B (zh) | 2008-04-15 | 2008-04-15 | 一种船用光纤捷联惯导系统传递对准精度评估方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2008100642915A CN101261130B (zh) | 2008-04-15 | 2008-04-15 | 一种船用光纤捷联惯导系统传递对准精度评估方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101261130A CN101261130A (zh) | 2008-09-10 |
CN101261130B true CN101261130B (zh) | 2010-12-29 |
Family
ID=39961733
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2008100642915A Expired - Fee Related CN101261130B (zh) | 2008-04-15 | 2008-04-15 | 一种船用光纤捷联惯导系统传递对准精度评估方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101261130B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101514899B (zh) * | 2009-04-08 | 2010-12-01 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 |
CN102506871B (zh) * | 2011-11-28 | 2014-01-22 | 北京航空航天大学 | 一种机载双光纤imu/dgps组合相对形变姿态测量装置 |
CN102564459B (zh) * | 2012-01-17 | 2015-03-11 | 北京理工大学 | 一种单轴旋转调制捷联式惯性导航系统海上校准方法 |
CN102607330B (zh) * | 2012-03-23 | 2014-04-16 | 东南大学 | 惯导系统传递对准中基准信息的优化处理方法 |
CN102628691A (zh) * | 2012-04-09 | 2012-08-08 | 北京自动化控制设备研究所 | 一种完全自主的相对惯性导航方法 |
CN102829777B (zh) * | 2012-09-10 | 2015-09-16 | 江苏科技大学 | 自主式水下机器人组合导航系统及方法 |
CN103175545A (zh) * | 2013-03-15 | 2013-06-26 | 戴洪德 | 惯导系统速度加部分角速度匹配抗干扰快速传递对准方法 |
CN103674068B (zh) * | 2013-12-19 | 2017-04-12 | 哈尔滨工程大学 | 一种基于激光跟踪仪的传递对准的验证方法 |
CN103983280B (zh) * | 2014-05-27 | 2017-02-15 | 上海新跃仪表厂 | 一种用速度差信息的天基惯性基准传递方法 |
CN104807479A (zh) * | 2015-05-20 | 2015-07-29 | 江苏华豪航海电器有限公司 | 一种基于主惯导姿态变化量辅助的惯导对准性能评估方法 |
CN106643806B (zh) * | 2016-12-30 | 2019-09-06 | 深圳友铂科技有限公司 | 一种惯导系统对准精度评估方法 |
CN111024128B (zh) * | 2019-12-30 | 2022-11-15 | 哈尔滨工程大学 | 一种机载光电吊舱光轴稳定状态传递对准方法 |
CN115856946A (zh) * | 2023-02-21 | 2023-03-28 | 和普威视光电股份有限公司 | 一种飞行器对准航道检测方法、装置、终端及存储介质 |
-
2008
- 2008-04-15 CN CN2008100642915A patent/CN101261130B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN101261130A (zh) | 2008-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101261130B (zh) | 一种船用光纤捷联惯导系统传递对准精度评估方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN103245360B (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
CN102169184B (zh) | 组合导航系统中测量双天线gps安装失准角的方法和装置 | |
CN104344837B (zh) | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN103076015B (zh) | 一种基于全面最优校正的sins/cns组合导航系统及其导航方法 | |
CN102706366B (zh) | 一种基于地球自转角速率约束的sins初始对准方法 | |
CN100541132C (zh) | 大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法 | |
CN100476360C (zh) | 一种基于星敏感器标定的深综合组合导航方法 | |
CN104344836B (zh) | 一种基于姿态观测的冗余惯导系统光纤陀螺系统级标定方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导系统大方位失准角初始对准方法 | |
CN103090866B (zh) | 一种单轴旋转光纤陀螺捷联惯导系统速度误差抑制方法 | |
CN101571394A (zh) | 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法 | |
CN111982106A (zh) | 导航方法、装置、存储介质及电子装置 | |
CN101187567A (zh) | 基于多普勒的光纤陀螺捷联惯导系统初始姿态确定方法 | |
CN103792561B (zh) | 一种基于gnss通道差分的紧组合降维滤波方法 | |
CN101915579A (zh) | 一种基于ckf的sins大失准角初始对准新方法 | |
Zhao | GPS/IMU integrated system for land vehicle navigation based on MEMS | |
CN101963513A (zh) | 消除水下运载体捷联惯导系统杆臂效应误差的对准方法 | |
CN101881619A (zh) | 基于姿态测量的船用捷联惯导与天文定位方法 | |
CN102052921B (zh) | 一种单轴旋转捷联惯导系统初始航向的确定方法 | |
CN103674064B (zh) | 捷联惯性导航系统的初始标定方法 | |
CN103245357A (zh) | 一种船用捷联惯导系统二次快速对准方法 | |
CN103017787A (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 | ||
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: 20101229 Termination date: 20180415 |