北航惯性导航综合实验二实验报告

1、幅科学与光社程学院SM OF IOQIENT SCIENCE I OPKhmONICS ENGIBUNG惯性测量单元安装误差系数标定实验二零一三年六月十日惯性测量单元安装误差系数标定试验一、实验目的1、掌握惯性测量单元(inertial measurementunit, IMU )的标度系数、安装 误差、零偏的标定方法；2、利用现有实验条件实现实验过程的设计。二、实验内容利用单轴速率转台，进行IMU的安装误差系数标定，并通过公式计算该安 装误差系数。三、实验系统组成单轴速率位置转台、MEMS惯性测量单元、稳压电源、数据采集系统。四、实验原理IMU安装误差系数的计算方法通常，惯导系统至少需要三个

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

3、系统i轴向陀螺输出角速度，i为i轴向的输入角速度；i为i轴向陀螺零偏；KH为i轴向陀螺标度因数；Ej为角速度通道的安装误差系 数，i和j为坐标轴X, 丫，Z的统称。x1xnx1xn设输入矩阵为1y1.yn ，输出矩阵为 oy1.yn ，则标z1zn11z1zn度因数、安装误差系数与陀螺漂移组成的矩阵可按最小二乘法估计为:类似，可计算加速度计的标度因数、安装误差系数与加计零偏。ax1axnax1axn设输入矩阵为A ay1. ayn，输出矩阵为Aoayi. ayn，则标度az1aznaz1azn1 1因数、安装误差系数与陀螺漂移组成的矩阵可按最小二乘法估计为：五、实验内容1、陀螺安装误差测试实验

4、1）速率转台处于“停止”状态，接通电源，预热至 IMU工作稳定；2）分别以10° /s ,20° /s ,40° /s ,60° Is ,80° /s的速率转动转台，打开监 控计算机中的数据采集软件。在每一个旋转速率下，转台正转，旋转稳定后，采集转台旋转360°的过程中IMU的输出数据一zj+,j 1,2,3,4,5，停转，存储数据；转台反转，如上再次采集IMU输出数据一z-,j 1,2,3, 4,5，停转，存储数据；3）翻转工装，依次使得陀螺敏感轴 X、丫轴依次平行于转台旋转轴，在每个位置上重复上述步骤，稳定后记录转动相应敏感轴的角

5、速度当量均值_ij ,i x, y; j 1,2,3, 4,5 并保存数据;六、实验结果陀螺数据求平均处理10° /s20° /s40° /s60° /s80° /sX轴反向Y轴反向Z轴反向X轴正向Y轴正向Z轴正向按公式（2）计算陀螺标度因数、安装误差和零偏结果如下KxxExyExz0.987170.015020.00015EyxKyyEyz0.0180.994820.000059EzxEzyKzz0.00570.000700.9918970.02010.05370.0810加速度计安装误差测试一、实验步骤1）接通电源，预热至IMU工作稳定，启

6、动数据采集软件；2）摇动转台手柄使IMU安装台面垂直，顺时针旋转垂直方向的转台，每隔20。作为一个实验测试位置，直到转过 360。回到原位置，再依次逆时针旋 转垂直方向的转台，分别记录18组Z向加速度计输出数据azj , j 1,2,；3）将转台台面调至水平，安装IMU使加速度计的Z向垂直于水平面内。摇动 转台手柄使IMU安装台面垂直，调整转台Z向加速度计处于水平位置，此 位置记为初始位置。4）顺时针旋转垂直方向的转台，每隔 20°作为一个实验测试位置，直到转过360。回到原位置，再依次逆时针旋转垂直方向的转台，分别记录18组X、丫向加速度计输出数据aj ,i x,y;j 1,2,。

7、、实验结果5）按公式（3）计算加速度计标度因数、安装误差和零位误差标度因数及安装误差阵KxxExyExz0.99870.00010.0020EyxKyyEyz0.00010.99880.0004EzxEzyKzz0.00330.00150.9988加速度计的安装误差系数和零偏0.02010.05370.0810三，实验分析1，Matlab在求逆的时候容易出现非奇异，导致不能求逆，应当适当调整输入阵的元素顺序，避免奇异。旋转调制原理验证实验一、实验目的1通过认识旋转调制技术，实现理论课学习范畴的拓展；2、验证旋转调制技术的效果，加强学生对旋转调制技术的理解。二、实验内容观摩单轴旋转调制系统工作过

8、程，学习旋转调制原理，验证旋转调制技术 对陀螺、加速度计性能的调制效果。三、实验系统组成旋转调制式捷联惯导系统、稳压电源、数据采集系统。四、实验原理旋转调制是陀螺漂移的自补偿技术，设 X向陀螺的漂移为x，加计零偏为 x，丫向陀螺的漂移为y，加计零偏为 y,平台绕Z轴以 的角速度旋转，如 图1所示，则地理坐标系下的等效东向和北向陀螺漂移和加速度计零偏的表达 式有：AZ图1旋转调制捷联惯导的组成框图xCOS tz Sinxsin t z cos tcos tsin tx sin tzcos t(2)旋转调制技术可以将惯性器件引起的误差大大降低。五、实验内容1教师讲解旋转调制技术简介旋转调制系统及显

9、控系统简介2 操作演示演示旋转调制系统工作过程控制电机分别处于旋转和锁定状态，输出并存储陀螺和加速度计数据。3 理论探究对两种状态下的陀螺漂移角速率分别求姿态误差角，探究旋转调制对陀螺性能 改善的作用。旋转调制后：未经调制的误差角:六、实验分析由图可以看出，经过旋转调制的姿态误差角从原理上讲应该比未经过旋转 调制的姿态误差角小，但是由于其他干扰，只能看出经过旋转调制后相对于未 经过旋转调制的情况幅值确定而不是发散。四，实验源程序1陀螺仪安装误差标定源程序%x 轴反向惯性器件综合实验陀螺标定数据');惯性器件综合实验陀螺标定数据');惯性器件综合实验陀螺标定数据');惯性

10、器件综合实验 惯性器件综合实验 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);x1=x101 x201 x401 x601 x801; %Y 轴反向惯性器件综合实验惯性器件综合实验惯性器件综合实验 惯性器件综合实验 惯性器件综合实验 y101=y10n(2:7201,

11、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); y601=mean(y601); y801=mean(y801);y1=y101 y201 y401 y601 y801; %Z 轴反向惯性器件综合实验惯性器件综合实验惯性器件综合实验惯性器件综合实验惯性器件综合实验陀螺标定数据 '); 陀螺标定数据 ');陀螺标定数据 '); 陀螺标定数据 &#

12、39;); 陀螺标定数据 '); 陀螺标定数据 '); 陀螺标定数据 ');陀螺标定数据 '); 陀螺标定数据 '); 陀螺标定数据 '); 陀螺标定数据 '); 陀螺标定数据 ');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(z8

13、01);z1=z101 z201 z401 z601 z801; %X 轴正向惯性器件综合实验陀螺标定数据 ');惯性器件综合实验陀螺标定数据 ');惯性器件综合实验陀螺标定数据 ');惯性器件综合实验陀螺标定数据 ');惯性器件综合实验陀螺标定数据 ');x101=x10p(2:7201,1);x201=x20p(2:3601,1);x401=x40p(2:1801,1);x601=x60p(2:1201,1);x801=x80p(28:929,1);x101=mean(x101);x201=mean(x201);x401=mean(x401);x60

14、1=mean(x601);x801=mean(x801);x0=x101 x201 x401 x601 x801;%Y轴正向 %惯性器件综合实验陀螺标定数据 ');惯性器件综合实验陀螺标定数据 ');惯性器件综合实验陀螺标定数据 ');惯性器件综合实验陀螺标定数据 ');惯性器件综合实验陀螺标定数据 ');y101=y10p(2:7201,2);y201=y20p(2:3601,2);y401=y40p(2:1801,2);y601=y60p(2:1201,2);y801=y80p(28:929,2);y101=mean(y101);y201=mean(

15、y201);y401=mean(y401);y601=mean(y601);y801=mean(y801);y0=y101 y201 y401 y601 y801;%Z轴正向 %惯性器件综合实验 陀螺标定数据 ');惯性器件综合实验 陀螺标定数据 ');惯性器件综合实验 陀螺标定数据 ');惯性器件综合实验 陀螺标定数据 ');惯性器件综合实验 陀螺标定数据 ');z101=z10p(2:7201,3);z201=z20p(2:3601,3);z401=z40p(2:1801,3);z601=z60p(2:1201,3);z801=z80p(28:929

16、,3);z101=mean(z101);z201=mean(z201);z401=mean(z401);z601=mean(z601);z801=mean(z801);z0=z101 z201 z401 z601 z801;k=1 1 1 1 1 x=x1,x0;y=y1,y0;z=z1,z0;W1=10 20 40 60 80 -10 -20 -40 -60 -80;80 60 40 20 10 -10 -20 -40 -60 -80;60 40 20 10 80 -10 -20 -40 -60 -80;1 1 1 1 1 1 1 1 1 1 ;W0=Sg= W0*(W1)'*inv

17、(W1*(W1)');2，计算加速度计安装误差源程序惯性器件综合实验 3accData');惯性器件综合实验 3accData');惯性器件综合实验 3accData');惯性器件综合实验 3accData');惯性器件综合实验 3accData');惯性器件综合实验 3accData');xd1=mean(xd)/1000;xu1=mean(xu)/1000;yd1=mean(yd)/1000;yu1=mean(yu)/1000;zd1=mean(zd)/1000;zu1=mean(zu)/1000;xd11=xd1(4:6)'

18、xu11=xu1(4:6)'yd11=yd1(4:6)'yu11=yu1(4:6)'zd11=zd1(4:6)'zu11=zu1(4:6)'Ao=xd11 yd11 zd11 xu11 yu11 zu11AI=1 0 0 -1 0 0;0 1 0 0 -1 0;0 0 1 0 0 -1;1 1 1 1 1 1;C=inv(AI*AI');Sacce=Ao*AI'*C;旋转调制与未经过旋转调制的源程序惯性器件综合实验 惯性导航试验数据 旋转调制实验数据 ');% 求转换矩阵 %Wx1=Q(160002:170002,1);Wy1=

19、Q(160002:170002,2);%提取转换矩阵的数据Wz1=Q(160002:170002,3);Wx1=mean(Wx1)*0./3600*1000*pi/180 ; % 转换为度每秒Wy1=mean(Wy1)*0./3600*1000*pi/180 ;Wz1=mean(Wz1)*(-0.)/3600*1000*pi/180;W=Wx1 Wy1 Wz1;Ax=Q(160002:170002,4);Ay=Q(160002:170002,5);Az=Q(160002:170002,6);% 曙>理慝>崔 % 訝。700丁 £0HO。x8cxio)ssoohl。NOUC

20、XI。 目。科CXIL0H8 二-l)soo*QMM(1)u_s*QM*gecyLZMllcxle。 二-l)soo*QMM(1)u_s*QM*secyLAMllcxlcxl。 二-i)soo*qmm(1)u_s*qm*( Locy lxmhcxisWOOHOO<曹O8l7_d*u-I一 M6 xz<A<XVH< oOOL*(z<ue luuz< ooor*(A<ue IUUA< OOOL*(XV)UE luux<_"N主 M A匸 M X 主 Mlr匸 MM1)u-S* 一Muz 匸Mm1)soo*qmha=-mO2M -zqq

21、 一 m Aqq 一 m xqq 一 MHqcHMNMHZqq 一 m _Q)SOO*AM+Q)U 一 s*.XMHAqq 一 m _Q)U 一s*AM+Q)soo*.XMHXqq 一mo8Md*u-l ilQM 9%08 Md*clucl 08 二 d*000 L*OO9$(O-)*Z/AHZ/A -0817一 d*000r009$0*A/AHA/A 藁>翌三瘁 %0817一 d*000r009$0*x/AHX/AP-S009I/00EOHCT -s009i/s0eohzm 粵懸星理慝>崔畀%ys009l/s0cxle)OUA/Aml-s009i/s0eohxm % %Witb=

22、Ctb* Witt;wtbbx= wibbx-Witb(1);wtbby= wibby-Witb(2); wtbbz=wibbz-Witb(3);nx=zeros(,1);ny=zeros(,1);nz=zeros(,1);nx(1)=wtbbx(1,1)*1/1000;ny(1)=wtbby(1,1)*1/1000;nz(1)=wtbbz(1,1)*1/1000;for i=2:()nx(i)=nx(i-1)+wtbbx(i,1)*1/1000;ny(i)=ny(i-1)+wtbby(i,1)*1/1000;nz(i)=nz(i-1)+wtbbz(i,1)*1/1000;u(i)=i;endplo