惯性测量单元安装误差系数标定
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
惯性测量单元安装误差系数标定实验
二零一三年六月十日
2.1 惯性测量单元安装误差系数标定试验
一、实验目的
1、掌握惯性测量单元(inertial measurement unit ,IMU )的标度系数、安装
误差、零偏的标定方法;
2、利用现有实验条件实现实验过程的设计。
二、实验内容
利用单轴速率转台,进行IMU 的安装误差系数标定,并通过公式计算该安装误差系数。 三、实验系统组成
单轴速率位置转台、MEMS 惯性测量单元、稳压电源、数据采集系统。 四、实验原理
IMU 安装误差系数的计算方法
通常,惯导系统至少需要三个陀螺和三个加速度计,用以感知载体的三轴角速度和加速度变化。将这些陀螺和加计按照敏感轴两两正交的方式集成在一起,安装在一个结构框架上,便构成了一个能感知完整惯性测量信息的小型系统,称之为惯性测量单元。对惯性测量单元进行标定时,除了要对其中的陀螺、加速度计进行常规标定外,还要考虑由于安装时不能严格保证敏感轴两两正交所带来的交叉耦合误差,即,要对IMU 的安装误差进行标定,测量出不正交角。因此,在考虑IMU 的安装误差、标度因数误差、零偏误差的情况下,建立东北天坐标系下IMU 的角速度通道误差方程。
x x xx xy xz x y y yx yy yz y z z zx
zy
zz z K E E E K E E E K ωεωωεωωεω⎡⎤⎡⎤⎡⎤⎡⎤
⎢⎥⎢⎥⎢⎥⎢⎥=+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢
⎥⎣⎦⎣⎦⎣⎦⎣⎦ (1)
式中i ω为惯性系统i 轴向陀螺输出角速度,i ω为i 轴向的输入角速度;i ε为i 轴向陀螺零偏;ii K 为i 轴向陀螺标度因数;ij E 为角速度通道的安装误差系
数,i和j为坐标轴X,Y,Z的统称。
设输入矩阵为
x1xn
y1yn
I
z1zn
...
11
ωω
ωω
ωω
⎡⎤
⎢⎥
⎢⎥
Ω=
⎢⎥
⎢⎥
⎣⎦
,输出矩阵为
x1xn
o y1yn
z1zn
...
ωω
ωω
ωω
⎡⎤
⎢⎥
Ω=⎢⎥
⎢⎥
⎣⎦
,则标
度因数、安装误差系数与陀螺漂移组成的矩阵可按最小二乘法估计为:类似,可计算加速度计的标度因数、安装误差系数与加计零偏。
设输入矩阵为
x1xn
y1yn
I
z1zn
...
11
a a
a a
A
a a
⎡⎤
⎢⎥
⎢⎥
=
⎢⎥
⎢⎥
⎣⎦
,输出矩阵为
x1xn
o y1yn
z1zn
...
a a
A a a
a a
⎡⎤
⎢⎥
=⎢⎥
⎢⎥
⎣⎦
,则标度
因数、安装误差系数与陀螺漂移组成的矩阵可按最小二乘法估计为:
五、实验内容
1、陀螺安装误差测试实验
1)速率转台处于“停止”状态,接通电源,预热至IMU工作稳定;
2)分别以10°/s,20°/s,40°/s,60°/s,80°/s的速率转动转台,打开监控计算机
中的数据采集软件。在每一个旋转速率下,转台正转,旋转稳定后,采集
转台旋转360°的过程中IMU的输出数据
zj+,1,2,3,4,5 j
ω=,停转,存储数
据;转台反转,如上再次采集IMU输出数据
zj-,1,2,3,4,5 j
ω=,停转,存储数据;
3)翻转工装,依次使得陀螺敏感轴X、Y轴依次平行于转台旋转轴,在每个
位置上重复上述步骤,稳定后记录转动相应敏感轴的角速度当量均值
ij ,,;1,2,3,4,5 i x y j
ω
±
==并保存数据;
六、实验结果
陀螺数据求平均处理
按公式(2)计算陀螺标度因数、安装误差和零偏结果如下。
0.987170.015020.000150.0180.994820.0000590.00570.000700.991897xx xy xz yx yy yz zx zy
zz K E E E K E E E K ⎡⎤⎡⎤⎢⎥
⎢⎥=-⎢⎥⎢⎥⎢⎥⎢
⎥--⎣⎦⎣
⎦
x Y Z
0.0201 0.0537 0.0810εεε⎡⎤⎡⎤⎢⎥⎢⎥=-⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦
2.2加速度计安装误差测试
一、实验步骤
1) 接通电源,预热至IMU 工作稳定,启动数据采集软件;
2) 摇动转台手柄使IMU 安装台面垂直,顺时针旋转垂直方向的转台,每隔
20°作为一个实验测试位置,直到转过360°回到原位置,再依次逆时针旋转垂直方向的转台,分别记录18组Z 向加速度计输出数据zj ,1,2,...a j ±=; 3) 将转台台面调至水平,安装IMU 使加速度计的Z 向垂直于水平面内。摇动
转台手柄使IMU 安装台面垂直,调整转台Z 向加速度计处于水平位置,此位置记为初始位置。
4) 顺时针旋转垂直方向的转台,每隔20°作为一个实验测试位置,直到转过
360°回到原位置,再依次逆时针旋转垂直方向的转台,分别记录18组X 、Y 向加速度计输出数据ij ,,;1,2,...a i x y j ±==。
二、实验结果
5) 按公式(3)计算加速度计标度因数、安装误差和零位误差。
标度因数及安装误差阵
0.99870.00010.00200.00010.99880.00040.00330.00150.9988xx xy xz yx yy yz zx zy
zz K E E E K E E E K ⎡⎤⎡⎤⎢⎥
⎢⎥=-⎢⎥⎢⎥⎢⎥⎢
⎥--⎣⎦⎣
⎦
加速度计的安装误差系数和零偏
x Y Z
0.0201 0.0537 0.0810εεε⎡⎤⎡⎤⎢⎥⎢⎥=-⎢⎥⎢⎥
⎢⎥⎢⎥⎣⎦⎣⎦
三,实验分析
1, Matlab 在求逆的时候容易出现非奇异,导致不能求逆,应当适当调整输入阵的元素顺