CN108731702B - 一种基于Huber方法的大失准角传递对准方法 - Google Patents
一种基于Huber方法的大失准角传递对准方法 Download PDFInfo
- Publication number
- CN108731702B CN108731702B CN201810716326.2A CN201810716326A CN108731702B CN 108731702 B CN108731702 B CN 108731702B CN 201810716326 A CN201810716326 A CN 201810716326A CN 108731702 B CN108731702 B CN 108731702B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- navigation system
- sub
- transfer alignment
- huber
- 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
Images
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
Abstract
本发明公开了一种基于Huber方法的大失准角传递对准方法。首先,考虑到系统的非线性,建立传递对准非线性状态方程和量测方程;其次,主、子惯导分别进行惯导解算,主惯导的速度、姿态和角速度信息传输到子惯导的导航计算机,利用主、子惯导系统之间的速度误差、姿态误差和角速度误差构造量测量;然后,进行容积卡尔曼滤波时间更新;之后利用利用Huber方法构造权值矩阵对观测残差进行加权修正;最后,进行容积卡尔曼滤波量测更新估计子惯导系统与主惯导系统间的安装误差角,完成传递对准。本发明解决了观测量中存在混合高斯噪声和野值情况下的舰船快速高精度对准问题。
Description
技术领域
本发明涉及捷联惯导初始对准技术领域,特别是涉及一种基于Huber方法的大失准角传递对准方法。
背景技术
惯性导航由于具有抗电磁干扰、隐蔽性好、信息全面、短期精度和稳定性高等诸多优点,成为舰船导航的一种重要方式。惯性导航系统利用陀螺仪测量运载体的角速度信息,利用加速度计测量运载体的比力信息,经过惯导解算得到运载体的速度、姿态以及位置等信息。惯性导航作为一种推算定位方式,在导航之前需要获得准确的初始信息,因此初始对准的速度与精度对惯导系统的性能有着重要影响。初始对准一般分为自对准和传递对准,罗经自对准要求静基座条件下进行,并且对准时间较长,而传递对准可以实现短时间高精度对准,能够满足武器系统等快速反应的需要。
在舰船传递对准的实际应用中,子惯导系统与主惯导系统在方位上往往存在一个大安装误差角,所以建立传递对准非线性数学模型更符合实际情况。并且舰船在海面航行时,受到外界复杂环境的影响,观测量中往往会存在非高斯强噪声甚至野值,此时基于l2范数最小的容积卡尔曼滤波可能会失效。为提高滤波算法的鲁棒性,国内许多学者进行了相应的研究。
陈雨等人在《一种混合H2/H∞滤波的传递对准算法》(发表于期刊《系统工程与电子技术》,2013年,第35卷,11期)一文中,将姿态噪声建模为能量有限噪声,将滤波问题转化为最小最大问题,设计了一种能处理观测噪声中既有高斯白噪声又有能量有限噪声的混合H2/H∞滤波算法,该算法比H∞滤波有更高的精度,比Kalman滤波有更强的稳定性。高敬东等人在《基于Huber的改进鲁棒滤波算法》(发表于期刊《系统仿真学报》,2014年,第26卷,08期)一文中,提出了一种利用新息卡方检测法预判断的鲁棒滤波算法,并通过一个简单线性模型的仿真验证了该算法可以抑制观测连续非高斯强噪声的影响,提高滤波精度及稳定性,具有良好的鲁棒性。张文杰等人在《基于Huber的高阶容积卡尔曼跟踪算法》(物理学报,2016年,第65卷,08期)一文中,提出了一种新的基于Huber的高阶容积卡尔曼滤波算法,在采用统计线性回归模型近似非线性量测模型的基础上,利用Huber M估计算法实现状态的量测更新,通过仿真验证了该算法能够目标跟踪的精度,并且具有一定的鲁棒性。综合近年的文献,国内学者在提高滤波算法的鲁棒性方面进行了一些研究,但基本是基于简单的线性或者非线性模型来验证算法的有效性。针对传递对准这一实际问题,本发明设计了一种基于Huber方法的大失准角传递对准方法,可用于实际观测噪声为非高斯噪声的情况,并且该方法利用容积卡尔曼滤波的优势,无需对非线性量测模型进行统计线性回归近似,传递对准的速度和精度比现有方法均有明显的提高。
发明内容
本发明的目的在于提供一种可应用于舰船存在大方位失准角并且观测量中存在非高斯强噪声甚至野值情况下的快速高精度传递对准方法。
实现本发明目的的技术方案为:一种基于Huber方法的大失准角传递对准方法,包括以下步骤:
步骤一:安装两套惯导系统,其中高精度的惯导系统作为主惯导,精度较低的惯导系统作为子惯导,完成主、子惯导系统的启动、预热准备;
步骤二:主、子惯导系统分别进行惯导解算,主惯导输出的速度、角速度和姿态信息传输给子惯导系统;
步骤三:考虑系统的非线性,建立舰船存在大失准角情况下的传递对准非线性状态方程和量测方程;
步骤四:利用本发明提出的基于Huber方法的大失准角传递对准方法对主、子惯导间的安装误差角进行估计,完成传递对准。
在步骤四中,将基于Huber方法的大失准角传递对准方法用于估计主、子惯导间的安装误差角,具体方式为:
(3)然后对残差进行随机解耦,并利用Huber方法构造权矩阵对解耦后的残差进行加权平均;
与现有技术相比,本发明的有益效果是:
本发明在舰船存在大失准角的情况下,充分考虑到系统的非线性,建立非线性模型,并且针对观测量中存在非高斯强噪声和野值的情况,设计了一种基于Huber方法的传递准方法,在标准CKF的基础上,利用Huber方法构造权值函数对观测残差进行修正,以降低非高斯强噪声和野值的影响,有效地提高了滤波效果,从而提高了传递对准的精度。
附图说明
图1为本发明的具体流程图;
图2为Matlab仿真得到的安装误差角估计误差曲线;
图3为Matlab仿真得到的航向安装误差角估计误差曲线;
图4为50次蒙特卡罗仿真结果。
具体实施方式
下面结合附图1本发明的具体流程图对本发明进一步说明。
为了验证本发明的有效性,利用Matlab对舰船大方位失准角传递对准模型进行仿真。
首先,建立速度加姿态匹配传递对准数学模型,具体如下:
忽略垂向通道,选取的状态变量为:
系统状态方程为:
其中,n为导航坐标系;m系为主惯导载体坐标系;s系为子惯导载体坐标系;为子惯导计算载体坐标系;δVn为速度误差在导航坐标系的投影;为主惯导载体坐标系到子惯导载体坐标系的方向余弦矩阵;为主惯导载体坐标系到子惯导计算载体坐标系的方向余弦矩阵;为主惯导载体坐标系到导航坐标系的方向余弦矩阵;为子惯导测量的比力在其载体坐标系的投影;为地球自转角速度在导航坐标系的投影;为n系相对于地球坐标系的角速度在n系的投影;为s系和m系之间的安装误差角;为系和m系之间的量测失准角;为主惯导相对于导航坐标系的角速度在m系的投影;▽s为加速度计常值漂移;wv为加速度计随机漂移;εs为陀螺常值漂移;为陀螺随机漂移。
量测方程为:
Z=h(X)+V
其中,V为系统的观测噪声。
然后,设计基于Huber方法的容积卡尔曼滤波算法,具体如下:
对于如下一个离散非线性系统:
其中,xk为系统状态矢量;zk为观测矢量;wk为系统噪声矢量,vk为量测噪声矢量,均为零均值的高斯白噪声,且互不相关,即满足:
其中,Qk为系统噪声序列的方差阵;Rk为量测噪声序列的方差阵;δkj为克罗内克函数。
基于Huber方法的容积卡尔曼滤波的具体实现步骤如下:
a.时间更新
假设k-1时刻的状态xk-1的统计特性已知,先对Pk-1做Cholesky分解:
计算容积点:
计算经系统状态方程传递后的容积点:
估计k时刻的状态预测值:
估计k时刻的状态预测协方差阵:
b.量测更新
对Pk/k-1做Cholesky分解:
计算容积点:
计算经系统量测方程传递后的容积点:
Zi,k/k-1=h(Xi,k/k-1)i=1,2…,2n
估计k时刻的量测预测值:
估计k时刻的量测预测协方差阵:
估计k时刻的一步预测互相关协方差阵:
对观测残差进行随机解耦:
利用Huber方法构造权值矩阵,重构观测残差:
计算k时刻的状态估计值:
计算k时刻的状态误差协方差阵:
最后,仿真验证本发明的有效性,舰船在海中航行时会受到风浪影响,产生三轴摇摆运动,其数学模型为:
仿真参数设置如下:
摇摆角幅值:ψm=5°,θm=15°,γm=10°;
摇摆周期:Ty=8s,Tp=12s,Tr=6s;
初始航向:K=30°;
陀螺常值漂移为εx=εy=εz=0.01°/h,随机漂移为0.001°/h;
加速度计随机常值偏置为10-4g,加速度计随机漂移为10-5g;
舰船以10n mile/h的速度匀速直航;
滤波周期:0.05s;
观测量中随机加入野值。
滤波器初始条件,包括状态估计协方差阵P0、系统噪声方差阵Q0及量测噪声方差阵R0,设定如下:
P0=diag{(0.1m/s)2,(0.1m/s)2,(1°)2,(1°)2,(10°)2,(1°)2,(1°)2,(10°)2,(1×10-4g0)2,(1×10-4g0)2,(0.01°/h)2,(0.01°/h)2,(0.01°/h)2}
Q0=diag{(1×10-5g0)2,(1×10-5g0)2,(0.001°/h)2,(0.001°/h)2,(0.001°/h)2}
R0=diag{(0.02m/s)2,(0.02m/s)2,(0.0004°)2,(0.0004°)2,(0.0004°)2}
仿真结果:
以上述仿真条件,利用CKF和本发明方法两种滤波算法估计安装误差角,仿真得到的结果如图2、图3和图4所示。
由图2和图3可以看出,在观测量中存在混合高斯噪声和野值的情况下,CKF滤波估计收敛速度变慢,滤波精度降低,而采用本发明方法,可以降低混合高斯噪声和野值的影响,误差估计曲线可以快速收敛,并且估计精度明显提高。由图4蒙特卡罗仿真结果可以看出,采用传统CKF滤波估计安装误差角,估计误差在5角分左右,而采用本发明方法,估计误差可达到2角分以下。综上所述,本发明提供的方法,可以在观测量中存在混合高斯噪声和野值的情况下,实现快速高精度对准。
Claims (1)
1.一种基于Huber方法的大失准角传递对准方法,其特征在于,包括以下步骤:
步骤一:安装两套惯导系统,其中高精度的惯导系统作为主惯导,精度较低的惯导系统作为子惯导,完成主、子惯导系统的启动、预热准备;
步骤二:主、子惯导系统分别进行惯导解算,主惯导输出的速度、角速度和姿态信息传输给子惯导系统;
步骤三:考虑系统的非线性,建立舰船存在大失准角情况下的传递对准非线性状态方程和量测方程;
步骤四:利用提出的基于Huber方法的大失准角传递对准方法对主、子惯导间的安装误差角进行估计,完成传递对准;
所述用于估计主、子惯导间的安装误差角的具体方法为:
(3)然后对残差进行随机解耦,并利用Huber方法构造权矩阵对解耦后的残差进行加权平均;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810716326.2A CN108731702B (zh) | 2018-07-03 | 2018-07-03 | 一种基于Huber方法的大失准角传递对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810716326.2A CN108731702B (zh) | 2018-07-03 | 2018-07-03 | 一种基于Huber方法的大失准角传递对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108731702A CN108731702A (zh) | 2018-11-02 |
CN108731702B true CN108731702B (zh) | 2021-12-24 |
Family
ID=63925863
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810716326.2A Active CN108731702B (zh) | 2018-07-03 | 2018-07-03 | 一种基于Huber方法的大失准角传递对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108731702B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110440830B (zh) * | 2019-08-20 | 2023-03-28 | 湖南航天机电设备与特种材料研究所 | 动基座下车载捷联惯导系统自对准方法 |
CN111141313B (zh) * | 2020-01-06 | 2023-04-07 | 西安理工大学 | 一种提高机载局部相对姿态匹配传递对准精度的方法 |
CN113340297B (zh) * | 2021-04-22 | 2022-08-09 | 中国人民解放军海军工程大学 | 基于坐标系传递的姿态估计方法、系统、终端、介质及应用 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103913181A (zh) * | 2014-04-24 | 2014-07-09 | 北京航空航天大学 | 一种基于参数辨识的机载分布式pos传递对准方法 |
CN105973268A (zh) * | 2016-05-06 | 2016-09-28 | 哈尔滨工程大学 | 一种基于共基座安装的传递对准精度定量评估方法 |
CN106200377A (zh) * | 2016-06-29 | 2016-12-07 | 中国人民解放军国防科学技术大学 | 一种飞行器控制参数的估计方法 |
CN106352876A (zh) * | 2016-07-25 | 2017-01-25 | 北京航空航天大学 | 一种基于h∞和ckf混合滤波的机载分布式pos传递对准方法 |
CN106885569A (zh) * | 2017-02-24 | 2017-06-23 | 南京理工大学 | 一种强机动条件下的弹载深组合arckf滤波方法 |
CN106885570A (zh) * | 2017-02-24 | 2017-06-23 | 南京理工大学 | 一种基于鲁棒sckf滤波的紧组合导航方法 |
-
2018
- 2018-07-03 CN CN201810716326.2A patent/CN108731702B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103913181A (zh) * | 2014-04-24 | 2014-07-09 | 北京航空航天大学 | 一种基于参数辨识的机载分布式pos传递对准方法 |
CN105973268A (zh) * | 2016-05-06 | 2016-09-28 | 哈尔滨工程大学 | 一种基于共基座安装的传递对准精度定量评估方法 |
CN106200377A (zh) * | 2016-06-29 | 2016-12-07 | 中国人民解放军国防科学技术大学 | 一种飞行器控制参数的估计方法 |
CN106352876A (zh) * | 2016-07-25 | 2017-01-25 | 北京航空航天大学 | 一种基于h∞和ckf混合滤波的机载分布式pos传递对准方法 |
CN106885569A (zh) * | 2017-02-24 | 2017-06-23 | 南京理工大学 | 一种强机动条件下的弹载深组合arckf滤波方法 |
CN106885570A (zh) * | 2017-02-24 | 2017-06-23 | 南京理工大学 | 一种基于鲁棒sckf滤波的紧组合导航方法 |
Non-Patent Citations (1)
Title |
---|
基于抗差自适应容积卡尔曼滤波的超紧耦合跟踪方法;赵欣;《自动化学报》;20141130;第40卷(第11期);2530-2540 * |
Also Published As
Publication number | Publication date |
---|---|
CN108731702A (zh) | 2018-11-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107990910B (zh) | 一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法 | |
CN109324330B (zh) | 基于混合无导数扩展卡尔曼滤波的usbl/sins紧组合导航定位方法 | |
CN108759870B (zh) | 一种基于新型鲁棒广义高阶容积卡尔曼滤波的传递对准方法 | |
Chen et al. | An effective pedestrian dead reckoning algorithm using a unified heading error model | |
CN109000642A (zh) | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 | |
CN108731702B (zh) | 一种基于Huber方法的大失准角传递对准方法 | |
Zhang et al. | Mathematical model and matlab simulation of strapdown inertial navigation system | |
CN108981696B (zh) | 一种sins任意失准角无奇异快速传递对准方法 | |
Li et al. | Optimization-based INS in-motion alignment approach for underwater vehicles | |
CN109931955B (zh) | 基于状态相关李群滤波的捷联惯性导航系统初始对准方法 | |
CN104655131A (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN109945895B (zh) | 基于渐消平滑变结构滤波的惯性导航初始对准方法 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN103389506A (zh) | 一种用于捷联惯性/北斗卫星组合导航系统的自适应滤波方法 | |
CN108761512A (zh) | 一种弹载bds/sins深组合自适应ckf滤波方法 | |
Fan et al. | Integrated navigation fusion strategy of INS/UWB for indoor carrier attitude angle and position synchronous tracking | |
Li et al. | A calibration method of DVL in integrated navigation system based on particle swarm optimization | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN105806363A (zh) | 基于srqkf的sins/dvl水下大失准角对准方法 | |
CN104236586A (zh) | 基于量测失准角的动基座传递对准方法 | |
CN103076026A (zh) | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 | |
CN103776449A (zh) | 一种提高鲁棒性的动基座初始对准方法 | |
CN103791918A (zh) | 一种舰船捷联惯导系统极区动基座对准方法 | |
CN104748761A (zh) | 基于最优姿态匹配的动基座传递对准时延补偿方法 | |
CN103697878A (zh) | 一种单陀螺单加速度计旋转调制寻北方法 |
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 |