三轴加速度传感器在智能车控制与道路识别中的应用

三轴加速度传感器在智能车控制与道路识别中的应用

赵小平程志江张永瑞段志尚

摘要：三轴加速度传感器MMA7260Q可以测量智能车惯性大小，选取最佳重心位置，并能准确定位智能车处于直线、弯道、坡道、漂移等运行状态；利用加速度传感器能够提前预测路径，并判断何时刹车效果最佳。并且很好的解决了在直立行走车模的平衡与方向识别。

关键词：智能车；加速度传感器；MMA7260Q；道路识别；

引言：

提出了一种基于三轴加速度传感器在智能车中的控制以及路径识别的设计。该设计采用三轴加速度传感器MMA7260Q测量智能车在运动中的加速度信号，以嵌入式单片MC9S12XSl28B作为核心控制器，对加速度信号进行采样，A ／D转换，再将特征数据存储在EEPROM中。很好地解决了智能车运动路径分析的问题以及在。实时获取小车加速度，从而更加全面的获取小车的运行状态，为控制的流畅性和更好的路况识别提供了可能。

在直立行走的车模中，应用同样的原理，选择最佳重心，可以很好地解决直立行走车模的平衡以及方向识别，从而加快车模的行车速度。

实验结果证明：结合加速度传感器具有很强的抗干扰性，提取角度信息更准确，确保了智能车在直道上能够以较高的速度行驶，在弯道则能基本不失速平滑地过弯。

1.智能车现存问题

在车模运行当中，人无法判断小车的运行状态，使用加速度传感器来监控小车的加速度，这样可以更加精确地知道小车的运行状态，而且可以通过对某个方向加速度的变化的检测来区分出坡道和非坡道。从而进行相应的策略应对。避免小车在比赛时出现停车与翻车现象。以及很好地解决了直立行走的车模中在行走过程中的平衡性。

2.MMA7260Q简介

加速度传感器是Freescale公司出品的MMA7260Q。

图1 芯片引脚定义

2.1M M A 7 2 6 0 Q 的特性：

在一个设备中提供三轴向XYZ检测灵敏度，可选灵敏度：1.5g、2g、4g 和6g；功耗低，具有休眠模式，低压运行一般在2.2V~3.6V，能够快速启动，一般启动时间为1ms；其低噪音，封装一般为16针脚6mm x 6mm x 1.45mm无针脚型方体扁平封装（Q F N ）。

2.2M M A 7 2 6 0 Q 的优点

为多功能应用提供灵活的可选量程：包括1.5g、2g 、4g 和6g ；功耗低，可延长电池使用寿命开机响应时间短，最适合电池供电手持设备的休眠模式，组件数量少-节约成本和空间噪音低、灵敏度高，具有自适应功能，频率及解析度高，提供精确的坠落、倾斜、移动、放置、震动和摇摆感应灵敏度不同应用的建议重力加速度级别自由落体检测：1g~2g 倾斜控制：1g~2g。

2.3加速度传感器应用分析

2.3.1干扰因素分析

芯片可以测试一个方向上的加速度变化。所以采用了不同的安装方式，其间要考虑到比较多的干扰因素。

一、车体行进过程中的机械振动

二、速度控制不平滑对车体运动状态的影响

三、常规情况下的误差和正常时，加速度传感器产生的输出区别大小

2.3.2安装方式分析

若安装于安装摄像头的立杆上，杆子在小车加减速的时候有比较明显的左右晃动，通过Labview 观察发现干扰过大。若安装于小车后部，由于电机自身的振动，对MEMS 产生的影响会较之前更为明显。

经测试，如果测量水平X 方向的加速度，宜将装有MMA2260的电路板装载在车前部。

图二 加速度传感器安装方式

若在直立行走车模上安装，则要测量竖直Z 方向上的加速度。

图三 直立行走车模安装示意图

Z 轴

X 轴

Y 轴

车模运行方向

X 轴

Z 轴

Y 轴

MMA7260Q信号采集模块设计加速度信号采集模块如图1所示。x，l，，z 3个相互垂直方向上的加速度由G-Gell传感单元感知，电容值经过容压变换器转换为电压值，经过增益放大器、滤波器和温度补偿以电压的形式作为输出信号拉J，经过放大滤波处理，将所需模拟信号调整至一个合适的范围，再转换为数字信号送数据处理单元。

图四加速度信号采集结构图

加速度传感器与单片机的接口电路MMA7260Q与MC9S12XSl28B的硬件接口电路如图2所示。微处理器内部包含完整的地输入缓存器、模拟开关电路、可编程增益放大器和A／D转换器以及数字滤波器，使用非常方便。G1，G2输入低电平，灵敏度达到800 mV／g。。当Mode=l时，加速度传感器处于正常工作状态。x，y，z输出端分别接RC滤波器，再通过高输出驱动运算放大器TLV4112构成电压跟随作用，输出稳定的直流电压信号。

图五MMA7260Q与MC9S12XSl28B的硬件接口电路

本设计采用CodeWamor软件与BDM作为调试工具，编程环境支持c语言和汇编语言的程序设计，大大方便了用户的程序设计，提高了系统开发效率。本设计程序代码使用C语言编写。

图六加速度程序流程图

2.6 A／D采样流程设计

本设计主要包括单片机初始化模块和实时路径检测模块。

1)单片机的初始化模块包括：I／O模块，AD模块，定时中断模块初始化。

2)实时路径检测模块：利用接受管，红外光电传感器和CCD摄像头检测特征信号，利用加速度传感器检测角度信号，将返回信号输入单片机的输入端口，程序不问断地读入输入端口的信号，结合判断语句，得出合适的PWM控制信号。

图七主程序与中断程序流程图

2.7实验测试

图中曲线为时间和AD采集到的数据之间的关系。而AD采集到的数据可以用来反映加速度的变化情况

图八装载于静止小车上时

图九 装载于运动状态不变小车上时

图十 小车角度变化时

通过测试可以看出。对于车体角度的变化，加速度传感器的值都有一定的变化。不过同时也看到车子的振动对加速度传感器也会产生一些干扰。

在识别坡道时，如果加速度传感器监控的是竖直方向的加速度，即z 方的加速度，那么在平道上时，明显竖直方向上加速度为零，在上坡后，如果忽略摩擦力，那加速度将变化为θθcos sin g 。通过加速度传感器中加速度的

-1.5g

1.5g 0