基于MPU6050的INS惯性导航与实时姿态检测系统.docx

基于MPU6050的INS惯性导航和实时姿态检测系统 项目目标及功能说明 项目目标 学习使用正点原子探索者开发板，并熟悉开发板上的MPU6050六轴传感器的工作原理和各函数的调用过程。同时学习开发板的扩展接口，尝试在开发板上扩展蓝牙模块，并实现开发板与手机等含有蓝牙模块的电子设备通过蓝牙连接并进行数据的传输。在完成上述内容的基础上，实现将MPU6050六轴传感器的加速度计和陀螺仪的数据传送到手机上，在手机上实现陀螺仪的变化效果展示。同时通过串口将MPU6050数据传送到电脑上，通过Matlab编程处理数据，实现惯性导航的简单展示。 系统功能说明 系统最主要的功能有两个：一个是在手机端能够展示开发板上MPU6050陀螺仪的姿态变化，通过一个立方体的转动来表示陀螺仪的转动；另一个是在电脑端能够读取MPU6050的数据，并通过对数据的处理还原数据中存储的MPU6050的姿态变化，简单展现出惯性导航的效果。 在实现系统最主要的两个功能过程中，还需要实现一些基础功能。开发板能够通过蓝牙与手机连接并传输数据；开发板能够通过串口将数据发送出去；在电脑端能够读取开发板上串口输出的数据等。  需求分析 惯性导航系统用于各种运动机具中，包括飞机、潜艇、航天飞机等运输工具及导弹，然而成本及复杂性限制了其可以应用的场合。但是，存在一种情形： 卫星一旦突然因故障、敌方打击或干扰（如太阳风暴）等原因无法提供服务，这对依赖GPS、北斗等卫星导航系统作为唯一PNT（Position、Navigation、Time）信息来源的系统来说可能是致命的灾难。 作为目前为止卫星导航系统最好的备援——惯性导航系统（INS），将于届时发挥出巨大的作用，其精度完全可以媲美GPS等卫星导航系统。并且它不需要外部参考就可确定当前位置、方向及速度，从而使它自然地不受外界的干扰和欺骗。 定位、导航和授时服务对军队而言就像氧气对人类一样不可或缺，因此通过研究新机理、研制新设备、开发新算法，以摆脱人员和系统设备对GPS的依赖，具有极大的战略意义。 姿态监测系统可广泛应用于关键资产姿态变化的无线实时监控。由于目前移动智能终端设备的数量和质量逐步提升，因此，通过计算机上传统的上位机软件进行姿态监测，逐渐暴露出了自身的缺点——串口传输无法实现无线监测、计算机相比智能终端便携性极差。 因此，使用无线传输（蓝牙、红外、WIFI、GSM等）的技术，开发一款在移动智能终端可以实时显示物体姿态的应用，具有很高的实用价值和广泛的市场应用前景。  开发环境 移动终端操作系统： Android 4.4.4 KitKat 计算机操作系统： Windows 8.1 Pro x64 串口开发： MATLAB R2014a 开发板IDE： Keil uVision5 Android IDE： Eclipse Java EE IDE for Web Developers Android Development Toolkit 23.0. 4.1468518  项目进展情况 到目前为止，我组已实现了以下功能： STM32F4开发板上MPU6050六轴传感器的数据获取并显示在LCD屏幕上。 在LCD屏幕上绘出圆形图案，且圆形图案能根据MPU6050六轴传感器的姿态变化而运动，传感器倾斜角度越大，图案运动速度越快。 扩展蓝牙模块，能通过蓝牙模块与手机连接并进行数据通信。 根据函数提供的帧格式定义数据帧，并通过USART接口将数据帧传给PC端。 在手机端能根据蓝牙获取的MPU6050六轴传感器的陀螺仪数据绘出立方体，立方体能在可接受的时间延迟内实时展现MPU6050的姿态变化（转动方向和角度）。 在PC端能通过对从USART接口获取的数据帧进行解析获取MPU6050加速度传感器和陀螺仪的数据，并根据数据帧中设置的校验位进行数据校验。 在PC端能根据解析出的加速度传感器和陀螺仪数据，在可接受的误差范围内还原MPU6050的姿态变化（包括位移、转动方向和角度），实现一个简单的惯性导航系统。  系统设计 IIC总线工作原理 总线的构成及信号类型 I2C总线是由数据线SDA和时钟SCL构成的串行总线，可发送和接收数据。在CPU与被控IC之间、IC与IC之间进行双向传送，最高传送速率100kbps。各种被控制电路均并联在这条总线上，但就像电话机一样只有拨通各自的号码才能工作，所以每个电路和模块都有唯一的地址，在信息的传输过程中，I2C总线上并接的每一模块电路既是主控器（或被控器），又是发送器（或接收器），这取决于它所要完成的功能。CPU发出的控制信号分为地址码和控制量两部分，地址码用来选址，即接通需要控制的电路，确定控制的种类；控制量决定该调整的类别（如对比度、亮度等）及需要调整的量。这样，各控制电路虽然挂在同一条总线上，却彼