四旋翼直升机飞行控制系统设计

四旋翼直升机飞行控制系统设计

四旋翼直升机具有4个呈交叉结构排列的螺旋桨，其独特的构型能够满足复杂环境中的任务需求。文中设计了一种四旋翼直升机飞行控制系统软硬件方案，通过传感器实时采集四旋翼的姿态、高度、位置等信息，采用PID算法设计飞行控制律，以ARM Cortex—M3内核高性能单片机作为主控制器。最后采用CVI开发的地面站软件实现在线数据采集与调参，并通过实际飞行验证了本方案的可行性与稳定性。

四旋翼飞行器(Ouadrotor，Four-rotor，4rotors helicopter，X4-flver等)是一种特殊构型的电动可遥控微型飞行器，它是由4个螺旋桨驱动，通过4个螺旋桨的差速来完成姿态控制。四旋翼飞行器与其他类型的无人机相比具有许多优点，其中主要是其可垂直起降及机动性强等性能，能够适应各种复杂环境。因此四旋翼飞行器在民用产品、军事武器等各方面有着广泛的应用前景。文中将介绍四旋翼飞行器控制系统的软硬件设计方案与实现。

1飞行控制系统总体设计

四旋翼飞行器控制系统的设计主要包括主飞行控制板和相关外围电路，结合惯性传感器、超声波传感器、GPS接收机、无线数传模块，并配套自行开发的地面站软件设计实现一套完整的四旋翼飞行器自主飞行控制系统。

四旋翼飞行器飞行控制系统的开发内容主要包括：飞控板及外围电路设计，传感器底层驱动开发，PWM控制信号的混控输出，飞行控制律程序设计以及地面站软件的设计与开发。

飞控系统的总体设计方案如图1所示。系统核心控制器为一款基于ARM cortex—M3内核的单片机；惯性测量元件(IMU)主要提供解算飞行器姿态的数据等信息；高度传感器采用超声波传感器，输出相对地面的高度信息；接收机接收遥控器发出的杆量信号，这些信号将用于控制器的输入；GPS接收机输出飞行器的位置信息；无线数据传输模块用于飞行器与地面站的数据通信。传感器信息经过飞行控制律的运算处理，最终通过PWM信号输出至电子调速器，用来控制四个电机的转速，以实现姿态、位置与高度的控制。地面通过无线数传实时传回飞行器信息用以检测飞行器飞行状态，同时地面站也可以向飞行器发送控制指令。

图2四旋翼飞行器机架

四旋翼飞行器的机架选用了市面上做工比较好的Xaircraft-650，其优点是各个组件采用模块化设计，方便拆卸和损耗更换，同时较高的起落架设计方便在飞行器底部搭载相关传感器设备。四旋翼飞行器的机架如图2所示。

2飞控系统硬件设计

2．1飞控核心板设计

飞控板的主控芯片选用意法半导体公司的ARM Cortex—M3内核的单片机STM32。其功

耗低，最高工作频率72MHz，拥有512K字节的闪存程序存储器和高达64K字节的SRAM，最多可达112个快速I／O端口，多达4个16位定时器，5个USRAT、3个SPI、2个I2C、1个CAN、1个USB2．0全速接口。具有优异的实时性能，同时拥有丰富而规范的固件库，适合飞控板的开发。

图3最小系统电路设计

飞控板采用最小系统加全部接口引出的设计，即保证系统能够正常工作的前提下，引出所有扩展接口以方便后续实验开发的功能扩展。主控芯片STM32F103的最小系统原理电路设计框图如图3所示，由于主芯片需要3．3V电压供电，所以采用稳压芯片产生3．3V电压，还需加电容对稳压后的电压进行滤波。在保证正确供电和正确接地的同时，需外加两个晶振电路。其中8M晶振作为系统外部时钟，起振后为系统提供时钟信号：32．768K晶振主要用于系统的实时时钟RTC电路；引出所有引脚以供扩展之用，同时设计了外部复位电路。

2．2传感器数据采集及通信接口设计

2．2．1组合导航系统数据采集

组合导航系统采用了惯性导航与全球卫星定位系统(GPS)相结合的方案，二者能够弥补相互的不足，为无人机提供可靠性好，自主性和精确度高的导航信息。其中惯性导航系统选择了基于MEMS技术的惯性传感器，结合卡尔曼滤波算法和四元数法及三轴磁力计温度补偿进行姿态解算和估计。传感器的输出为数字信号，通过串口发送数据。由于STM32片内集成串口，因此设计RS232电平与TTL电平转换电路以实现数据通信。电平转换电路采用MAX232芯片，电路如图4所示。

2．2．2超声波传感器

用于测量高度的超声波传感器采用SensComp公司的615088传感器，它具有两种模式：触发测距模式和5Hz自动测距模式。测量范围：0．15～10．7m，测量精度：0．1％。

STM32采用捕获中断方式测得超声波发送的边沿跳变信号与经障碍物反射回来的超声波边沿跳变信号，做差换算得到超声波模块与障碍物的距离。实测在0．2～10m范围内的距离，其测距误差不超过0.1％，满足四旋翼飞行器飞行的精度要求。

2．2．3无线数传模块

本设计方案所选用的无线数据传输模块有TTL、RS232、RS4853种接口，同时配有USB 转，TTL模块，在开阔地的传输距离可达800m。飞控系统主控芯片通过无线数据传输模块与上位PC机进行通信，传送由传感器获得的飞行数据到上位PC机以实时监测飞行状态，同时上位PC机也可以向飞行器传送飞行控制指令及相关参数。

2．2．4PWM信号的采集与输出

由于四旋翼飞行器的飞行完全依靠四个电机的转速变化来控制，其不同于固定翼飞机的是滚转、俯仰、偏航以及油门通道均需要通过4个电机联动才能实现对四旋翼飞行器的控制。因此，需要在油门通道控制信号的基础上叠加其余3个通道信号，混控合成之后的四路信号分别输出至4个电子调速器对各个电机加以控制。

根据四旋翼姿态控制的原理，定义4个电机序号以及机体轴系如图5所示。

图5电机序号以及机体坐标系定义

根据上述分析，电机控制信号混控公式如式(1)所示：

其中△φ=φ-φmid，△θ=θ-θmid，△ψ=ψ-ψmid。M1，M2，M3，M4分别表示电机1～电机4的控制信号，T表示油门通道控制信号，φ表示滚转通道控制信号，θ表示俯仰通道控制信号，ψ表示偏航通道控制信号，φmid、θmid、ψmid分别表示滚转、俯仰、偏航通道控制信号的中立值。

3飞控系统软件设计

3．1地面站软件设计

为方便监测四旋翼飞行状态，利用CVI软件设计开发了地面PC机惯导数据采集界面，如图6所示。地面PC机通过无线数据传输模块实时接收四旋翼飞行数据，通过该界面显示四旋翼三轴姿态角，加速度，角速率，经纬度及GPS速度等信息，并实时绘制出三轴姿态角曲线。