基于DSP的室内惯性导航系统设计

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

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

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

综上所述，本文将选用低成本的MEMS器件，结合DSP和卡尔曼滤波算法，能实现较高精度的轮式小车导航和定位。

1系统体系架构

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

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