加速度计补偿倾角传感器

传感器实际倾斜角为:

所以只要得出单轴轴加速度传感器测量结果F(θx)和加速度计测量结果F(θy)就可以计算出θx和θy,进而知道总的倾斜度。

为实现高精度全摆幅倾斜测量就必须把两个传感器一个传感方向与重力方向垂直,一个传感方向与重力方向平行。运用此方法测量倾斜角。加速度传感器测量结果为:

此时θ为单方向上全摆幅、高精度倾斜角度。运用两轴加速度传感器无法解决倾斜角测量中全方位和全摆幅不能共同实现的矛盾。所以为测量一个全方位,全摆幅的倾斜角就必须使用三轴加速度计。

运用三轴加速度计测量倾斜角就必须把测量范围分为两档,一档为倾斜角为-π/4~π/4,二档为倾斜角为(-π/2~-π/4) &(π/4~π/2) 。当倾斜角度在±π/4之间时,

,这里以F(θz)的值作为划分档次的依据。

在一档中F(θx),F(θy)的分辨率很高,此时相当于运用一个两轴加速度传感器测量全方位,低摆幅倾斜角,运用式(15)可以计算倾斜角。在二档中F(θz)的分辨率都很高,此时相当于运用一个一轴加速度传感器测量全方位,高倾斜角度的倾斜角,运用式(1)可以计算倾斜角。

加速度计测试方向y 轴传感量Ay 为:Ay = (Vout_B–Vout_A)/2g;

加速度计:Cos a = Ay/g;

倾角传感器:Sin a = (Vout - Offset)/Sensitivity;

融合补偿:tan a = (Vout - Offset)*g/(Sensitivity*Ay);

2 SCA3000

传感器的微型化、智能化、低功耗是当今传感器发展的必然趋势,微电子机械系统技术(MicroElectro,Mechanical Systems,MEMS) 是传感器微型化发展道路上的一项重要技术。SCA3000-D1是VTI 公司的全数字化三轴加速度计,量程±2g ,电源电压3.3 V,64组缓冲存储器记录数据,在系统一级上面,有先进的性能和有效节能方式,频率响应可选,SPI 数字串口通信,抗冲击力强,可以应用于许多恶劣的条件下。

2.1传感器前端

前端单元采用了耐用、稳定、低功耗和噪声的电容传感器,这个前端单元包含三个加速度传感块。由于结构原因,三个加速度传感块传感方向与直角坐标成45°角,所以在接口电路模块中有一个匹配处理,加速度导致电容变化接着在信号调理电路中转化为电压变化。

2.2 接口电路

传感单元连接一个电容电压转换器,接下来在模拟领域校准,信号通过ADC 转换器转换为数字信号,ADC 信号被分离成三个信号处理通道,经过低通滤波器和骤减。之后,信号配合上直角坐标系和传输给输出寄存器。在一般测量中,加速度数据能够通过串行总线SPI 读出。

3 硬件设计

在此运用ARM7微控制器LPC2210和三轴加速度计SCA3000测量数据。运用ZLG7290控制LED 显示倾斜角度,保留一组SPI 接口用于扩展功能。

如图5所示,LPC2294通过SPI 总线连接SCA3000,通过I2C 总线连接ZLG7290,开关S1,S2,S3,S4用做校准功能使用,具体运用后面介绍。

SPI 是一个全双工的同步串行接口,一个SPI 总线可以连接多个主机和多个从机,但是在同一时刻只允许一个主机操作总线,总线上只能有一个主机和一个从机通信。SPI 总线一般由3~5根线组成,如图5所示为经典的4线SPI 连接电路,一个主机连接两个从机,主出从进(Master Out Slave In,MOSI) ,主入从出(Master In Slave Out,MISO) ,串行时钟(Serial ClocK ,SCK) ,片选(Chip Select,CSB) 低有效,工作时SSO ,SSl 只能有一个为低。主机一般为微控制器产生串行时钟,从机接收时钟。SCA3000一般作为从机组成一个系统。 SCA3000SPI 帧格式和传输协议如图6所示。

当CSB 为低时,SPI 帧触发,每一帧数据有16 b,MOSI 线上前8 b包含需要读/写的寄存器地址和读/写控制,其中前6 b为寄存器地址,第7 b为读/写控制,1为读,O 为写,第8 b为0,MOSI 线上后8 b为需要写的数据,读时不要考虑上面的数据。MOSI 线上数据是在时钟上升沿被采样,而在MISO 线上数据在时钟下降沿被装载。

MISO 线上,第2 b为前一SPI 帧的帧错误比特,第7 b始终为1,第8 b为当前帧数据的奇偶校验位。后8位数据为要读取的数据,在写过程中为地址寄存器中先前数据。 4 数据处理与校验

由于测量精度、外力影响,三轴加速度计的横轴传感,零刻度度偏移,温度飘移等影响导致三轴加速度计在测量上出现误差,或者测量数据受到不同程度的污染,这对求倾斜角产生很大的阻碍。由于上述原因的影响,现实中测量得到的三轴加速度计的三个数据的矢量和往往不会等于重力加速度。有外力时加速度传感器测得的是重力与外力和的加速度,肯定不等于重力加速度,有恒外力作用时难以直接测量倾斜角的准确值(运用适当方法进行补偿或抵消除外) ,SCA3000对数字信号进行低通滤波可以去除掉高频振动;对三轴数字数据进行权限设置,对于三轴数据矢量和与重力加速度的偏差大于0.05g 时抛弃此次测量数据,保证测量精度。

4.1 零点偏移

零刻度偏移的解决方案,当倾斜角较小时,z 轴数据的分辨率极低,影响测量精度,所以此时运用其中两轴进行倾斜角测量将更精确。为提高精度,需要对倾斜角传感器进行调零校正,校正后的结果将是测量值减去偏移值后的数据。偏移值的测量方法有两种:

(1)将传感器放置在一个校准水平面上,此时的输出即为偏移值。

(2)如图7所示,测量出图7(a).(b)姿势的输出VA ,VB 偏移值为(VA+VB)/2。

4.2 横轴传感

横轴传感补偿方案,由于组合封装或者器件本身结构原因,三轴加速度计存在横轴传感现象,三轴加速度计的横轴传感的度量有下式定义:

式中:Sx ,Sz 为横轴方向测得的传感量,Sy 为测试方向测得的传感量,由于横轴传感的存在,使得测量结果不准确,所以需要对输出结果进行补偿,首先来考虑两轴间的传感补偿,如图8所示。

图8中,测试方向为y 轴方向,加速度传感器如图8(a)样式放置时,x 轴输出为Voutx-A ,y 轴输出为Vouty-A ;加速度传感器如图8(b)样式放置时,x 轴输出为Voutx-B ,y 轴输出为Vouty-B ,测试方向y 轴传感量为:

x 横轴传感量为:

所以当倾斜角传感器倾斜为某一角度时,x 横轴数据经y 轴进行传感补偿后的值为:

式中:xoutComp 为补偿后的x 轴数据;Vouty-axis 为x 轴测量数据;Vouty-axis 为y 轴测量数据;Voffsety 为y 轴数据偏移值。同样,z 轴数据对x 轴数据进行补偿后得到x 轴数据的校准值。4.3 数据融合

SCA3000工作在测量模式下时,传感器输出数据速率为260 Hz,0.37 s就可以产生一次输出缓冲存储器半满中断。所以在倾斜角度变化不是很剧烈的情况下,可以对每一输出缓冲存储器中数据进行加权平均求得倾斜角度。

5 软件设计

程序主要分三部分,主程序main ,倾斜角计算子程序tlitcalculate 和校准子程序calibrate ,在对SCA3000进行操作时,还要调用SPI 读写程序,在对ZLG7290进行操作时调用I2C 读写子程序。

如图9所示,在倾斜角传感器第一次使用前必须对其进行校准,包括测量各轴的零点偏移,各轴的横轴传感量,当PO .1置高时进入校准状态。在校准中,PO .9&PO .10&PO .11=000时,将SCA3000按z 轴垂直向上放置;PO .9&P0.10&P0.11=001时,将SCA3000按z 轴垂直向下放置;PO .9&P0.10&P0.11=OlO时,将SCA3000按x 轴垂直向上放置;P0.9&PO .10&PO .11=01l时,将SCA3000按x 轴垂直向下放置;P0.9&PO .10&P0.11=100时,将SCA3000按y 轴垂直向上放置;P0.9&P0.10&P0.11=101时,将SCA3000按y 轴垂直向下放置。综合各个状态时的数据完成零点偏移和横轴传感量计算。实际运用中,SCA3000安装在平台上时不可能保持xy 轴与平台完全平行,z 轴完全垂直平台。所以在进行测量前必须取得平台水平放置时SCA3000的输出值,将其设为初始值保存于FLASH 中。

在倾斜角计算中。首先读数据进行零点偏移补偿和横轴传感补偿,接着对严重污染的数据丢弃,进行数据融合,再判断倾斜角度大小。当角度较小时,利用两轴数据进行计算,当角度过大时运用三轴数据进行计算。

主程序中,采用定时器中断和SCA3000缓存器中断两个中断对SCA3000数据进行读写。保证数据的实时性。

6 结语

本文基于三轴加速度计SCA3000和ARM 处理器芯片LPC2210设计了一种三轴倾斜角智能传感器,它具有全方位和全摆幅的特点。本文对两轴、三轴加速度计测量倾斜角的原理进行了分析,采用两轴、三轴数据的合理运用,实现精度高、抗噪性能强的倾斜角传感器的研究。

对传感器数据采用零点偏移补偿,横轴传感量补偿,进一步提高了数据的精度。采用SPI 接口实现传感器与微控制器间的通信,采用定时器中断和SCA3000缓存器中断两个中断唤起对传感器数据的读/写,实现对传感器数据读速度可控。

传感器实际倾斜角为:

所以只要得出单轴轴加速度传感器测量结果F(θx)和加速度计测量结果F(θy)就可以计算出θx和θy,进而知道总的倾斜度。

为实现高精度全摆幅倾斜测量就必须把两个传感器一个传感方向与重力方向垂直,一个传感方向与重力方向平行。运用此方法测量倾斜角。加速度传感器测量结果为:

此时θ为单方向上全摆幅、高精度倾斜角度。运用两轴加速度传感器无法解决倾斜角测量中全方位和全摆幅不能共同实现的矛盾。所以为测量一个全方位,全摆幅的倾斜角就必须使用三轴加速度计。

运用三轴加速度计测量倾斜角就必须把测量范围分为两档,一档为倾斜角为-π/4~π/4,二档为倾斜角为(-π/2~-π/4) &(π/4~π/2) 。当倾斜角度在±π/4之间时,

,这里以F(θz)的值作为划分档次的依据。

在一档中F(θx),F(θy)的分辨率很高,此时相当于运用一个两轴加速度传感器测量全方位,低摆幅倾斜角,运用式(15)可以计算倾斜角。在二档中F(θz)的分辨率都很高,此时相当于运用一个一轴加速度传感器测量全方位,高倾斜角度的倾斜角,运用式(1)可以计算倾斜角。

加速度计测试方向y 轴传感量Ay 为:Ay = (Vout_B–Vout_A)/2g;

加速度计:Cos a = Ay/g;

倾角传感器:Sin a = (Vout - Offset)/Sensitivity;

融合补偿:tan a = (Vout - Offset)*g/(Sensitivity*Ay);

2 SCA3000

传感器的微型化、智能化、低功耗是当今传感器发展的必然趋势,微电子机械系统技术(MicroElectro,Mechanical Systems,MEMS) 是传感器微型化发展道路上的一项重要技术。SCA3000-D1是VTI 公司的全数字化三轴加速度计,量程±2g ,电源电压3.3 V,64组缓冲存储器记录数据,在系统一级上面,有先进的性能和有效节能方式,频率响应可选,SPI 数字串口通信,抗冲击力强,可以应用于许多恶劣的条件下。

2.1传感器前端

前端单元采用了耐用、稳定、低功耗和噪声的电容传感器,这个前端单元包含三个加速度传感块。由于结构原因,三个加速度传感块传感方向与直角坐标成45°角,所以在接口电路模块中有一个匹配处理,加速度导致电容变化接着在信号调理电路中转化为电压变化。

2.2 接口电路

传感单元连接一个电容电压转换器,接下来在模拟领域校准,信号通过ADC 转换器转换为数字信号,ADC 信号被分离成三个信号处理通道,经过低通滤波器和骤减。之后,信号配合上直角坐标系和传输给输出寄存器。在一般测量中,加速度数据能够通过串行总线SPI 读出。

3 硬件设计

在此运用ARM7微控制器LPC2210和三轴加速度计SCA3000测量数据。运用ZLG7290控制LED 显示倾斜角度,保留一组SPI 接口用于扩展功能。

如图5所示,LPC2294通过SPI 总线连接SCA3000,通过I2C 总线连接ZLG7290,开关S1,S2,S3,S4用做校准功能使用,具体运用后面介绍。

SPI 是一个全双工的同步串行接口,一个SPI 总线可以连接多个主机和多个从机,但是在同一时刻只允许一个主机操作总线,总线上只能有一个主机和一个从机通信。SPI 总线一般由3~5根线组成,如图5所示为经典的4线SPI 连接电路,一个主机连接两个从机,主出从进(Master Out Slave In,MOSI) ,主入从出(Master In Slave Out,MISO) ,串行时钟(Serial ClocK ,SCK) ,片选(Chip Select,CSB) 低有效,工作时SSO ,SSl 只能有一个为低。主机一般为微控制器产生串行时钟,从机接收时钟。SCA3000一般作为从机组成一个系统。 SCA3000SPI 帧格式和传输协议如图6所示。

当CSB 为低时,SPI 帧触发,每一帧数据有16 b,MOSI 线上前8 b包含需要读/写的寄存器地址和读/写控制,其中前6 b为寄存器地址,第7 b为读/写控制,1为读,O 为写,第8 b为0,MOSI 线上后8 b为需要写的数据,读时不要考虑上面的数据。MOSI 线上数据是在时钟上升沿被采样,而在MISO 线上数据在时钟下降沿被装载。

MISO 线上,第2 b为前一SPI 帧的帧错误比特,第7 b始终为1,第8 b为当前帧数据的奇偶校验位。后8位数据为要读取的数据,在写过程中为地址寄存器中先前数据。 4 数据处理与校验

由于测量精度、外力影响,三轴加速度计的横轴传感,零刻度度偏移,温度飘移等影响导致三轴加速度计在测量上出现误差,或者测量数据受到不同程度的污染,这对求倾斜角产生很大的阻碍。由于上述原因的影响,现实中测量得到的三轴加速度计的三个数据的矢量和往往不会等于重力加速度。有外力时加速度传感器测得的是重力与外力和的加速度,肯定不等于重力加速度,有恒外力作用时难以直接测量倾斜角的准确值(运用适当方法进行补偿或抵消除外) ,SCA3000对数字信号进行低通滤波可以去除掉高频振动;对三轴数字数据进行权限设置,对于三轴数据矢量和与重力加速度的偏差大于0.05g 时抛弃此次测量数据,保证测量精度。

4.1 零点偏移

零刻度偏移的解决方案,当倾斜角较小时,z 轴数据的分辨率极低,影响测量精度,所以此时运用其中两轴进行倾斜角测量将更精确。为提高精度,需要对倾斜角传感器进行调零校正,校正后的结果将是测量值减去偏移值后的数据。偏移值的测量方法有两种:

(1)将传感器放置在一个校准水平面上,此时的输出即为偏移值。

(2)如图7所示,测量出图7(a).(b)姿势的输出VA ,VB 偏移值为(VA+VB)/2。

4.2 横轴传感

横轴传感补偿方案,由于组合封装或者器件本身结构原因,三轴加速度计存在横轴传感现象,三轴加速度计的横轴传感的度量有下式定义:

式中:Sx ,Sz 为横轴方向测得的传感量,Sy 为测试方向测得的传感量,由于横轴传感的存在,使得测量结果不准确,所以需要对输出结果进行补偿,首先来考虑两轴间的传感补偿,如图8所示。

图8中,测试方向为y 轴方向,加速度传感器如图8(a)样式放置时,x 轴输出为Voutx-A ,y 轴输出为Vouty-A ;加速度传感器如图8(b)样式放置时,x 轴输出为Voutx-B ,y 轴输出为Vouty-B ,测试方向y 轴传感量为:

x 横轴传感量为:

所以当倾斜角传感器倾斜为某一角度时,x 横轴数据经y 轴进行传感补偿后的值为:

式中:xoutComp 为补偿后的x 轴数据;Vouty-axis 为x 轴测量数据;Vouty-axis 为y 轴测量数据;Voffsety 为y 轴数据偏移值。同样,z 轴数据对x 轴数据进行补偿后得到x 轴数据的校准值。4.3 数据融合

SCA3000工作在测量模式下时,传感器输出数据速率为260 Hz,0.37 s就可以产生一次输出缓冲存储器半满中断。所以在倾斜角度变化不是很剧烈的情况下,可以对每一输出缓冲存储器中数据进行加权平均求得倾斜角度。

5 软件设计

程序主要分三部分,主程序main ,倾斜角计算子程序tlitcalculate 和校准子程序calibrate ,在对SCA3000进行操作时,还要调用SPI 读写程序,在对ZLG7290进行操作时调用I2C 读写子程序。

如图9所示,在倾斜角传感器第一次使用前必须对其进行校准,包括测量各轴的零点偏移,各轴的横轴传感量,当PO .1置高时进入校准状态。在校准中,PO .9&PO .10&PO .11=000时,将SCA3000按z 轴垂直向上放置;PO .9&P0.10&P0.11=001时,将SCA3000按z 轴垂直向下放置;PO .9&P0.10&P0.11=OlO时,将SCA3000按x 轴垂直向上放置;P0.9&PO .10&PO .11=01l时,将SCA3000按x 轴垂直向下放置;P0.9&PO .10&P0.11=100时,将SCA3000按y 轴垂直向上放置;P0.9&P0.10&P0.11=101时,将SCA3000按y 轴垂直向下放置。综合各个状态时的数据完成零点偏移和横轴传感量计算。实际运用中,SCA3000安装在平台上时不可能保持xy 轴与平台完全平行,z 轴完全垂直平台。所以在进行测量前必须取得平台水平放置时SCA3000的输出值,将其设为初始值保存于FLASH 中。

在倾斜角计算中。首先读数据进行零点偏移补偿和横轴传感补偿,接着对严重污染的数据丢弃,进行数据融合,再判断倾斜角度大小。当角度较小时,利用两轴数据进行计算,当角度过大时运用三轴数据进行计算。

主程序中,采用定时器中断和SCA3000缓存器中断两个中断对SCA3000数据进行读写。保证数据的实时性。

6 结语

本文基于三轴加速度计SCA3000和ARM 处理器芯片LPC2210设计了一种三轴倾斜角智能传感器,它具有全方位和全摆幅的特点。本文对两轴、三轴加速度计测量倾斜角的原理进行了分析,采用两轴、三轴数据的合理运用,实现精度高、抗噪性能强的倾斜角传感器的研究。

对传感器数据采用零点偏移补偿,横轴传感量补偿,进一步提高了数据的精度。采用SPI 接口实现传感器与微控制器间的通信,采用定时器中断和SCA3000缓存器中断两个中断唤起对传感器数据的读/写,实现对传感器数据读速度可控。


相关文章

  • 智能车设计 论文
  • 摘要 在全国大学生飞思卡尔"智能汽车"竞赛中,对智能车前轮倾角的调整是一个十分重要的过程,它关系到车模在高速行进过程中的直线行驶性能,转弯的性能等许多方面.为了提高倾角调整的准确性.一致性,本毕业设计旨在开发一种运用于前 ...查看


  • 静态测试系统的评价指标
  • 1.静态测试系统的评价指标 灵敏度:输入量的变化∆x(t)所引起的输出量变化∆y(t)的大小. 放大倍数E=∆y(t) ∆x(t) 分辨率:指试验系统能测量到的最小输入量变化的值Δx 重复性:指用同一试验系统在相同的试验条件下对同一被测量进 ...查看


  • 陀螺仪+加速度+卡尔曼数据融合
  • ) o l .36 N o . 4 J o u r n a l o f S o u t h w e s t C h i n aN o r m a lU n i v e r s i t N a t u r a l S c i e n c eE ...查看


  • 加速度传感器原理与应用简介
  • 加速度传感器原理与应用简介 1.什么是加速度传感器 加速度传感器是一种能够测量加速力的电子设备.加速力就是当物体在加速过程中作用在物体上的力,就好比地球引力,也就是重力.加速力可以是个常量,比如g ,也可以是变量. 加速度计有两种:一种是角 ...查看


  • 倾角传感器原理与应用介绍
  • 倾角传感器原理与应用介绍 2011-10-10 8:43 倾角传感器经常用于系统的水平测量,如工程车辆调平,和高空平台安全保护,定向卫星通讯天线的俯仰角测量,船舶航行姿态测量,盾构顶管应用,大坝检测,地质设备倾斜监测,火炮炮管初射角度测量, ...查看


  • 双轮自平衡小车系统设计与制作-硬件部分
  • 摘 要 近几年来,随着汽车技术的快速发展,很多新兴技术涌现出来,其中就包括双轮自平衡小车技术.这项技术在很多方面都得到了体现,在交通方面施展了尤为强大的作用,其应用也逐渐深入到日常生活中,现在生活中常见的双轮自平衡电动车便是最常见的代表.本 ...查看


  • 加速度传感器及压电式传感器应用
  • 加速度传感器及压电式传感器应用 摘要:加速度传感器是一种惯性传感器,它能感受加速度并转换成可用输出信号,被广泛用于航空航天.武器系统.汽车.消费电子等.通过加速度的测量,本文简单介绍了加速度传感器的种类.原理及相关应用并着重介绍了压电式加速 ...查看


  • 智能车电磁组-德州学院-极速终结者技术报告
  • 第七届"飞思卡尔"杯全国大学生 智能汽车竞赛 技 术 报 告 学 校: 德州学院 队伍名称: 极速终结者 参赛队员: 卢瑞剑 高祥 朱振阳 带队教师:姚俊红 关于技术报告和研究论文授权的使用说明 本人完全了解第六届&qu ...查看


  • 基于角度及角速度的智能汽车直立行走控制
  • 第16卷第2期 2014年4月 JOURNALOFCHUZHOUUNIVERSITY 滁州学院学报 Vol.16No.2 Apr.2014 基于角度及角速度的智能汽车直立行走控制 宋国富 摘 要:飞思卡尔智能车的电磁组项目要求车子能够直立行 ...查看


热门内容