西华大学毕业设计说明书 ② 具有131 LSBs/°/sec敏感度与全格感测范围为±250、±500、±1000 与±2000°/sec的3轴角速度感测器(陀螺仪)。
③ 集成可程序控制,范围为±2g、±4g、±8g 和±16g 的3轴加速度传感器。 ④ 移除加速器与陀螺仪轴间敏感度,降低设定给予的影响与感测器的飘移。
⑤ 自带数字运动处理(DMP: Digital Motion Processing)引擎可减少MCU复杂的融合演算数据、感测器同步化、姿势感应等的负荷。
⑥ 内建运作时间偏差与磁力感测器校正演算技术,免除了客户须另外进行校正的需求。 ⑦ 自带一个数字温度传感器。
⑧ 带数字输入同步引脚(Sync pin)支持视频电子影相稳定技术与GPS。
⑨ 可程序控制的中断(interrupt),支持姿势识别、摇摄、画面放大缩小、滚动、快速下降中断、high-G中断、零动作感应、触击感应、摇动感应功能。
⑩ VDD供电电压为2.5V±5%、3.0V±5%、3.3V±5%;VLOGIC可低至1.8V±5%。 ? 陀螺仪工作电流:5mA,陀螺仪待机电流:5uA;加速器工作电流:500uA,加速器省电模式电流:40uA@10Hz。
? 自带1024字节FIFO,有助于降低系统功耗。 ? 高达400Khz的IIC通信接口。 ? 超小封装尺寸:4x4x0.9mm(QFN)。
MPU6050芯片工作电路图如图4.10所示。
图4.10 MPU6050芯片工作电路图
MPU6050主要用于采集飞行器飞行时X,Y,Z三个轴上的加速度和偏转角速度。具体的讲,陀螺仪的测量物理量是偏转、倾斜时的转动角速度和坐标轴上的线加速度。
第 14 页
西华大学毕业设计说明书 MPU6050内部通过MEMS工艺做出了一个参考坐标系,当芯片随着飞行器动作时,芯片的坐标相对参考坐标发生旋转时,芯片会读出这个差异。经过芯片内部处理后,会输出一个绕坐标轴旋转的角速度。MPU6050芯片坐标轴分布如图4.11所示。
图4.11 MPU6050芯片坐标轴分布图
关于加速度的测量其实是当物体在加速过程中作用在物体上的力,这里需要注意的是在地球上任何物体都会受到地球给的重力,芯片也不例外,所以X,Y,Z坐标轴上测得的加速度包含了重力在三个坐标轴上的重力加速度分量。
第 15 页
西华大学毕业设计说明书
5软件设计
5.1软件设计原理及设计所用工具
上位机采用Lab windows制作。Lab windows是美国国家仪器公司推出的交互式C语言开发平台。可编写检测系统、数据采集系统等应用软件。用于数据采集分析和显示。软件界面如图5.1所示。
图5.1 Lab Windows界面图
STM32F407芯片使用C语言软件开发系统KEIL开发。KEIL提供了包括C编译器和功能强大的仿真调试等在内的完整开发方案。操作界面如图5.2所示。
第 16 页
西华大学毕业设计说明书
图5.2 KEIL操作界面图
5.2主要软件设计流程框图及说明
5.2.1串口中断流程图
无线数传模块连接在串口上,当串口有中断发生时,说明接收到上位机命令,需要处理串口数据。串口中断流程图如图5.3所示。
进入串口中断 接收中断数据 处理数据 串口标志位置1 结束
图5.3 串口中断流程图
第 17 页
西华大学毕业设计说明书 5.2.2外部中断流程图
GY-86飞控姿态模块的数据就绪中断连接在单片机外部中断的管脚上,当STM32F407接收到外部中断时,说明一组飞行器姿态数据已经就绪,需要进行姿态解算。外部中断流程图如图5.4所示。
进入外部中断 读取模块数据 姿态解算 DMP标志位置1 结束
图5.4 外部中断流程图
5.2.3主程序流程图
在主程序里,进行一系列初始化后就进入while大循环,在循环里主要做了通信数据处理,这是为了防止飞行器飞行角度过大导致飞行器侧翻问题,其次就是调整PWM波占空比调节无刷电机转速。主程序流程图如图5.5所示。
第 18 页
百度搜索“77cn”或“免费范文网”即可找到本站免费阅读全部范文。收藏本站方便下次阅读,免费范文网,提供经典小说综合文库基于STM32的四旋翼飞行控制系统毕业设计 - 图文(4)在线全文阅读。
相关推荐: