四旋翼飞行器嵌入式陀螺仪数据采集设计

《四旋翼飞行器嵌入式陀螺仪数据采集设计》由会员上传分享，免费在线阅读，更多相关内容在学术论文-天天文库。

1、四旋翼飞行器嵌入式陀螺仪数据采集设计摘要本文以创新开发套件的小型四旋翼飞行器为实际对象，通过对陀螺传感器L3G4200D采集原始数据以及整合三轴加速度计LIS3DH的一段经过测试的配置信息，用于配合运行控制算法和处理从惯性导航系统传输过来的姿态信息。通过多次调试控制算法，进行多次飞行试验，该芯片配置数据可以有效满足稳定飞行数据采集的功能。【关键词】四旋翼飞行器STM32F103陀螺传感器L3G4200D加速度计LIS3DH1引言四旋翼飞行器是一种能够实现垂直的起降，并在空屮可以随时通过调整飞行姿态來改变飞行方位的飞行器。四旋翼飞行器利用旋翼转向在前后与左右的反相，

2、来抵消反扭力矩，从而保持机体的平衡。在现实应用中，由于小型多旋翼飞行器具有其它飞行器所无法比拟的优势，因此其在现代社会诸多领域得到广泛应用，包括摄影航拍、电网线路巡检、环境保护监测、农林施肥作业等。目前四旋翼飞行器主要分为遥控器进行的遥控型和自主控制的自主飞控型两种。针对四旋翼飞行器控制技术的主要集屮在两大热点研究领域：一个是基于惯性导航的自主控制系统，另外一个是基于视觉飞行的自主控制系统。2嵌入式陀螺仪数据采集的实现为了实现四旋翼飞行器在空中自主、持续飞行，同时可以保证飞行过程中的姿态稳定和平稳飞行。本文采用一套自主开发基于STM32F103主控的飞行控制系统对

3、陀螺传感器L3G4200D采集原始数据部分进行设计，整套控制系统主要分为姿态控制系统、加速度控制系统和高度控制系统，控制系统均搭载在硬件平台上。2.1飞控硬件平台总体设计四旋翼飞行器的硬件平台主要分为两大部分，第一部分是惯导平台的电路设计，它是采集飞行器机体的运动状态信息的作为控制系统控制的重要的信息依裾。惯导平台的反馈精度直接影响到控制系统的控制精度。第二部分是主控芯片的电路设计。惯导平台本文选取陀螺传感器L3G4200D,它是一种低功率的三轴陀螺传感器，采用专门微细加工工艺制造，通过TC接口技术构成一个CMOS型的专门电路并留有数字接门(I2C/SPI),可以

4、更好地跟传感器元件匹配。陀螺传感L3G4200D器硬件电路图如图1所示。硬件电路设计的重点在于芯片的输入电压及SF>I总线的供电电压均为3.3V和陀螺传感器与姿态处理芯片的SPI通信。加速度计选取的是LIS3DH,是一款低功率的三轴加速度计。主控芯片和姿态处理芯片？用的是STM32F103,进行飞行控制和姿态信息的处理。姿态控制系统采用基于神经网络的PID控制飞行器的姿态角，整个系统采用改进型负反馈结构。2.2飞行器系统的软件设计本文的四旋翼飞行器的软件系统主要完成飞控主板和PC端无线遥控部分的程序设计，软件程序是在集成编译环境KeilMDK-ARM下由C语言编程

5、实现。飞控主板程序设计流程图如图2所示，主要操作包括首先开机对无线模块、L3G4200D、LIS3DH以及PWM电机等进行初始化，再对整个系统的惯性测量单元IMU进行零偏调整，然后设置无线接收模块等待对解锁输入信息的判断，最后如果解锁成功，则对IMU读取出来的简单的加速度、陀螺仪角速度的原始数裾作处理得到本系统想耍得到姿态角度，从而进行PID电机控制，并通过飞控板上ADC实时获取板上供电电压参数以便于自动返航情况处理。其中L3G4200D初始化及数据采集操作主要有：寄存器配置、数据输出速率配置、工作模式设置、三维坐标轴采集参数设置、高通滤波器使能启动和数据量程设定

6、等。飞控程序屮使用定时器屮断的方式对时间进行处理，每0.5ms屮断一次，通过对中断标志位的查询结合不同时间的间隔来分别处理优先级不同的任务，每次中断后立即检查无线模块的接收数据，确保飞控主板控制信息的实时性。每2次屮断即1ms获取一次IMU单元的原始数据并作滤波处理获得较为准确的系统加速度、角速度的当前数据。每4次中断即2ms测量并计算当前飞控主板的运动姿态，与PC机遥控端的冃标姿态一起求取差值再通过PID控制算法对各个电机进行PWM调速控制。每200次中断即100ms,飞控系统由STM32H03的ADC通道采集一次主板供电电压，并把供电电压实时参数返送给PC端。

7、PC端无线遥控部分的程序功能就是把遥控端的操作动作转化成信号传给飞控主板，并且实时显示PC端当前所执行的控制信息和飞控主板返送的飞行姿态及供电电压参数等信息。2.3系统运作过程使用PC机发送控制指令，发送到机体的飞控板STM32_C0NTR0L上。飞控板通过接收姿态处理板的运动状态信息和PC机的控制指令进行控制算法的处理，得出控制要求的PWM波。PWM波经过电调的处理产生出占空比符合PWM波的电压信号输入四个电机。根据电压的变化，电机的转速变化引起机体的姿态信息的变化。陀螺仪和加速度计组成的捷联式惯性导航系统，用计算机把测量信号变换为导航参数，测量机体的姿态信息，

8、陀螺仪测出