专利名称：一种自主水下航行器自主导航定位方法
技术领域：
本发明涉及的是一种自主水下航行器自主导航定位方法，特别是涉及一种基于强跟踪容积卡尔曼滤波(Strong Tracking Cubature KalmanFilter, STCKF)的自主水下航行器自主导航定位方法。
背景技术：
自主水下航行器(Autonomous Underwater Vehicle,AUV)作为一种可以在水下移动的装置，具有自带动力、活动自主的特点，可以进行海洋环境监测、海底搜索、打捞等水下作业，已被广泛应用于海洋勘察与资源开发等领域。但水下导航问题即如何确定AUV在水下环境中的位置以便其采取正确的行动成功的完成任务，依然是AUV设计所面临的主要关键技术之一。
目前国内外试图寻求一种有效的手段用于AUV自主导航定位。当AUV处于实际运行环境中时，受外部应用环境不确定性因素的影响，AUV自主导航系统的实际数学模型与理论模型不能完全匹配，即AUV自主导航系统具有模型不确定性。研究表明，当理论模型与实际系统完全匹配时，卡尔曼滤波器输出残差序列是互不相关的高斯白噪声序列。
针对上述问题，周东华等人在文献《非线性系统带次优渐消因子的扩展卡尔曼滤波》(控制与决策，1990，5 (5) :1-6)及文献《一种带多重次优渐消因子的扩展卡尔曼滤波器》(自动化学报，1991，17(6) :689-695)中基于扩展卡尔曼滤波(Extended KalmanFilter, EKF)提出了强跟踪滤波器(Strong TrackingFilter, STF)，其通过在EKF状态预测协方差阵中引入渐消因子，在线实时调整增益矩阵，强迫输出残差序列保持相互正交。这样，STF 在AUV自主导航系统模型不确定时仍然能保持对系统状态的跟踪能力，有效解决了 EKF关于模型不确定的鲁棒性差、滤波发散等问题。但STF仍然存在对非线性状态后验分布的一阶线性化近似精度偏低，及需要计算非线性函数的雅克比矩阵等自身无法克服的理论局限性。
加拿大学者Arasaratnam 在文献《Cubature KalmanFilters)) (IEEE TransactionsonAutomatic Control, 2009, 54(6) : 1254-1269)中提出了容积卡尔曼滤波(Cubature KalmanFilter, CKF)方法。CKF根据容积准则，通过一组具有相同权重的点经过非线性系统方程转换后产生新的点来给出下一时刻系统状态的预测，避免了对非线性模型的线性化处理，其精度达三阶。文献《Nonlinear estimation for spacecraft attitude using decentralizedunscented information filter)) (International Conference on Control Automation andSyatems, 2010:1562-1566)及文献《GaussHermite quadraturefiIter with applicationto spacecraft attitude estimation)) (Journal of Guidance and Dynamics, 2011，34 (2) : 367-379)均基于 CKF 进行飞行器姿态估计；文献《A CKF based GNSS/INS train integratedpositioning method》 (International Conference on Mechatronics and Automation, 2010:1686-1689)米用 CKF 与 GNSS/INS 协同进行火车定位。
发明内容
位方法。
本发明的目的在于提供一种精度更高、稳定性更强的自主水下航行器自主导航定本发明的目的是这样实现的本发明包括如下步骤(I)建立自主水下航行器运动模型
权利要求
1.一种自主水下航行器自主导航定位方法，其特征在于，包括如下步骤(1)建立自主水下航行器运动模型
全文摘要
本发明涉及的是一种自主水下航行器自主导航定位方法，特别是涉及一种基于强跟踪容积卡尔曼滤波的自主水下航行器自主导航定位方法。本发明包括如下步骤选取自主水下航行器运动模型；选取自主水下航行器测量模型；通过自主水下航行器运动模型和测量模型构建动态系统；滤波器参数初始化；选取渐消因子；更新滤波器时间；更新滤波器量测数据；由当前时刻更新到下一时刻，重复执行步骤(5)至步骤(7)，直到到达终止时刻，结束计算，输出结果。通过引入渐消因子实时调整滤波增益矩阵，强迫输出残差序列保持相互正交，以此来减小老数据的权值，相对地增加新数据的权值，提高了滤波器的估计精度和稳定性。
文档编号G01C21/20GK102980579SQ20121046035
公开日2013年3月20日 申请日期2012年11月15日 优先权日2012年11月15日
发明者王宏健, 傅桂霞, 严浙平, 边信黔, 李娟 , 刘向波 申请人:哈尔滨工程大学