当前位置:
文档之家› 三轴加速度传感器在智能车路径识别中的应用
三轴加速度传感器在智能车路径识别中的应用
阂哮圆一园一圈
图1加速度信号采集结构图
Fig 1 Structure
diagram of
acceleration signal
acquisifion
1.2加速度传感器与单片机的接口电路
MMA7260Q与MC9S12DGl28B的硬件接口电路如图2 所示【…。微处理器内部包含完整的地输入缓存器、模拟开 关电路、可编程增益放大器和A/D转换器以及数字滤波 器,使用非常方便。g。,92输入低电平,灵敏度达到
output
由图6(a)可知,第1个尖峰表示智能车处于加速状 态,第2个尖峰表示智能车处于减速状态;由图6(b)可知,
调理、单极低通滤波和温度补偿技术。成本低、功耗低,测 试中加速度信号稳定性和灵敏度都达到了预期的效果。从 而提高了系统的控制精度,使舵机响应速度变快。 基于加速度传感器的路径识别设计方法,相比传统的 光电感应和图像捕捉抗干扰性更强,数据处理更简单。可
(a)主程序部分流程图
(a)flow chart
ofmain
番蓄
Fig
[jpJ
定时器献戗
3实验结果分析 测试1:当智能处于匀速直线运动时,对X-OUT,y-
(b)中断服务程序流程图
chart ofbreak in service program
OUT,Z・OUT分别采样600次,测试电压为3.42 V。计算出 600个点的期望值是105,方差为2.864 822,标准差为 1.701417622。加速度采样值正态分布如图4,由此可见加 速度传感器静止时输出采样值近似为105。
1.59。。…。
态。x,y,z输出端分别接RC滤波器,再通过高输出驱动 运算放大器TLV4112构成电压跟随作用,输出稳定的直流 电压信号。
通过每只传感器的相对输出值与加速度值作加权平均 就可以算出智能车相对于静止状态的各轴相对偏移位置
SD..:—N—ow—S—D—--_min,
max—ml/l
(1)
of
aecelerometer appUcafion
由以上测试,智能车路径识别的关键在于判断异形路径
井陕速、准确地响应。智能车行驶过程中,利用加速度传感器 输出信号波形可以判断出前方路径,从直道人弯、下坡过弯等 情况都能顺利通过,并增加了智能车对路径的跟随睦能。
智能车左右方向加速度信号,Z—OUT表示智能车上下方向
加速度信号.采样值经过数字滤波以后,通过Matlab绘制 出各个方向输出波形图。由于智能车的底盘不可能保持绝
A/D采样流程设计
本设计主要包括单片机初始化模块和实时路径检测模
对水平,车身可能会向前倾斜或者向后倾斜,所以,Y-OUT,
X—OUT,z—OUT输出值都有5%的误差,当处于匀速直线运
(Engineering
Center of the
Ministry
of
Education,Metallurgical Automation
Wuhan
University of
Science and Technology,Wuhan 430081,China)
Abstract:A design of path recognition based three—axis aecelerometer
Co)转弯或者漂移时分析图
Co)analysis
graph ofturn
Or
采样点数 (c)上,下坡时分析图
(e)analysis
graph ofup slope and down slope
drift
Fig
6
图6不同轴向输出波形图 Waveform of different axis direction
and
MC9S12DGl28B
2软件设计实现 本设计采用CodeWamor软件与BDM作为调试工具, 编程环境支持c语言和汇编语言的程序设计,大大方便了 用户的程序设计,提高了系统开发效率。本设计程序代码 使用C语言编写¨j。
2.1
2.3路径识别规则
x—OUT表示智能车前后方向加速度信号,Y-OUT表示
Acce=(∑SD。。G。)/(∑SD。)x3—1.5,
图2
Fig
2
(2)
MMA7260Q与MC9S12GDGl28B接口电路
circuit of
式中Acce为各个方向加速度值;SD。为当前加速度相对 输出值;G。为当前采样电压值所对应的加速度值;NowSD 为当前采样电压值。
Interface
MMA7260
car’S are
converted
saved in EEPROM.So the problem of the smart
path analysis is resolved
very
well.
car
Key
words:acceleration transducer;path recognition;smart
收稿日期:2009—1卜18
万方数据
126
传感器与微系统
第29卷
800 mV/g。。当Mode=l时,加速度传感器处于正常工作状
值,再除以各方向传感器的输出范围即可得到其相对输出 值。根据g,=92=0,最小值对应着一1.59。,最大值对应着 +1.59。,静止时各向加速度值为0,加速度范围为一1.5一
以广泛用于无人驾驶智能汽车、智能仪表、机器人步态特征
提取和故障诊断等。 参考文献:
[1]卓晴,黄开胜.学做智能车一挑战“飞思卡尔”杯[M].北
京:北京航空航天大学出版社,2007. m/赵憾靼智 [2] 苏维嘉,王旭辉.新型加速度传感器在倾角测量中的应用研 究[J].机械研究及应用,2007,20(5):63-65. [3]王威.HCSl2微控制器原理及应用[M].北京:北京航空航 智能车前进距离/m 图7加速度传感器应用效果图
MMA7260Q信号采集模块设计
加速度信号采集模块如图1所示。x,l,,z 3个相互垂
直方向上的加速度由G一(:ell传感单元感知,电容值经过容 压变换器转换为电压值,经过增益放大器、滤波器和温度补 偿以电压的形式作为输出信号拉J,经过放大滤波处理,将 所需模拟信号调整至一个合适的范围,再转换为数字信号 送数据处理单元。
表1路径判断规则表
Tab 1 Rule table of path
recognition
y-OUT X-OUT z.OUT
Y-OUT
X—OUT
z—OUT
状态
状态 【mV) (mV) (mV) (mV) (mV) (mV)
加速度信号采集部分设计流程图如图3所示。
值执耐X・OUT.Y—OtVf. z_0UT避礼鬻样.A/D转换
0引
言
1硬件电路设计
1.1
目前,智能车路径识别方法有2种:一是采用反射式红 外光电管,根据不同颜色对红外线的吸收程度不同来提取 特征信息,从而得知轨道的路径。这种方法的缺陷是光电 管的前瞻不够远,反射光线受外界光线干扰很大;二是采用 CCD摄像头获取轨道的图像信息,通过数字图像处理方法 得到轨道路径,这种方法的缺陷是过弯和坡道时容易采集 到轨道以外的信息而导致智能车偏离轨道,而且,图像数据 存储量大,信息处理比较复杂…。 本文利用Freescale公司的高灵敏度三轴加速度传感 器MMA7260Q可以测量智能车惯性大小,选取最佳重心位 置,并能准确定位智能车处于直线、弯道、坡道、漂移等运行 状态;利用加速度传感器能够提前预测路径,并判断何时刹 车效果最佳。实验结果证明:结合加速度传感器具有很强 的抗干扰性,提取角度信息更准确,确保了智能车在直道上 能够以较高的速度行驶,在弯道则能基本不失速平滑地过 弯。
5
图5
同一时刻三轴传感器采样值分布
of three-axis
sensor’s
Distribution
sampling
value
atthe slimetime
童
j塑
羹
}磐
童
趔
鞋
啦 怅
鞋
※
00
馔
00
采样点数
(a)加速和减速时分析图
(a)analysis graph ofspeed-up and slow・down
摘要:提出了一种基于加速度传感器的路径识别设计。该设计采用三轴加速度传感器MMA7260Q测 量智能车在运动中的加速度信号,以嵌入式单片机MC9S12DGl28B作为核心控制器,对加速度信号进行 采样,A/D转换,再将特征数据存储在EEPROM中。很好地解决了智能车运动路径分析的问题。 关键词:加速度传感器;路径识别;智能车 中图分类号:TP
on
acceleration transducer has been proposed.This design
car
uses
the of
to
MMA7260Q.It
detect the acceleration signal when the smart
iS moving.As the
core
controller.Embedded SCM MC9S1212DGl28B has been used.The acceleration signal iS sampled and digital data via the ADC of the microcontroller.Then the data
250 200
program(b)flow
图3程序流程图
3 Flow chart of
program
2.2数字滤波算法设计
由于加速度传感器三轴之间差异和较高灵敏度,防止 在运动过程中由于智能车的抖动引起的误差,对单片机采 样得到的电压值进行归一化处理,最后可得到各方向传感 器的相对电压值。具体实现方法:让智能车后轮转动起来, 分别记录各传感器输出信号的最大值和最小值,用最大值 减去最小值得到各传感器在运动过程中的输出范围。在智 能车行驶过程中将各方向传感器输出的信号值减去最小