发明名称 一种GPS/SINS超紧组合导航系统自适应混合滤波方法
摘要 本发明涉及一种GPS/SINS超紧组合导航系统自适应混合滤波方法,其特征在于:步骤1:建立GPS/SINS超紧组合导航系统误差模型;步骤2:采用卡尔曼滤波方法进行数据融合,得到系统状态的最优估计值<img file="DDA0000508599610000011.GIF" wi="55" he="56" />和估计误差方程阵P;步骤3:利用步骤2中获得的系统状态的最优估计值<img file="DDA0000508599610000012.GIF" wi="54" he="56" />对SINS输出的导航定位信息进行输出校正;步骤4:采用误差方差阵的特征值和特征向量的可观测性分析方法,利用步骤2中获得的估计误差方程阵P求取系统各个状态的可观测度信息;步骤5:将步骤4中获得的系统状态可观测度信息作为反馈因子,将其与步骤2中获得的系统状态的最优估计值<img file="DDA0000508599610000013.GIF" wi="48" he="64" />的乘积作为反馈量,对GPS和SINS的参数进行反馈校正。
申请公布号 CN103968843A 申请公布日期 2014.08.06
申请号 CN201410216276.3 申请日期 2014.05.21
申请人 哈尔滨工程大学 发明人 周卫东;蔡佳楠;孙龙
分类号 G01C21/20(2006.01)I;G01C21/16(2006.01)I;G01S19/47(2010.01)I 主分类号 G01C21/20(2006.01)I
代理机构 代理人
主权项 一种GPS/SINS超紧组合导航系统自适应混合滤波方法,其特征在于:步骤1:建立GPS/SINS超紧组合导航系统误差模型;步骤2:采用卡尔曼滤波方法进行数据融合,得到系统状态的最优估计值<img file="FDA0000508599580000011.GIF" wi="61" he="71" />和估计误差方程阵P;步骤3:利用步骤2中获得的系统状态的最优估计值<img file="FDA0000508599580000012.GIF" wi="52" he="70" />对SINS输出的导航定位信息进行输出校正;步骤4:采用误差方差阵的特征值和特征向量的可观测性分析方法,利用步骤2中获得的估计误差方程阵P求取系统各个状态的可观测度信息;步骤5:将步骤4中获得的系统状态可观测度信息作为反馈因子,将其与步骤2中获得的系统状态的最优估计值<img file="FDA0000508599580000013.GIF" wi="56" he="71" />的乘积作为反馈量,对GPS和SINS的参数进行反馈校正。
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室