基于惯性传感器的室内惯性导航与定位系统※＊

2015-07-03黄洪加

单片机与嵌入式系统应用 2015年2期

黄洪加

（广东工业大学自动化学院，广州510006）

引言

轮式遥控机器人已经在地震、火灾等一些危险的室内区域进行救援和探测，或执行反恐任务。由于在这些特殊的环境下存在诸多未知因素，且室内无GPS信号，人们不得不依靠先进的科学技术和仪器来获取遥控机器人小车的导航信息。但是，目前轮式运动小车主要采用的导航传感方式有视觉、光电、超声、里程计等，比较容易被外界环境干扰，不能满足广大市场的需求。

但是惯性导航装备安装在运载体内，工作时不依赖于外界信息，也不向外界辐射能量，不容易遭到干扰，是一种自立式导航系统，优于常见的导航传感方式。并且近年来MEMS（微机电系统）结构的惯性传感器随半导体技术的进步得到了迅速发展，低成本而高精度的期望得到了实现。MEMS惯性传感器组成的惯性导航装置结合轮式小车的里程计，能够产生导航和定位信息，减少对外部环境的依赖，实现在外部环境条件（例如光照、墙壁材质）未知情况下的导航。

由于是在室内区域进行勘测搜索，小车的运行特点与飞机、船、车不同，它的运动轨迹变化较快，且运动时存在一定的振动，因此常用的卡尔曼滤波算法需要改进才能应用。惯性传感器采集数据量大，且进行惯性导航时需要大量的浮点运算，因此本项目采用了具有强大数字信号处理功能的DSP芯片TMS320F28335和PC控制终端，实现惯性传感器的数据采集、时序逻辑控制、与驱动系统通信和地图显示功能，具有体积小、成本低、功耗低等优点。

1 系统体系架构

本文的目标是研制一个轮式小车惯性导航系统，能够通过WiFi实现PC终端或手持终端控制轮式小车行动以及小车所采集数据的传输。

搭建如图1所示的系统，TI公司的浮点DSP芯片TMS320F28335采集各MEMS惯性传感器的信号并处理，处理结果通过 WiFi输送到PC终端；PC终端负责定位结果显示和地图显示，并向小车驱动系统发送控制命令，同时接收驱动系统反馈的里程计信息。

图1 系统总体架构

2 硬件设计及详细实现

硬件设计上，主要分为核心板和驱动板。核心板包括DSP最小系统、JTAG下载口设计、电源供给电路、MEMS传感器和WiFi模块等。而驱动板主要设计的内容是直流大电机的驱动模块。

2.1 核心板设计

TMS320F28335工作时需要的电压不同：内核电压1.9 V，I/O供电电压3.3 V，所以电源部分利用两路输出电源器件TPS767D318来实现，如图2所示。同时根据仿真实验和实际焊接电路的测试，电源模块输出端最好使用电容值不小于10μF的保护电容，且不能使用贴片电容，否则工作不稳定。

图2 DSP电源设计

在电源设计中，考虑到TPS767D318芯片可以产生复位信号，所以在核心板上并没有另外为DSP设计复位电路。

图3为JTAG下载电路，按照仿真器的通信引脚选择14脚的仿真接口，同时要注意EMU0和EMUl信号必须通过上拉电阻连接至电源，其中上拉电阻为10 kΩ。

2.2 小车驱动板设计

在本装置中，采用BTS7960作为直流电机驱动芯片。BTS7960是集成的大电流半桥驱动，其内部包含了一片NMOS、一片 PMOS和一片半桥门集驱动，在IOUT＝9 A，VS＝13.5 V，Tj＝25℃时，其内阻抗为17 mΩ。装置采用两个直流大电机，图4为驱动单个电机前后转向的电路图。

图3 JTAG下载电路

图4 驱动模块电路设计

电机驱动中，需要注意一个细节，就是电机在转动过程中有可能会产生反向的电动势，使电流一瞬间过大，导致单片机复位甚至有可能烧坏芯片。因此在设计过程中，可以考虑在单片机PWM输入到电机驱动接口的地方添加光耦器件或者二极管隔离。如图5所示，驱动板选择了TLP521-4光耦器件设计隔离电路，减小了电压的干扰，简化电路的设计，同时也把4路PWM的I/O电平从3.3 V上拉到5 V。

3 软件设计及具体实现

在软件程序设计上，主要应用9自由度惯性导航传感器（ITG3200＋ADXL345＋HMC5883L），结合DSP和卡尔曼滤波算法，实现较高精度的轮式小车导航和定位。

3.1 传感器程序设计

图5 TLP521-4隔离电路

9自由度惯性导航传感器在许多领域都得到了实际应用，如无人机、救灾机器人等。它包括ITG3200三轴陀螺仪、ADXL345三轴加速度传感器和HMC5883L三轴磁感应传感器，可以得到角速度、加速度以及角度的实时数值。

ITG3200是MEMS三轴陀螺仪，可以测量小车的旋转角速度，同时也可以通过积分把角速度转换为小车的倾角。ITG3200的初始化程序略——编者注。

其具体功能实现可以在主程序中通过SCI读取其值。所读取的值为角速度，不会受到小车运动的影响，因此信号噪声很小，同时可以由它积分得到小车倾斜角度，从而平滑信号使其更加稳定。

由于装置在不同的室内区域进行勘测搜索，再加上未知的环境，所以角速度信号可能存在一定的偏差，导致积分后的角度出现大的误差，无法得到实际的数值。为了消除由于偏差而产生的累积误差，装置上加上ADXL345三轴加速度传感器对于获得的角度信息进行校正。ADXL345初始化程序略——编者注。

通过ADXL345所得到的角度，与陀螺仪积分后的角度进行对比，然后使用它们的偏差改变陀螺仪的输出，从而使积分后的角度慢慢校正到实际值，如图6所示。

HMC5883L三轴磁感应传感器的作用相当于罗盘，在水平情况下，无需借助其他传感器便可以计算出航向。其初始化程序略——编者注。

由于装置是要在不同环境下进行工作的，所以其并不能保持时刻是水平的，就需要加速度传感器来纠正由于倾斜引起的误差。

图6 通过加速度传感器校正角度

3.2 卡尔曼滤波算法应用

由于装置在室内区域进行勘测搜索，它的运动变化快，轨迹不定，而且要适用于不同的环境，因此常用的卡尔曼滤波算法需要进一步改进才能应用。卡尔曼过滤算法是用前一个估计值和最近一个观察数据，来估计信号的当前值，它是用状态方程和递推的方法进行估计，解也是以估计值形式给出的。其运用在加速度器和陀螺仪上的卡尔曼滤波程序略——编者注。

通过滤波时数据平滑将加速度输出电压附近产生的波动噪声滤掉。