ADIS16209 IMU在倾角测量中的应用

摘 要:介绍了Analog Device公司MEMS惯性传感器ADIS16209的特性,阐述了使用其测量倾角的原理与方法,并设计了基于Luminary公司的LM3S8962 ARM7微处理器组成一个倾角测量系统。最后将其得到的结果与Crossbow Technology公司的AHRS得到的结果进行比较分析,得到倾角测量系统在静态情况下可以准确地测量倾角的结论。

关键词:ADIS16209; 倾角测量; LM3S8962; 静态

中图分类号:TP212 文献标识码:A

文章编号:1004-373X(2010)13-0110-04

Application of ADIS16209 IMU in Inclination Measurement

WU Xiao-peng, ZHAO Zuo-xi, HU Lian, ZHANG Lin

(MOE Key Laboratory of Key Technology on Agricultural Machine and Equipment, South China Agricultural University, Guangzhou 510640, China)

Abstract: The characteristics of MEMS inertial sensor ADIS16209 (produced by Analog Device) is introduced. The principle and method to measure the inclination with ADIS16209 are elaborated. An inclination measuring system was designed by using LM3S8962 ARM7 microprocessor and ADIS16209. The measuring system can accurately measure inclination through comparing the results gained by this system with AHRS of Crossbow Technology Company.

Keywords: ADIS16209; inclination measurement; LM3S8962; static state

0 引 言

倾角传感器是测量关于水平倾斜角的装置[1],倾角变化测量仪器是许多工业应用设备需要具备的一个组成部分,包括测量设备、卫星天线稳定系统、工厂机床、运动安全监视器和汽车轮位对准装置等。准确地测量倾角的变化,有利于这些设备更加稳定的工作及避免事故发生。现在采用的倾角测量仪大多数体积较大,信号采集比较慢,测量精度不高,误差较大,需要做大量的温度补偿和校准工作。这些缺点制约着工业设备性能的提高,也加大了工程的工作量。

ADIS16209是ADI公司新推出的一款精密的微电子机械系统(MEMS)[2]倾斜计,提供小于0.1°线性倾斜误差的全补偿直接角度输出,它使用出厂时安装的校正系数动态地检测系统环境并且补偿直接数字角度输出以便解决电压、温度、角度和其他参数变化引起的误差,减少了产品设计时间、减低成本和复杂性。

本文详细地介绍ADIS16209的功能特性和使用方法,并使用Luminary公司的LM3S8962 Cortex-M3[3]微处理器与之组合设计一个倾角测量系统。最后对测量结果进行分析。

1 ADIS16209功能与使用方法

ADIS16209的是一种高精度、数字化倾角测量仪和双轴加速度测量仪,可以在单轴(±180°),双轴(±90°)等两种模式下运作[4]。标准电源电压(3.3 V)和串行外设接口(SPI)设计最简单,集成方便。一个简单的内部寄存器结构处理所有的输出数据和配置功能。这包括访问以下输出数据:校准加速度、准确倾斜角度、电源、内部温度、辅助模拟和数字输入信号、诊断错误标志和可编程报警条件。

ADIS16209采用9.2 mm×9.2 mm×3.9 mm LGA封装,可工作在-40~+125 ℃,能连接使用标准RoHS标准的回流焊工艺,广泛应用于医疗仪器、测量设备、工厂机床、机器人、惯性测量单元、导航控制等领域。

1.1 ADIS16209的功能

如图1所示,分别是ADIS16209的功能图、安装示意图与引脚图。由图1(a)可知,ADIS16209主要由┝街岐MEMS加速度计、温度传感器、1个模/数转换模块(ADC)、1个数/模转换模块(DAC)和报警模块(ALARMS)组成。传感器感知外界信号后,信号调理并转换,经过信号处理后,将得到的数据结果存入输出寄存器。通过SPI总线,外部SPI主控器件向ADIS16209发送控制指令或者读取。ADIS16209内部设置有控制寄存器,寄存器都有默认的值,通过对控制寄存器的修改写操作,可以改变采样频率,改变平均滤波参数等┒喔霆方面的控制效果。每个采样周期结束后,传感器测量结果存放至输出寄存器,并且DIO1引脚向器件外产生一个脉冲,表示一组新的完整的测量数据已经采集准备好,可供外部SPI主控器件读取。

图1 ADIS16209功能框图与引脚图

图1(b)是ADIS16209坐标朝向图,传感器测量的Ax与Ay两个方向上的加速度分量。第1,2,3,4引脚是传感器的SPI接口,第9引脚RST是传感器的复位引脚。

1.2 ADIS16209使用方法

1.2.1 ADIS16209硬件连接

ADIS163209的 SPI接口[4]与各种微处理器SPI主控制器件接线如图2所示。

图2 ADIS16209 SPI总线连接图

SPI总线的时钟频率最高可以达到2.5 MHz。但ADIS16209的采样频率对SPI时钟一定的要求:当采样频率大于等于546 SPS时,SPI的时钟频率最高可以采用2.5 MHz。当采样频率小于546 SPS时,SPI的时钟频率应不大于1 MHz,建议采用1 MHz。

1.2.2 ADIS16209数据读写与数据处理

通过SPI总线,可以对ADIS16209进行读写操作。可以根据自己的要求设置控制寄存器的值达到控制效果,也可以使用寄存器的默认设置。控制指令由1位的读写控制位,1位空位,6位寄存器地址位和8位的数据位组成。向ADIS16209写控制指令时,要将指令的最高位置1,例如,要将采样频率设置为2 731 SPS,也就是采样频率寄存器的值设置为0x0001,那么写指令就应该如下:先写寄存器低地址0x36,数据为0x01,再写高地址0x37,数据为0x00,所以指令为0xB601B700。对其他的控制寄存器的修改也可按照这样的方式修改。

读取ADIS16209输出的数据与写控制指令稍有区别,读取每个寄存器的值要分为2个16位的时序。┑1个16位时序向ADIS16209写入读取命令和寄存器地址。第2个16位时序将对应寄存器内容发送至DOUT数据线上,微控制器才可以得到正确的数据。如要读取x轴加速度寄存器的值(X ACC),那么┑1个16位时序DIN=0x0400,第2个时序XACCL OUT(x轴加速度值)将被发送到DOUT数据线上,SPI主机此时读到的数据才是上一个16位读指令发出的需要的指令。

从SPI总线上读取到的传感器数据是二进制数据或者二进制补码形式的数据。需要对其进行一定的解读才可以得到实际输出的代表的值。传感器输出的鞲霆值代表的意义可详见ADIS16209的数据手册中的Output Data Register Format 表[4]。其中SUPPLY OUT,AUX ADC和TEMP OUT的数据格式都为二进制数据,可以使用以下公式进行解算:

VALUE =DATA VALUE×Scale,

DATA VALUE≤2n-1 (1)

式中:VALUE代表实际的测量量的值;DATA VALUE代表寄存器的值;Scale代表寄存器每个最小单位代表的实际值;n为对应寄存器的数据位数。

XACC OUT,YACC OUT,XINCL OUT和YINCL OUT输出的数据格式均为14位2的补码,可以使用以下公式进行解算[5]:

VALUE= DATA VALUE×Scale,

DATA VLAUE≤2n-1

(2n-DATA VALUE)×(-Scale),

DATA VALUE>2n-1(2)

式中:DATA VALUE为寄存器的输出数据;VALUE为转换后实际的测量量的值;Scale为寄存器值最小值代表的最小单位;n为对应寄存器的数据位数。

2基于Luminary LMS8962与ADIS16209的倾角测量系统设计

下面介绍基于Luminary公司的LMS8962与ADIS16209的倾角测量系统的原理与设计。

2.1 倾角测量原理

加速度计是测量物体所受除万有引力加速度以外的加速度。将ADIS16209静止放在水平面时,其受到的是水平面对其向上的支撑力的加速度和地球自转的向心加速度的矢量和[6]。而地球自转的向心加速度很小[7],在测量中忽略不计。那么只要使得ADIS16209将一个加速传感器的输出摆置为0时,也即是将传感器摆置如图3(a)所示。或者两个加速度计测得的矢量和等于水平面对其向上的支撑力的加速度,也就是重力加速度的反方向矢量,也即是将传感器摆置如图4(a)所示。那么就可以利用这些矢量求出传感器与水平的倾角关系。

图3 单轴测量方式

当使用单轴测量方式时,如图3(b)所示,可知Ay轴测得的分量为0,Ax轴测得的分量为 a x,那么Ax轴与水平面的夹角:

θx=arcsin( a x/ g ) (3)

同理可以得到使用Ay轴作单轴测量方式时,Ay轴与水平面的夹角:

θy=arsin( a y/ g ) (4)

图4 双轴测量方式

当使用双轴测量方式时,如图4(b)所示,Т感器Ax与Ay轴组成的平面垂直于水平面,那么重量加速度g=ax+ay,Ax轴测得的分量为 a x,那么Axе嵊胨平面的夹角:

θx=arcsin( a x/ g ) (5)

Ay轴与水平面的夹角:

θy=arcsin( a y/ g ) (6)

2.2 硬件电路设计

本文使用Luminary公司的LMS8962与ADIS16209搭建成倾角测量系统。LMS8962是一款高性能的32位Cortex-M3内核微处理器,它有丰富的片内外设,如模/数转换(ADC),PWM,CAN和串行总线(SSI)等[8],功能强大,易于集成。

如图5所示是由LMS8962与ADIS16209组成的倾角测量系统。LMS8962通过SSI总线(SSI是串行通信总线,它兼容SPI总线[8]。)与ADIS16209进行通信。将采集到的数据存储到SD卡中,将解算得到的结果实时在LCD[9]上显示出来。

图5 硬件系统框图

2.3 软件设计

如图6所示是系统的软件流程图。程序启动进入系统初始化,接下来向ADIS16209写控制指令,以设置ADIS16209工作在需求的模式下,然后读取返回的数据并进行解算,最后通过存储数据到SD卡中并在液晶模块中显示出来。

图6 系统的软件流程图

3 实验结果

Crossbow Technology公司的AHRS500GA-226是高精度的IMU[10],其广泛应用于航空航天等高科技领域。实验以AHRS输出的结果为参考,将ADIS16209与AHRS固定于同一平台上,使得ADIS16209的Ax与Ay轴与AHRS的Ax与Ay轴方向相一致。令它们的Ax与Ay轴组成的平面与水平面垂直,绕着Ax与Ay轴组成的平面的垂直线转动,使Ax与Ay轴与水平面成一定的夹角。图7~图10是ADIS16209与AHRS输出的数据结果的对比,图中主要看较平稳的数据部分,数据抖动部分是因为在切换方向,切换方向时手对传感器有一个加速度,叠加在原来静止状态下受到的力,此时测量到的不能作为准确的结果。

图7 ADIS16209测得Ax轴上加速度与AHRS测得

Ax轴上加速度比较

图8 ADIS16209测得Ay轴上加速度与AHRS测得

Ay轴上加速度比较

图9 ADIS16209与AHRS测得Ax轴与水平面夹角比较

4 结 语

(1) 在静止状态下,ADIS16209双轴加速度计的输出与AHRS的输出趋势吻合,误差小于0.005g,具有较高的精度。

(2) 在静止状态下,由ADIS16209双轴测量方式得到的Ax轴、Ay轴与水平面的夹角和AHRS测得的结果趋势吻合,误差在1°以内,在但是ADIS16209有一定的噪声,如果对ADIS16209输出的加速度值进行滤波除噪处理,可以得到更好的结果。

图10 ADIS16209与AHRS测得Ay轴与水平面夹角比较

参考文献

[1]高国伟.传感器系列讲座(3)――倾角传感器[J].传感器世界,1995,1(8):35-44.

[2]张维胜.倾角传感器原理和发展[J].传感器世界,2002,8(8):18-21.

[3]Texas Instruments. Cortex-M3 technical reference manual revision: r1p1. ARM company[ EB/OL] .[ 2009-06-18] . http: //.

[4]Analog Devices Inc.. ADIS16209 data sheet[DB/OL]. [ 2008-01-11] . www. analog. com.

[5]康华光.电子技术基础数字部分[ M] .4版.北京:高等教育出版社,2000.

[6]陈永冰,钟斌.惯性导航原理[M].北京:国防工业出版社,2007.

[7]BEKIR Esmat. Introduction to modern navigation systems[ M] . USA: World Scientific Publishing, 2007.

[8]Luminary Micro Inc.. LMS8962 microcontroller data sheet[ EB/OL] . [ 2008-03-11] . . USA, 2007.

[9]RITDisplay Corporation. RGS13128096WH000 OLED datasheet[DB/OL]. [ 2008-01-11] . USA, 2006.

[10]Crossbow Technology Inc.. Crossbow Technology Inc. AHRS500GA-user′s manual[M]. Revision B. USA: Crossbow Technology Inc., 2007.