基于联邦滤波器的SINSGNSDVS水下组合导航研究.doc

基于联邦滤波器的SINS/GNS/DVS水下组合导航研讨
刘明雍1，周志远1，赵涛2
(1.西北工业大学航海学院，西安710072;)
（2.中国兵器工业集团第二零二研讨所，咸阳712099)
摘要：针对现有的水下导航零碎不能全面满足AUV导航的需求，为了提高水下航行器组合导航零碎长时间远航程的隐蔽性，可靠性及精度，提出了一种基于联邦滤波器的惯性导航零碎、地磁导航、多普勒速度声纳的组合导航方案，并采用简化自适应卡尔曼算法对水下航行器组合导航零碎进行误差估计，解决了传统卡尔曼滤波容易发散的问题。仿真结果表明，在SINS/GNS/DVS组合导航中采用该算法，提高了定位精度，保证了滤波的快速性，验证了该算法的可行性和正确性。
关键词：组合导航；自适应卡尔曼滤波器；地磁导航
中图分类号：U666.11文献标志码：A

ResearchonSINS/DNS/DVSunderwaterintegratednavigation
basedonfederalfilter
LiuMing-yong1，ZhouZhi-yuan1，ZhaoTao2
CollegeofMarine,NorthwestPolytechnicalUniversity,ShaanxiXi’an,710072)
(2.NO.202instituteofChinaordnanceindustrygroupcorporation,ShaanxiXiang-yang,712099)
Abstract:ConsideringofthefactthattheexistingunderwaternavigationsystemcannotcompletelystheneedsoftheAUVnavigation.Inordertoenhancethelongrangeanddeepwaterability,reliabilityandaccuracyoftheunderwatervehiclenavigationsystem,inthispaper,weproposeafilteralgorithmbasedontheFederationofinertialnavigationsystemconsistingofDopplerspeedsonar,magneticnavigationmethod.Meanwhile,asimplifiedmethodisadoptedforadaptiveKalmanUnderwaterVehiclenavigationsystemerrorestimatestosolvethedivergenceproblemoftraditionalKalmanfilter.Thesimulationresultsshowthattheproposedmehodcanimporvethepositioningaccuracy.Moreover,thethespeedinessofthefilterisguaranteed.Inaddition,thesimulationresultsalsodemonstratetheeffectivenessandcorrectnessofthealgorithm.
Keywords:Integratednavigation;AdaptiveKalmanfilter;GeomagneticNavigation

0引言
当前水下组合导航定位普遍采用SINS/GPS/DVL方案。由于GPS信号在水下很快衰减，故航行器需定期上爬到近水面,使GPS天线露出水面,来接收GPS的定位信息，对由陀螺罗经和多普勒速度仪组成的自主导航零碎进行位置校准。然而随着水下航行器的运用范围、下潜深度不断扩展，特别是军事领域内对其隐蔽性的要求，常规组合方案越来越难以满足需求。作为无源导航技术的地磁导航为实现这一目标提供了新的技术途径。国内外的研讨中对地磁导航的研讨有很多成果。文献[1]将测量的地磁异常场强度序列与事先存储的地磁异常图实时进行相关匹配，确定飞机在地磁异常图上的经度和纬度；文献[2]中介绍了在对飞行弹体进行弹道控制中,利用地磁探测滚转姿势来实时获取弹体的对地方位,为弹体控制提供方位根据。但是，地磁导航在水下导航方面的运用，所做研讨很少。
考虑上述问题，本文提出了一种SINS/GNS（地磁）/DVS组合方案，该方法以地磁场模型解算地磁场强度的方式来得到精确位置信息,辅以精确计时进而获得速度信息；以地磁零碎获取的速度、位置信息与惯导零碎输出的速度、位置信息的差值作为量测值,经过卡尔曼滤波,估计导航零碎的误差,作为一个子滤波器；并与另一子滤波器SINS/DVL进行信息融合，从而构成联邦滤波器。考虑到水下环境的复杂多变使导航零碎特别是地磁导航零