三轴加速度传感器在智能车控制与道三轴加速度传感器在智能车控制与道 路识别中的应用路识别中的应用三轴加速度传感器 MMA7260Q 可以测量智能车惯性大小，选取最佳重心位置，并能准确定位智能车处于直线、弯道、坡道、漂移等运行状态；利用加速度传感器能够提前预测路径，并判断何时刹车效果最佳。并且很好的解决了在直立行走车模的平衡与方向识别。由此提出了一种基于三轴加速度传感器在智能车中的控制以及路径识别的设计。该设计采用三轴加速度传感器MMA7260Q 测量智能车在运动中的加速度信号，以嵌入式单片 MC9S12XSl28B 作为核心控制器，对加速度信号进行采样，AD 转换，再将特征数据存储在 EEPROM 中。很好地解决了智能车运动路径分析的问题以及在。实时获取小车加速度，从而更加全面的获取小车的运行状态，为控制的流畅性和更好的路况识别提供了可能。在直立行走的车模中，应用同样的原理，选择最佳重心，可以很好地解决直立行走车模的平衡以及方向识别，从而加快车模的行车速度。实验结果证明：结合加速度传感器具有很强的抗干扰性，提取角度信息更准确，确保了智能车在直道上能够以较高的速度行驶，在弯道则能基本不失速平滑地过弯。1.1. 智能车现存问题智能车现存问题在车模运行当中，人无法判断小车的运行状态，使用加速度传感器来监控小车的加速度，这样可以更加精确地知道小车的运行状态，而且可以通过对某个方向加速度的变化的检测来区分出坡道和非坡道。从而进行相应的策略应对。避免小车在比赛时出现停车与翻车现象。以及很好地解决了直立行走的车模中在行走过程中的平衡性。2.2. MMA7260QMMA7260Q 简介简介加速度传感器是 Freescale 公司出品的 MMA7260Q。图 1 芯片引脚定义2.12.1 MMA7260QMMA7260Q 的特性：的特性：在一个设备中提供三轴向 XYZ 检测灵敏度，可选灵敏度：1.5g、2g、4g 和 6g；功耗低，具有休眠模式，低压运行一般在 2.2V3.6V，能够快速启动，一般启动时间为1ms；其低噪音，封装一般为 16 针脚 6mm x 6mm x 1.45mm无针脚型方体扁平封装（QFN）。2.22.2 MMA7260QMMA7260Q 的优点的优点为多功能应用提供灵活的可选量程：包括 1.5g、2g 、4g 和 6g；功耗低，可延长电池使用寿命 开机响应时间短，最适合电池供电手持设备的休眠模式，组件数量少-节约成本和空间噪音低、灵敏度高，具有自适应功能，频率及解析度高，提供精确的坠落、倾斜、移动、放置、震动和摇摆感应灵敏度不同应用的建议重力加速度级别自由落体检测：1g2g 倾斜控制：1g2g。2.32.3 加速度传感器应用分析加速度传感器应用分析2.3.1 干扰因素分析芯片可以测试一个方向上的加速度变化。所以采用了不同的安装方式，其间要考虑到比较多的干扰因素。一、车体行进过程中的机械振动二、速度控制不平滑对车体运动状态的影响三、常规情况下的误差和正常时，加速度传感器产生的输出区别大小2.3.2 安装方式分析若安装于安装摄像头的立杆上，杆子在小车加减速的时候有比较明显的左右晃动，通过 Labview 观察发现干扰过大。若安装于小车后部，由于电机自身的振动，对 MEMS产生的影响会较之前更为明显。经测试，如果测量水平 X 方向的加速度，宜将装有MMA2260 的电路板装载在车前部。图二 加速度传感器安装方式若在直立行走车模上安装，则要测量竖直 Z 方向上的加速度。图三 直立行走车模安装示意图2.42.4 硬件电路设计硬件电路设计MMA7260Q 信号采集模块设计加速度信号采集模块如图1 所示。x，y，z 3 个相互垂直方向上的加速度由 G-Gell传感单元感知，电容值经过容压变换器转换为电压值，经过增益放大器、滤波器和温度补偿以电压的形式作为输出信号拉 J，经过放大滤波处理，将所需模拟信号调整至一个合适的范围，再转换为数字信号送数据处理单元。图四 加速度信号采集结构图加速度传感器与单片机的接口电路 MMA7260Q 与MC9S12XSl28B 的硬件接口电路如图 2 所示。微处理器内部包含完整的地输入缓存器、模拟开关电路、可编程增益放大器和 A/D 转换器以及数字滤波器，使用非常方便。G1，G2 输入低电平，灵敏度达到 800 mVg。当 Mode=l时，加速度传感器处于正常工作状态。x，y，z 输出端分别接 RC 滤波器，再通过高输出驱动运算放大器 TLV4112 构成电压跟随作用，输出稳定的直流电压信号。图五 MMA7260Q 与 MC9S12XSl28B 的硬件接口电路2.52.5 软件设计实现软件设计实现本设计采用 CodeWamor 软件与 BDM 作为调试工具，编程环境支持 c 语言和汇编语言的程序设计，大大方便了用户的程序设计，提高了系统开发效率。本设计程序代码使用 C 语言编写。图六 加速度程序流程图2.62.6 A/DA/D 采样流程设计采样流程设计本设计主要包括单片机初始化模块和实时路径检测模块。1）单片机的初始化模块包括：I/O 模块，AD 模块，定时中断模块初始化。2）实时路径检测模块：利用接受管，红外光电传感器和 CCD 摄像头检测特征信号，利用加速度传感器检测角度信号，将返回信号输入单片机的输入端口，程序不问断地读入输入端口的信号，结合判断语句，得出合适的 PWM 控制信号。图七 主程序与中断程序流程图2.72.7 实验测试实验测试图中曲线为时间和 AD 采集到的数据之间的关系。而 AD采集到的数据可以用来反映加速度的变化情况图八 装载于静止小车上时图九 装载于运动状态不变小车上时图十 小车角度变化时，加速度传感器值的变化规律通过测试可以看出。对于车体角度的变化，加速度传感器的值都有一定的变化。不过同时也看到车子的振动对加速度传感器也会产生一些干扰。在识别坡道时，如果加速度传感器监控的是竖直方向的加速度，即 z 方的加速度，那么在平道上时，明显竖直方向上加速度为零，在上坡后，如果忽略摩擦力，那加速度将变化为gsincos。通过加速度传感器中加速度的变化可以容易的辨别出平道和坡道。2.82.8 数字滤波算法设计数字滤波算法设计由于加速度传感器三轴之间差异和较高灵敏度，防止在运动过程中由于智能车的抖动引起的误差，对单片机采样得到的电压值进行归一化处理，最后可得到各方向传感器的相对电压值。具体实现方法：让智能车后轮转动起来，分别记录各传感器输出信号的最大值和最小值，用最大值减去最小值得到各传感器在运动过程中的输出范围。在智能车行驶过程中将各方向传感器输出的信号值减去最小值，再除以各方向传感器的输出范围即可得到其相对输出值。根据 g1=g2=0，最小值对应着-1.5g，最大值对应着+1.5g。，静止时各向加速度值为 0，加速度范围为-1.5g一+1.5g。2.92.9 路径识别规则路径识别规则X-T 表示智能车前后方向加速度信号，Y-OUT 表示智能车左右方向加速度信号，Z-T 表示智能车上下方向加速度信号采样值经过数字滤波，由于智能车的底盘不可能保持绝对水平，车身可能会向前倾斜或者向后倾斜，所以，Y-OUT，X-OUT，Z-OUT 值都有 5的误差，当处于匀速直线运动时，采样值在 100110 之间波动。通过加权平均近似为 105，125 对应+1.5g， 80 对应-1.5g。3 3 结束语结束语MMA 7260Q 是一种电容式加速度传感器，融合了信号调理，单极低通滤波和温度补偿技术。成本低，功耗低，测试中加速度信号稳定性与灵敏度都达到了预期的效果，从而提高了系统的控制精度，使舵机响应速度变快。基于三轴加速度传感器在智能车的控制与路径识别的设计，相比传统的路径识别具有数据处理简单，控制精度高的特点，使舵机响应变快。可以广泛应用与无人驾驶智能车，智能仪表，机器人等高端技术领域。