一种惯性重力匹配组合导航系统中时间延迟的补偿方法
【专利摘要】本发明公开了一种惯性重力匹配组合导航系统中时间延迟的补偿方法，包括以下几个步骤：步骤一，采集惯性导航系统输出的纬度经度λ、航向ψ和速度V及重力仪测得的重力信号；步骤二，计算重力信号的厄特弗斯校正值，并对厄特弗斯校正值进行滤波处理；步骤三，确定重力信号的延迟时间；步骤四，利用基于重力等值线的匹配算法，获取重力信号相应时刻的载体位置；步骤五，建立卡尔曼滤波器模型；步骤六，将载体位置的经度和纬度作为观测量，利用卡尔曼滤波实时估计重力信号对应时间点的惯性导航系统误差，对惯导系统进行校正；步骤七，进行卡尔曼滤波多步预测出当前时刻的状态向量，完成时间延迟补偿。本法明具有补偿重力信号时间延迟、高导航精度的优点。
【专利说明】一种惯性重力匹配组合导航系统中时间延迟的补偿方法
【技术领域】
[0001]本发明属于组合导航领域，尤其涉及具有补偿重力信号延迟功能的一种惯性重力匹配组合导航系统中时间延迟的补偿方法。
【背景技术】
[0002]上世纪80-90年代美国和前苏联便相继开始了研制战略水下潜器的无源导航辅助系统。最初的辅助方法是基于图形匹配，包括与海底地形图、磁场图的匹配，但由于需要用声纳测量海底轮廓，导致海底地形匹配的隐蔽性较弱；同时由于磁场变化复杂目前还难以真正运用到水下潜器导航中，因此重力信号和重力梯度数据成为水下潜器导航的主要无源信息资源。重力辅助导航具有精度高、隐蔽性强、自主性强等优点，是潜艇等水下航行器理想的水下辅助导航定位手段。
[0003]重力辅助导航的前提是获取高精度的重力异常值，而重力异常一般是通过海洋重力仪获取。目前高精度的海洋重力仪为了抑制垂直加速度和高频噪声的影响，采用了强阻尼加滤波的方法。这就导致当前获取的重力异常值并不是运载体所处位置的重力异常，而是一段时间前所处位置的重力异常值。如果在这样的条件下进行重力匹配，就会产生误差，甚至可能影响惯导系统的精度。
[0004]传统计算延迟时间的方法是从理论上进行分析，由于重力仪的内部传感器结构比较复杂，无法把所有导致重力异常信号延迟的因素都考虑进来，这就会造成延迟时间计算不准确。在滤波系统中，常用的处理测量数据延迟的一个直观的方法是:等延迟的测量数据到达数据处理单元后再从发生延迟的时刻到当前时刻重新进行滤波，也就是重复滤波法。这样的方法可以保证滤波性能，也比较简单，但是当测量数据延迟较大时会给系统带来极大的计算压力和数据存储的空间压力，最终会导致测量数据更多地出现延迟的情况。
【发明内容】
[0005]本发明的目的是提供一种具有高精度的惯性重力匹配组合导航系统中时间延迟的补偿方法。
[0006]一种惯性重力匹配组合导航系统中时间延迟的补偿方法，包括以下几个步骤:
[0007]步骤一，采集惯性导航系统输出的纬度,、经度λ、航向ψ和速度V及重力仪测得的重力信号；
[0008]步骤二，利用惯性导航系统输出的纬度W肮向Ψ和速度V计算重力信号的厄特
弗斯校正值，并且对厄特弗斯校正值进行滤波处理；
[0009]
【权利要求】
1.一种惯性重力匹配组合导航系统中时间延迟的补偿方法，其特征在于:包括以下几个步骤， 步骤一，采集惯性导航系统输出的纬度#、经度λ、航向Ψ和速度V及重力仪测得的重力信号； 步骤二，利用惯性导航系统输出的纬度f、航向V和速度V计算重力信号的厄特弗斯校正值，并且对厄特弗斯校正值进行滤波处理；
2.根据权利要求1所述的一种惯性重力匹配组合导航系统中时间延迟的补偿方法，其特征在于:所述的对厄特弗斯校正值进行滤波处理采用小波理论中的Mallat算法，选取db9小波基函数，分解后选取Penalize Medium阈值并以软阈值的方法对重力信号降噪，各层的阈值参数为:Levl:1051.002 ；Lev2:586.308 ；Lev3:65.569 ；Lev4:66.213 ；Lev5:53.099 ；Lev6:148.424 ；Lev7:29.860 ；Lev8:29.860 ；Lev8:29.860，最后对各层分解信号重构，得到降噪后的厄特弗斯校正值。
【文档编号】G01C21/00GK103743395SQ201410022467
【公开日】2014年4月23日 申请日期:2014年1月17日 优先权日:2014年1月17日
【发明者】周广涛, 姜鑫, 孙艳涛, 赵博, 林萌萌, 李佳璇, 夏秀玮, 郝勤顺, 于春阳, 赵维珩 申请人:哈尔滨工程大学