三轴转台标定加速度传感器

本文格式为Word版，下载可任意编辑——三轴转台标定加速度传感器基于三轴转台的ADXL335加速度传感器标定试验

一、试验目的

1、熟练使用SGT320E型三轴多功能转台，把握传感器测量和采集的方法2、把握卡尔曼滤波课程的传感器三参数标定原理二、试验器材

1、试验室具备“SGT320E型三轴多功能转台〞试验设备2、试验室具备ADXL335加速度传感器

3、安捷伦数据采集卡、笔记本电脑、MATLAB软件等。三、试验原理1、三轴转台部分

静态测试：此试验基础以“SGT320E型三轴多功能转台〞为平台，在三轴转台内框夹具上安装“ADXL335加速度传感器〞进行测试，由三轴转台内框0°作为初始位置，内框旋转180°，每隔2°采集一次数据。将90个数据依照最小二乘法滤波，在Matlab中计算出标定传感器所需要的三个误差参数：Bias（零偏）、ScaleFactorerror（刻度系数误差）、g-sensitivedrift（作用在转感器敏感轴上的加速度引起的g相关零偏）。2、加速度传感器三个误差参数标定原理部分

在理想状态下，加速度计敏感轴被放置于垂直地面方向，则读数应为g，当敏感轴与重力加速度方向存在一个夹角??时，读数应为g?cos?K。

但事实上，加速度计是存在误差。假使为了简化变量，忽略加速度计本身噪声，那加速度计的输出可以包括重力部分（g?cos?K）、零偏值（Bias）、刻度因素误差（SF?g?cos?K）、敏感轴偏移误差（K?(g?cos?K)），因此加速度传感器的输出表达式为：

2Acc_Output?g?cos?K?Bias?SF?g?cos?K?K?(g?cos?K)2

那么误差表达式为：

Error?Acc_Output?g?cos?K?Bias?SF?g?cos?K?K?(g?cos?K)2

因此，标定传感器就需要求出Bias、SF、K三个参数。

假使将Error当作测量模型yK，将g?cos?K当作xK，则测量方程表达式为：

*yK?Bias?SF?xK?K?(xK)2

由于测量方程是二阶的，用最小二乘法滤波方法中的二阶多项式代替：

2?K?a0?a1xK?a2xKy其中参数a0、a1、a2分别对应误差测量方程中的Bias、SF、K，数值由最小二乘法的二阶多项式参数矩阵确定，矩阵表示形式为：

??n?a0??n?a???xk?1???k?1??a2???n2??xk?k?1??x?xk?1nk?1k?1nnk2k3k?x2?x?k?k?1?n3?xk??k?1n?4xk???k?1?n?1?n*???yk??nk?1?*?xy?kk???k?1?n?2*??xkyk??k?1???通过计算这一矩阵，求得标定传感器所需的三个误差参数Bias、SF、K。如图1，为利用最小二乘法滤波，计算标定参数的程序流程图：

3、ADXL335加速度传感器部分

ADXL335是一款小尺寸、薄型、低功耗、完整的三轴加速度计，提供经过信号调理的电压输出，能以最小±3g的满量程范围测量加速度。它可以测量倾斜检测应用中的静态重力加速度，以及运动、冲击或振动导致的动态加速度。

ADXL335的输出为电平输出，需转化成加速度值和角度值。由芯片手册可知，ADXL335的参考电压Vs为3.3V，满量程为±3g可以得到，输出电压值V与加速度值a之间的关系式为：

a?V?3gVs所得加速度值为敏感轴方向上的加速度，在静止的条件下，该加速度方向与重力加速度夹角??如图2所示：

由图可知夹角??与a之间的关系为：

a?g?cos?K

利用上述关系式，可得到输出电压值对应的夹角??。四、试验步骤

1、试验准备：三轴转台启动过程

1）确定安装及连线，整体检查确定无误后通电；2）启动转台控制软件，选择负载范围0-10kg；3）三轴转台控制系统上电；4）三轴转台控制系统闭合；5）三轴转台内框归零；

6）选择位置方式，在此方式下，转台内框转动的角加速度为0，符合静态试验原则。设置位置参数为180°，设置速度参数为1°/s。速度设置为1°/s，是为了保证第一个采样点（即转台输出2°时采样点）加速度接近0，保证数据符合静态试验原则。

7）转台运行；

8）数据采样记录，记录下转台内框输出为0°、2°、4°??178°、180°时，加速度传感器输出电平值，利用试验原理3所述处理，得到各采样点对应??值；

9）利用试验原理2所述，在matlab下进行计算，得出三个误差系数的值。五、试验结果

1、根据试验步骤8，求得的采样点??值与三轴转台理论?之间的误差状况如图3所示：

图3测量误差状况分布图

由图中可以看到前20个（即0-40°）和后20个（即140-180°）有较大误差，是由于在这两个范围内角度余弦值变化不大，加速度传感器输出电压变化小，使得测量结果产生较大误差。

2、根据步骤9，在matlab下进行计算，得出三个误差系数的值为下表

初始值计算结果

Bias

0.000308Ft/Sec0.000931Ft/Sec

SF

K

4.082*10^(-8)0.979*10^(-8)

4.51*10^(-6)0.121*10^(-5)

表1三个误差系数表

初始值为ADXL335芯片说明书中给出的加速度传感器三个系数的参考值。对比发现有略微不同，其主要原因在于：

1）试验时，加速度传感器安装在三轴转台内框上，传感器与内框存在一个间隙，造成采样误差。

2）采集时无法确凿读取转台内框旋转特定角度所对应的电压值，而是在采样一个邻域区间内取平均值得出的采样数据。

3）试验本身为简化模型而忽略了加速度计本身存在的噪声误差，此部分误差没有被考虑在内。六、总结

经过本次试验设计与操作，熟练了对SGT320E型三轴多功能转台的使用，把握了传感器ADXL335的测量方法，同时熟悉了课程所教授的通过最小二乘法滤波的计算步骤，把握了滤波估计真值的原理，并试验验证加深理解。

基于三轴转台的ADXL335加速度计标定

农业机械的自动导航控制与变量作业实施中，实时检测与获取农业机械的神态角对农业机械确切导航及变量作业控制具有重要意义。对物体神态角的监测常用到电子罗盘、陀螺仪以及加速度计等惯性测量单元进行组合监测，采用多传感器融合技术来获取物体的偏航角、俯仰角及翻滚角信息。惯性测量单元在使用前必需对其进行标定校准试验，补偿各种误差以提高检测精度。惯性传感器的标定寻常是在三轴转台上来完成的。

根据误差产活力制不同，三轴加速度计误差主要分为零位偏差、标度系数误差、安装误差及轴间非正交误差等。对ＭＥＭＳ三轴加速度计传感器来说，零位误差和标度系数误差是影响其精度的主要因素，且随时间环境的变化而变化，安装误差及轴间非正交误差在长时间范围内不会产生较大的变化，

并可以通过提高安装工艺及制造工艺来减小此类误差的影响。轴间非正交误差造成影响和安装误差相似，可将其统一划归为安装误差。因此，根据上

述ＭＥＭＳ三轴加速度计误差形成的特点，将传感器输出误差数学模型［５－１０］表示为

?Dx??Sx????Dy???kyx?D??k?z??zx?kk???MSk??M?kS???Mxyyxzyzzzyx??Bx??????By?y???B?z??z?其中：Ｄｘ，Ｄｙ，Ｄｚ为加速度的真实值；Ｍｘ，Ｍｙ，Ｍｚ为传感器测量值；Ｂｘ，Ｂｙ，Ｂｚ为传感器的零偏，为传感器的比例因子，为传感器安装误差系数，加速度传感器的标定就是确定数学模型中的零偏、比例因子、安装误差系数，该模型中共有1２个未知参数。随着安装工艺和制作工艺的提高，安装误差所带来的影响很小，相对于比例因子和零偏所造成的误差来说是可以忽略的小量，因此现场简单标定可以只对比例因子与零偏进行标定，则传感器的误差数学模型简化为

?Dx??Sx????Dy???0?D??0?z??0S0y0??Mx??Bx??????0??My???By?

????Sz???Mz??Bz?为了检验现场标定的精度，将传感器模块安放在北京航空缜密机械研究所研制的ＳＧＴ３２０Ｅ型三轴多功能转台的内框上，ＭＣＵ采用Ａｔｍｅｇａ１６，串口波特率设置为１１０５９２，设置转台工作于“位置方式〞，转台的“位率〞采用默认值１０．０００（／ｓ，“位加速度〞采用默认值１０．０００（°）／ｓ２

在６种位置下分别采集ｘｙｚ３个敏感轴的原始数据至少２０组取平均值，且小数点后保存２位有效数字，得到６位置下的原始数据如表３所示。

为便于求解传感器数学模型中的１２个未知参数，对传感器模型２进行等价变换

?DxDyD???MzxMyMz?Sx?k1??xy?k?xz??Bx?kSkByxyyzyk??k?S??B??zxzyzz记为：Ｄ＝Ｍ2Ｋ。其中：Ｄ为已知的６个位置的重力加速度；Ｍ为加速度传感器的６个位置原始输出；Ｋ为待求标定系数矩阵，共１２个未知参数。

在位置１下有

Ｄ（１）＝［２５６００］

Ｍ（１）＝［２７７．５８３．９７８．７９１］

同理，由表１加速度计理论输出值及表３的实际测量值可以得到Ｄ（２），Ｄ（３），?，Ｄ（６）和Ｍ（２），Ｍ（３），?，Ｍ（６）。表示成矩阵形式Ｄ６3３＝［Ｄ（１），Ｄ（２），

Ｄ（３），Ｄ（４），Ｄ（５），Ｄ（６）］Ｍ６3４＝［Ｍ（１），Ｍ（２）Ｍ（３），Ｍ（４），Ｍ（５），Ｍ（６）］

则式（５）可表示为：Ｄ６3３＝Ｍ６3４2Ｋ４3３，可得到１８个方程，需求解１２个未知数，因此采用最小二乘法即可得到最优解。鉴于篇幅，此处推导从略，给出系数矩阵解的表达式如下

K4?3??MT?6?4M6?4?

?1?M6?4?D6?3

T在MATLAB中求出标定系数矩阵为

?0.97697147?0.00042886K4?3???0.00346613???14.982060870.000180550.980442820.01053770?.10853448?0.00421058???0.00588396?

1.00746543???7.50431774?则标定补偿后的加速度传感器输出值可由下面标定补偿解算矩阵得到

?Dx??0.976971470.000428860.00346613??Mx???14.98206087???????????0.000180550.980442820.01053770??4.10853448?Dy????My????D????????Mz????7.50431774??z???0.00421058?0.0058833961.00746543标定系数如下

?Sx??0.97697174?????0.98044282S?y????S??1.00746543??z????

?14.98206087?Bx???????4.10853448?By?????7.50431774?????Bz???加速度计输出位置X轴Y轴Z轴123456

敏感轴取向位置X轴1234上下左右Y轴前前上下Z轴左右前前X轴256-25600Y轴00256-256Z轴0000加速度值277.583.978.79