采用 STM32 设计的四轴飞行器飞控系统.pdf

采用STM32设计的四轴飞行器飞控系统 作者：常国权 关键字：STM32 四轴飞行器 1、引言 四轴飞行器是一种结构紧凑、飞行方式独特的垂直起降式飞行器，与普通的飞行器相比具有结构简单， 故障率低和单位体积能够产生更大升力等优点，在军事和民用多个领域都有广阔的应用前景，非常适合在 狭小空间内执行任务。因此四旋翼飞行器具有广阔的应用前景，吸引了众多科研人员，成为国内外新的研 究热点。 本设计主要通过利用惯性测量单元(IMU)姿态获取技术、PID 电机控制算法、2.4G无线遥控通信技术和 高速空心杯直流电机驱动技术来实现简易的四轴方案。整个系统的设计包括飞控部分和遥控部分，飞控部 分采用机架和控制核心部分一体设计增加系统稳定性，遥控部分采用模拟摇杆操作输入使操作体验极佳， 两部分之间的通信采用2.4G无线模块保证数据稳定传输。飞行控制板采用高速单片机STM32作为处理器， 采用含有三轴陀螺仪、三轴加速度计的运动传感器MPU6050作为惯性测量单元，通过2.4G无线模块和遥控 板进行通信，最终根据PID控制算法通过PWM方式驱动空心杯电机来达到遥控目标。 2、系统总体设计 系统硬件的设计主要分要遥控板和飞控板两个部分，遥控板采用常见羊角把游戏手柄的外形设计，控 制输入采用四向摇杆，无线数据传输采用2.4G无线模块。飞控板采用控制处理核心和机架一体的设计即处 理器和电机都集成在同一个电路板上，采用常规尺寸能够采用普通玩具的配件。系统软件的设计同样包括 遥控板和飞控板两部分的工作，遥控板软件的设计主要包括ADC 的采集和数据的无线发送。飞控板的软件 的设计主要包括无线数据的接收，自身姿态的实时结算，电机PID增量的计算和电机的驱动。整个四轴飞 行器系统包括人员操作遥控端和飞行器控制端，遥控端主控制器STM32通过ADC外设对摇杆数据进行采集， 把采集到的数据通过2.4G无线通信模块发送至飞控端。飞控板的主要工作就是通过无线模块进行控制信号 的接收，并且利用惯性测量单元获得实时系统加速度和角速度原始数据，并且最终解算出当前的系统姿态， 然后根据遥控板发送的目标姿态和当姿态差计算出PID 电机增量，然后通过PWM驱动电机进行系统调整来 实现飞行器的稳定飞行。系统的总体设计框图如图1所示。 图1 系统总体设计框图 2、四轴飞行器的硬件设计 2.1主控单元选择 从成本和性能综合考虑，飞控板和遥控板的主控单元都采用意法半导体公司的增强型高速单片机 STM32F103作为主控的，STM32F103是基于的ARM 32位的Cortex-M3 内核架构，稳定工作频率可达72MHz， 是一个具有丰富资源、高速时钟的精简指令的微处理器。STM32F103拥有从64K或128K字节的闪存程序可 选存储器，高达20K字节的SRAM，2个12位模数转换器多达16个输入通道，7通道DMA控制器，多达80 个快速I/O端口，串行单线调试(SWD)和JTAG接口调试模式，多达7个定时器，多达2个I2C接口(支持 SMBus/PMBus)，多达3个USART接口(支持ISO7816接口，LIN，IrDA接口和调制解调控制)，多达2个SPI 接口(18M位/秒)，CAN接口(2.0B主动)，USB2.0全速接口。主控单元原理图如图2所示。 图2 主控单元原理图 2.2 飞控板电路设计 飞控板的核心设计是MPU6050测量传感器、NRF2401无线模块以及飞控板电机驱动等模块的设计。飞控 系统的惯性测量单元采用MPU6050作为测量传感器，MPU6050 的驱动方式采用IIC接口，时钟引脚SCL连接 到STM32 的PB10，数据引脚连接到STM32 的PB11 引脚，数据中断引脚连接到PB5，为了增强驱动能力在每 个引脚上都加入了 10K的上拉电阻，原理图的设计如图3所示。 图3 飞控板惯性测量单元原理图 相对于其他模块电系统也是比较重要的部分，飞控系统采用3.7V高放电倍率锂电池进行供电。主控芯 片供电部分和IMU传感器部分采用各自独立的LDO进行供电，这样确保了系统的稳定性和IMU传感器数据 采集的准确性，稳压直流电源模块的原理图设计如图4所示。 图4 飞控板电源稳压原理图 飞控板与遥控板数据的通信同样采用的是基于2.4G频段的NRF2401模块，确保了数据的稳定传输。 STM32的SPI1外设对2.4G模块进行