资源描述:
《基于联邦滤波器的sinsgnsdvs水下组合导航研究》由会员上传分享,免费在线阅读,更多相关内容在行业资料-天天文库。
1、基于联邦滤波器的SINS/GNS/DVS水下组合导航研究刘明雍1,周志远1,赵涛2(1.西北工业大学航海学院,西安710072;)(2.中国兵器工业集团第二零二研究所,咸阳712099)摘要:针对现有的水下导航系统不能全面满足AUV导航的需要,为了提高水下航行器组合导航系统长时间远航程的隐蔽性,可靠性及精度,提出了一种基于联邦滤波器的惯性导航系统、地磁导航、多普勒速度声纳的组合导航方案,并采用简化自适应卡尔曼算法对水下航行器组合导航系统进行误差估计,解决了传统卡尔曼滤波容易发散的问题。仿真结果表明,在SINS/GNS/DVS组合导航中采用
2、该算法,提高了定位精度,保证了滤波的快速性,验证了该算法的可行性和正确性。关键词:组合导航;自适应卡尔曼滤波器;地磁导航中图分类号:U666.11文献标志码:AResearchonSINS/DNS/DVSunderwaterintegratednavigationbasedonfederalfilterLiuMing-yong1,ZhouZhi-yuan1,ZhaoTao2(1.CollegeofMarine,NorthwestPolytechnicalUniversity,ShaanxiXi’an,710072)(2.NO.202ins
3、tituteofChinaordnanceindustrygroupcorporation,ShaanxiXiang-yang,712099)Abstract:ConsideringofthefactthattheexistingunderwaternavigationsystemcannotcompletelystheneedsoftheAUVnavigation.Inordertoenhancethelongrangeanddeepwaterability,reliabilityandaccuracyoftheunderwaterve
4、hiclenavigationsystem,inthispaper,weproposeafilteralgorithmbasedontheFederationofinertialnavigationsystemconsistingofDopplerspeedsonar,magneticnavigationmethod.Meanwhile,asimplifiedmethodisadoptedforadaptiveKalmanUnderwaterVehiclenavigationsystemerrorestimatestosolvethedi
5、vergenceproblemoftraditionalKalmanfilter.Thesimulationresultsshowthattheproposedmehodcanimporvethepositioningaccuracy.Moreover,thethespeedinessofthefilterisguaranteed.Inaddition,thesimulationresultsalsodemonstratetheeffectivenessandcorrectnessofthealgorithm.Keywords:Integ
6、ratednavigation;AdaptiveKalmanfilter;GeomagneticNavigation1基金项目:教育部新世纪优秀人才支持(NCET-06-0877);国家863计划资助(2007AA0676)作者简介:刘明雍(1971—),男,湖北石首人,教授,博士生导师。主要从事控制理论与应用,水下航行器导航与制导。0引言当前水下组合导航定位普遍采用SINS/GPS/DVL方案。由于GPS信号在水下很快衰减,故航行器需定期上爬到近水面,使GPS天线露出水面,来接收GPS的定位信息,对由陀螺罗经和多普勒速度仪组成的自主导航
7、系统进行位置校准。然而随着水下航行器的应用范围、下潜深度不断扩展,特别是军事领域内对其隐蔽性的要求,常规组合方案越来越难以满足需求。作为无源导航技术的地磁导航为实现这一目标提供了新的技术途径。国内外的研究中对地磁导航的研究有很多成果。文献[1]将测量的地磁异常场强度序列与事先存储的地磁异常图实时进行相关匹配,确定飞机在地磁异常图上的经度和纬度;文献[2]中介绍了在对飞行弹体进行弹道控制中,利用地磁探测滚转姿态来实时获取弹体的对地方位,为弹体控制提供方位依据。但是,地磁导航在水下导航方面的应用,所做研究很少。考虑上述问题,本文提出了一种SI
8、NS/GNS(地磁)/DVS组合方案,该方法以地磁场模型解算地磁场强度的方式来得到精确位置信息,辅以精确计时进而获得速度信息;以地磁系统获取的速度、位置信息与惯导系统输出的速度、位置信息的差值