卡尔曼滤波与组合导航课程报告

《卡尔曼滤波与组合导航课程报告》由会员上传分享，免费在线阅读，更多相关内容在学术论文-天天文库。

1、《卡尔曼滤波与组合导航》课程实验报告实验捷联惯导/GPS组合导航系统静态导航实验实验序号3姓名陈星宇系院专业17班级ZY11172学号ZY1117212日期2012-5-15指导教师宫晓琳成绩一、实验目的①掌握捷联惯导/GPS组合导航系统的构成和基本工作原理；②掌握采用卡尔曼滤波方法进行捷联惯导/GPS组合的基本原理；③掌握捷联惯导/GPS组合导航系统静态性能；④了解捷联惯导/GPS组合导航静态时的系统状态可观测性；二、实验原理（1）系统方程其中，、、为数学平台失准角；、、分别为载体的东向、北向和

2、天向速度误差；、、分别为纬度误差、经度误差和高度误差；、、、、、分别为陀螺随机常值漂移和加速度计随机常值零偏。（下标E、N、U分别代表东、北、天）系统的噪声转移矩阵为：系统噪声矢量由陀螺仪和加速度计的随机误差组成，表达式为：系统的状态转移矩阵组成内容为：，其中中非零元素为可由惯导误差模型获得。。（2）量测方程量测变量，，、、、、和分别为捷联解算与GPS的东向速度、北向速度、天向速度、纬度、经度和高度之差；量测矩阵，，18，为量测噪声。量测噪声方差阵根据GPS的位置、速度噪声水平选取。（3）卡尔曼滤

3、波方程状态一步预测：状态估计：滤波增益：一步预测均方误差：估计均方误差：三、实验内容及步骤1、实验内容①捷联惯导/GPS组合导航系统静态导航实验；2、实验步骤1）实验准备（由实验教师操作）①将IMU安装在大理石实验台上，确认IMU的安装基准面靠在大理石实验平台上的方位基准尺上；②将IMU与导航计算机、导航计算机与稳压电源、导航计算机与监控计算机、GPS接收机与导航计算机、GPS天线与GPS接收机、GPS接收机与GPS电池之间的连接线正确连接；③打开GPS信号转发器；④打开监控计算机中的监控软件；⑤

4、打开稳压电源开关，确认稳压电源输出为28V；⑥打开捷联惯导/GPS组合实验系统电源，实验系统开始启动，注意30s内严禁动IMU；⑦打开GPS接收机电源，确认通过信号转发器可以接收到4颗以上卫星；⑧将监控软件设置为“准备”状态，准备时间5分钟；⑨准备过程中由实验教师介绍捷联惯导/GPS组合实验系统的组成、工作原理；182）捷联惯导/GPS组合导航系统静态导航实验①实验系统准备5分钟之后，通过监控软件，将实验系统设置为“组合导航”状态；②记录IMU的原始输出，即角增量和比力信息；③记录数据过程中，由实

5、验教师介绍采用卡尔曼滤波方法进行捷联惯导/GPS组合导航的基本原理；④记录IMU数据5分钟后，停止记录数据，利用监控计算机中的捷联惯导/GPS组合导航软件进行静态导航解算，并显示静态导航结果；四、实验结果与分析1、SINS/GPS组合导航后得纬度曲线和GPS导航纬度曲线对比如下图2、SINS/GPS组合导航后得经度曲线和GPS导航经度曲线对比如下图183、SINS/GPS组合导航后得高度曲线和GPS导航高度曲线对比如下图4、SINS/GPS组合导航后得东向速度曲线和GPS导航东向速度曲线对比如下图

6、5、SINS/GPS组合导航后得北向速度曲线和GPS导航北向速度曲线对比如下图6、SINS/GPS组合导航后得天向速度曲线和GPS导航天向速度曲线对比如下图187、SINS/GPS组合导航后航向角曲线、俯仰角曲线和横滚角曲线如下图8、纯惯性导航轨迹、GPS导航轨迹和SINS/GPS组合导航轨迹对比如下图9、平台失准角的估计均方差曲线如下图1810、速度和位置的估计均方差曲线如下图11、陀螺漂移的估计均方差曲线和加速度计偏置的估计均方差曲线如下图结果分析：从仿真结果可以看出，滤波之后载体的位置和速度

7、比GPS输出的位置和速度精度高，载体姿态在滤波校正后结果较好，INS/GPS组合导航有效地抑制了纯惯性导航的发散，也有效地去除了GPS量测输出的噪声。东北天方向的速度误差均能够估计出来，天向陀螺漂移估计不出来，在动基座情况下，东向和北向加计零偏、天向平台失准角以及东向和北向陀螺漂移均变得可观测，收敛性变好。可见，INS/GPS是一种较为理想的组合导航方式。五、源程序clear;clc;%载入数据IMU=load('C:UsersAdministratorDesktop卡尔曼IMU.dat

8、');GPS=load('C:UsersAdministratorDesktop卡尔曼GPS.dat');18%%%%%%%%%%定义常数e=1/298.3;re=6378245;wie=7.292115147e-5;IMU_T=1/100;GPS_T=1/20;g0=9.7803267714;gk1=0.00193185138639;gk2=0.00669437999013;LOOP=360000;%%%%定义存储惯导解算的位置、速度、姿态和滤波后的位置、速度、姿态ve