惯性测量单元安装误差系数标定.DOC

1、1惯性测量单元安装误差系数标定实验2二零一三年六月十日2.1 惯性测量单元安装误差系数标定试验一、实验目的1、掌握惯性测量单元（inertial measurement unit，IMU）的标度系数、安装误差、零偏的标定方法；2、利用现有实验条件实现实验过程的设计。二、实验内容利用单轴速率转台，进行IMU的安装误差系数标定，并通过公式计算该安装误差系数。三、实验系统组成单轴速率位置转台、MEMS惯性测量单元、稳压电源、数据采集系统。四、实验原理IMU安装误差系数的计算方法通常，惯导系统至少需要三个陀螺和三个加速度计，用以感知载体的三轴角速度和加速度变化。将这些陀螺和加计按照敏感轴两两正交的方式

2、集成在一起，安装在一个结构框架上，便构成了一个能感知完整惯性测量信息的小型系统，称之为惯性测量单元。对惯性测量单元进行标定时，除了要对其中的陀螺、加速度计进行常规标定外，还要考虑由于安装时不能严格保证敏感轴两两正交所带来的交叉耦合误差，即，要对IMU的安装误差进行标定，测量出不正交角。因此，在考虑IMU的安装误差、标度因数误差、零偏误差的情况下，建立东北天坐标系下IMU的角速度通道误差方程。3(1)xxxyxzyy yzzzxyzKE式中 为惯性系统i轴向陀螺输出角速度， 为i轴向的输入角速度； 为i轴向陀螺零偏； 为i轴向陀螺标度因数； 为角速度通道的安装误差系数，iKjE和j为坐标轴X，Y

3、，Z的统称。设输入矩阵为 ，输出矩阵为 ，则标x1xnyyIzz.x1xnoyyzz.度因数、安装误差系数与陀螺漂移组成的矩阵可按最小二乘法估计为：类似，可计算加速度计的标度因数、安装误差系数与加计零偏。设输入矩阵为 ，输出矩阵为 ，则标度x1xnyyIzz.aAx1xnoyyzz.aA因数、安装误差系数与陀螺漂移组成的矩阵可按最小二乘法估计为：五、实验内容1、陀螺安装误差测试实验1) 速率转台处于“停止”状态，接通电源，预热至IMU工作稳定；2) 分别以10/s，20/s，40/s，60/s ，80/s的速率转动转台，打开监控计算机中的数据采集软件。在每一个旋转速率下，转台正转，旋转稳定后，

4、采集转台旋转360 的过程中IMU 的输出数据 ，停转，存储数据zj+,12,345；转台反转，如上再次采集IMU输出数据 ，停转，存储数zj-,据；43) 翻转工装，依次使得陀螺敏感轴X、Y轴依次平行于转台旋转轴，在每个位置上重复上述步骤，稳定后记录转动相应敏感轴的角速度当量均值并保存数据；ij,;1,2345xyj六、实验结果陀螺数据求平均处理10/s 20/s 40/s 60/s 80/sX轴反向 -9.9123 -19.9246 -39.8253 -59.6601 -79.1389Y轴反向 -10.3317 -19.9998 -40.4727 -59.7430 -79.2054Z轴反向

5、 -9.9690 -19.8442 -39.8682 -59.4884 -79.0262X轴正向 9.9243 19.9380 39.8195 59.6146 79.3660Y轴正向 10.0445 19.9458 39.9983 59.9388 79.2885Z轴正向 10.0398 19.9238 39.9615 59.7230 79.3576按公式（2）计算陀螺标度因数、安装误差和零偏结果如下。 0.9871.502.15489.7xyxzzxyzKE xYZ 0.21537 .852.2加速度计安装误差测试一、实验步骤1) 接通电源，预热至IMU工作稳定，启动数据采集软件；2) 摇动转

6、台手柄使IMU安装台面垂直，顺时针旋转垂直方向的转台，每隔20作为一个实验测试位置，直到转过360回到原位置，再依次逆时针旋转垂直方向的转台，分别记录18组Z向加速度计输出数据 ；zj,12,.a3) 将转台台面调至水平，安装IMU使加速度计的Z向垂直于水平面内。摇动转台手柄使IMU安装台面垂直，调整转台Z向加速度计处于水平位置，此位置记为初始位置。4) 顺时针旋转垂直方向的转台，每隔20作为一个实验测试位置，直到转过360回到原位置，再依次逆时针旋转垂直方向的转台，分别记录18组X 、Y 向加速度计输出数据 。ij,;1,2.axyj二、实验结果5) 按公式（3）计算加速度计标度因数、安装误

7、差和零位误差。标度因数及安装误差阵 0.987.01.24.3.5.98xyxzzxyzKE加速度计的安装误差系数和零偏6xYZ 0.21537 .8三，实验分析1， Matlab在求逆的时候容易出现非奇异，导致不能求逆，应当适当调整输入阵的元素顺序，避免奇异。2.3旋转调制原理验证实验一、实验目的1、通过认识旋转调制技术，实现理论课学习范畴的拓展；2、验证旋转调制技术的效果，加强学生对旋转调制技术的理解。二、实验内容观摩单轴旋转调制系统工作过程，学习旋转调制原理，验证旋转调制技术对陀螺、加速度计性能的调制效果。三、实验系统组成旋转调制式捷联惯导系统、稳压电源、数据采集系统。四、实验原理旋转调

8、制是陀螺漂移的自补偿技术，设X向陀螺的漂移为 ，加计零偏为x，Y 向陀螺的漂移为 ，加计零偏为 ,平台绕Z 轴以 的角速度旋转，如图xyy1所示，则地理坐标系下的等效东向和北向陀螺漂移和加速度计零偏的表达式有：XOZY绕Z轴旋转调制7图1 旋转调制捷联惯导的组成框图cosinicsExzZtt（1）cosinicsExzZtt（2）旋转调制技术可以将惯性器件引起的误差大大降低。五、实验内容1教师讲解 旋转调制技术简介 旋转调制系统及显控系统简介2操作演示 演示旋转调制系统工作过程 控制电机分别处于旋转和锁定状态，输出并存储陀螺和加速度计数据。3理论探究对两种状态下的陀螺漂移角速率分别求姿态误差

9、角，探究旋转调制对陀螺性能改善的作用。旋转调制后 ：8未经调制的误差角：9六、实验分析由图可以看出，经过旋转调制的姿态误差角从原理上讲应该比未经过旋转调制的姿态误差角小，但是由于其他干扰，只能看出经过旋转调制后相对于未经过旋转调制的情况幅值确定而不是发散。四，实验源程序1，陀螺仪安装误差标定源程序%X轴反向x10n=load(E:惯性器件综合实验2 陀螺标定数据x10n.txt);x20n=load(E:惯性器件综合实验2 陀螺标定数据x20n.txt);x40n=load(E:惯性器件综合实验2 陀螺标定数据x40n.txt);x60n=load(E:惯性器件综合实验2 陀螺标定数据x60n

10、.txt);x80n=load(E:惯性器件综合实验2 陀螺标定数据x80n.txt);x101=x10n(2:7201,1);x201=x20n(2:3601,1);x401=x40n(2:1801,1);x601=x60n(2:1201,1);x801=x80n(28:929,1);x101=mean(x101);x201=mean(x201);x401=mean(x401);x601=mean(x601);x801=mean(x801);10x1=x101 x201 x401 x601 x801;%Y轴反向y10n=load(E:惯性器件综合实验2 陀螺标定数据y10n.txt);y20

11、n=load(E:惯性器件综合实验2 陀螺标定数据y20n.txt);y40n=load(E:惯性器件综合实验2 陀螺标定数据y40n.txt);y60n=load(E:惯性器件综合实验2 陀螺标定数据y60n.txt);y80n=load(E:惯性器件综合实验2 陀螺标定数据y80n.txt);y101=y10n(2:7201,2);y201=y20n(2:3601,2);y401=y40n(2:1801,2);y601=y60n(2:1201,2);y801=y80n(28:929,2);y101=mean(y101);y201=mean(y201);y401=mean(y401);y60

12、1=mean(y601);y801=mean(y801); y1=y101 y201 y401 y601 y801;%Z轴反向z10n=load(E:惯性器件综合实验2陀螺标定数据z10n.txt);z20n=load(E:惯性器件综合实验2陀螺标定数据z20n.txt);z40n=load(E:惯性器件综合实验2陀螺标定数据z40n.txt);z60n=load(E:惯性器件综合实验2陀螺标定数据z60n.txt);z80n=load(E:惯性器件综合实验2陀螺标定数据z80n.txt);z101=z10n(2:7201,3);z201=z20n(2:3601,3);z401=z40n(2:1801,3);z601=z60n(2:1201,3);z801=z80n(28:929,3);z101=mean(z101);z201=mean(z201);z401=mean(z401);z601=mean(z601);z801=mean(z801);z1=z101 z201 z401 z601 z801;%X轴正向x10p=load(E:惯性器件综合实验2 陀螺标定数据x10p.txt);x20p=load(E:惯性器件综合实验2 陀螺标定数据x20p.txt);