基于ARM处理器的无人飞行器飞控导航系统一体化设计

陈亚锋

（中国电子科技集团公司第二十七研究所，河南郑州450047）

摘要：为实现无人飞行器飞控导航系统功耗低、体积小、低成本、高集成度等目标，提出一种基于ARM 架构STM32F405微处理器和MEMS传感器芯片的无人飞行器飞控导航一体化控制系统设计方案。详细介绍了控制系统的原理、组成以及软硬件设计过程，并引入非线性鲁棒控制算法以提高控制系统的精度及抗干扰能力。仿真结果表明，采用非线性鲁棒控制算法的控制系统性能稳定，并且具有控制精度良好、鲁棒性较强等特点。

教育期刊网 http://www.jyqkw.com
关键词 ：无人飞行器；ARM微处理器；MEMS传感器；非线性鲁棒控制

中图分类号：TN967?34；V249 文献标识码：A 文章编号：1004?373X（2015）17?0093?04

0 引言

无人飞行器在军用和民用方面的需求日益增多，特别是小型无人飞行器，已经在侦察打击、航拍测绘、消防减灾、电力巡线、农林植保等诸多领域得以研究应用。无人飞行器种类繁多，从机体结构方面可以分为固定翼无人机、单旋翼无人直升机、共轴双旋翼无人直升机、多旋翼无人飞行器等构型。其中，多旋翼无人飞行器因其成本较低、尺寸较小、结构简单、控制灵活等特点，其研究及应用得到广泛关注。同时，多旋翼飞行器平台具有欠驱动、非线性、静不稳定等特点，对导航及控制算法设计要求较高[1]，是进行无人飞行器飞控系统设计、导航解算以及控制算法研究的理想平台。

由于小型无人飞行器具有较小的尺寸结构及重量，因此对飞行器飞控及导航系统尺寸、重量以及功耗的要求较为苛刻。通常无人飞行器飞控系统采用PC104[2]，DSP等微处理器作为主控计算机，尺寸重量较大、功耗较大、成本较高，并且由于所用处理器的处理能力有限，多采用导航计算机同飞控计算机相分离的设计方式[3]，人为增加了尺寸及重量。因此，将无人飞行器飞控与导航系统进行一体化设计是减小飞控系统尺寸、重量及功耗的有效手段，但一体化设计需要处理器有较高的主频及内存，对用于进行飞控与导航解算的处理器提出了较高要求。基于ARM Cortex?M4 内核的STM32F405 微处理器是一款具备高性能、低成本、低功耗要求的嵌入式微处理器，主频高达168 MHz，并且带有单精度浮点运算单元，可以进行复杂的导航姿态解算以及控制率计算等工作，使得飞控导航一体化设计成为可能。

本文以四旋翼无人飞行器平台为研究对象，利用基于ARM Cortex_M4内核的STM32F405微处理器和MEMS传感器组件设计无人飞行器飞控导航一体化控制系统，并引入非线性鲁棒控制算法，以提高控制系统的抗干扰能力。

1 系统组成及原理

作为小型无人飞行器经典构型中的一种，四旋翼飞行器由成对布置的电机、螺旋桨提供升力以及俯仰、滚转控制力，偏航由螺旋桨差动产生的反扭矩实现。飞控导航一体化控制系统主要由导航定位单元、惯性测量单元以及主控单元三部分组成。采用一体化设计思想，将三个单元组件集成到一块电路板上。其中导航定位单元由gps模块、磁传感器组成，外接GPS天线；惯性测量单元集成了具有较高性能的基于MEMS芯片的加速度计、陀螺仪模拟器件，并包含气压高度计；主控处理单元为STM32F405 微处理器，主要实现传感器数据采集、滤波处理、姿态解算、指令接收、控制律解算、通道分配、PWM输出以及状态信息发送等功能。

2 硬件设计

飞控导航一体化控制系统硬件电路是无人飞行器导航、控制功能实现的支撑和保障。控制系统采用集成化设计，其组成框图如图1所示，包含传感器组件、主控芯片、电子调速器组件以及电机等部分。其中，传感器组件主要包含导航定位单元及惯性测量单元，与主控单元芯片集成到同一块电路板上；电调组件及电机作为控制系统的执行机构分散布置到飞行器机体结构中，主要接收PWM控制指令，实现电机转速控制，完成飞行器各种飞行动作。

2.1 导航定位单元

为使无人飞行器能够实时获取当前位置、速度、航向等相关导航信息，并且可以沿着预定航线飞行，导航定位单元主要由GPS模块和磁传感器组成。

其中GPS采用U?Blox?6H模组，外接GPS天线，可以实现5 Hz定位数据输出。磁传感器芯片选用HMC5883，量程±3.5 gauss，可以实现三轴磁通量测量，采用I2C 总线输出。

2.2 惯性测量单元

惯性测量单元传感器组件为飞行器实时提供三轴角速度、三轴加速度等信息。主要使用到的传感器有测量线加速度的加速度计，测量角速度的陀螺仪。

为采集三轴加速度、三轴角速度，选用3 颗ADXRS620 单轴陀螺仪芯片，量程为±300 (°)/s；2 颗ADXL203双轴加速度计芯片，量程为±5 gauss。陀螺仪及加速度芯片采用正交排列的方式放置。由于陀螺仪及加速度芯片均为模拟量输出，需要通过A/D转换实现模拟量数字量转换。A/D 转换选用AD7689芯片，16位分辨率，可实现8通道的模拟电压采集，经SPI总线输出转换后的数字量。另外，为了能够实现飞行器定高，选用气压高度芯片MS5611，SPI总线输出。

2.3 主处理单元

主处理单元采用ST公司最新推出的基于ARM Cortex?M4内核的STM32F405微处理器。主频高达168 MHz，处理能力更强；增加了单精度浮点运算单元（FPU），通过内置单精度FPU 提升控制算法的执行速度；采用32 位多重AHB总线矩阵和多通道DMA控制器，支持程序执行和数据传输并行处理，有着较快的数据传输速度；增加了数字信号控制器（DSC）功能，可以替换只有整数运算能力的DSP产品。如上所述，STM32F405是一款具有较强数据处理能力以及数据传输能力的MCU，并且功耗极低，可以实现较为复杂的数据滤波、姿态解算等算法，使得飞控导航一体化设计成为可能。

STM32F405 微处理器采用10 个16 位定时器、2 个32位定时器可以实现多路PWM信号输出，满足飞行器多路电机或舵机的控制需求；1 MB flash存储器，192 KBSRAM，满足应用程序存储及运行所需；6个USART，3个SPI，3个I2C通信接口，满足与传感器、无线通信等设备的通信需求；另外，处理器内嵌2通道的12位DAC模块以及3 个12 位的ADC 模块，可以实现电池电压采集等功能。

3 软件设计

3.1 导航及姿态解算

卡尔曼滤波及互补滤波是导航及姿态解算中经常用到的滤波算法。其中卡尔曼滤波是一种最优化自回归数据处理算法，在计算机图形图像处理、姿态解算[4]、多传感器数据融合导航[5]等诸多场合得以应用。但是卡尔曼滤波参数较难确定，而且其计算量很大，对处理器的运算速度和精度有很高的要求。互补滤波算法相对卡尔曼滤波较为简单可靠，对惯性器件的精度要求较低，在飞行器姿态解算中的应用十分广泛[6]。

4 仿真计算

针对四旋翼飞行器数学模型设计相应非线性鲁棒控制器，并进行仿真试验。由于四旋翼飞行器为轴对称结构，俯仰与滚转通道控制效应相近，本文仅给出滚转通道的控制效果。为验证控制系统的鲁棒性，加入幅值为±0.2 rad/s的噪声信号。图4为滚转通道滚转角阶跃响应输出，为便于对比分析，分别绘出PID与NRC两种控制算法下滚转角响应曲线；图5为PID与NRC两种控制算法下滚转角速度曲线。可以看出，NRC 阶跃响应输出平缓，控制精度较高，并且相较于PID 对噪声干扰的抑制能力更强，对角速度噪声干扰的抑制效果更为明显，表明NRC具有良好的鲁棒性。

5 结语

本文采用基于ARM Cortex?M4 内核的STM32F405微处理器作为主控芯片，结合MEMS传感器及GPS模块设计无人飞行器飞控导航一体化系统，引入互补滤波进行姿态解算，并且采用航位推算算法提高GPS导航定位的更新频率，在保证导航及姿态解算精度的同时降低数据滤波的计算量。以四旋翼飞行器作为研究平台，采用非线性鲁棒算法作为飞行器姿态控制器，仿真计算表明，采用非线性鲁棒控制算法的飞行器飞控导航一体化控制系统相较于采用传统PID算法的飞控系统，具有良好的控制精度以及较强的鲁棒性。

另外，本文设计的飞控导航一体化控制系统经过控制参数适当调整、控制通道进行适当分配后可以作为一种通用型飞控导航一体化飞行控制器，应用于固定翼无人机、无人直升机等多种构型的无人飞行器平台中。

教育期刊网 http://www.jyqkw.com
参考文献

[1] 张垚，鲜斌，殷强，等.基于ARM 处理器的四旋翼无人机自主控制系统研究[J].中国科学技术大学学报，2012，42（9）：753?760.

[2] 顾冬雷，夏先明，高正.无人直升机飞控系统设计与应用[J].南京航空航天大学学报，2005，37（4）：476?478.

[3] 王伟，徐平，林德福，等.基于MCU和DSP的无人机控制系统设计[J].测试技术学报，2011，25（6）：494?498.

[4] WANG Shaohua，YANG Ying. Quadrotor aircraft attitude esti?mation and control based on Kalman filter [J]. Control Theory& Applications，2013，30（9）：1109?1114.

[5] MARTIN P，SALAUN E. Generalized multiplicative extendedKalman filter for aided attitude and heading reference system[C]// Proceedings of 2010 the AIAA Guidance， Navigation，and Control Conference. Toronto：AIAA，2010：423?428.

[6] 梁延德，程敏，何福本，等.基于互补滤波器的四旋翼飞行器姿态解算[J].传感器与微系统，2011，30（11）：56?59.

[7] POUNDS P，MAHONY R，CORKE P. Modelling and controlof a large quadrotor robot [J]. Control Engineering Practice，2010，18（7）：691?699.

[8] 王俊生，马宏绪，蔡文澜，等.基于ADRC的小型四旋翼无人直升机控制方法研究[J].弹箭与制导学报，2008，28（3）：31?40.

[9] BOUABDALLAH S，NOTH A，SIEGWART R. PID vs LQ con?trol techniques applied to an indoor micro quadrotor [C]// 2004IEEE International Conference on Intelligent Robots and Sys?tems. Piscataway：IEEE，2004：2451?2456.

[10] 李波波，贾秋玲.基于滑模控制的四旋翼飞行器控制器设计[J].电子设计工程，2013，21（16）：76?78.

[11] TORNAMBE A. A decentralized controller for the robust stabi?lization of a class of MIMO dynamical systems [J]. Journal ofDynamic Systems， Measurement， and Control， 1994， 116（2）：293?304.

[12] HU Qiong，FEI Qing，WU Qinghe. Research and applicationof nonlinear control techniques for quadrotor UAV [J]. Journalof University of science and Technology of China，2012，42（8）：656?663.