近年来，随着微电子技术、传感器技术、信号处理技术的迅速发展，以及新能源、新材料的广泛应用，使四旋翼无人飞行器的控制算法与工程应用得到了优化与创新。国防科技大学、上海交通大学等学者提出了基于Backstepping方法、自抗扰控制、滑膜技术的控制［1，2］。斯坦福大学的STAＲMAC工程研发的四旋翼飞行器系统具有可靠完全自主航点跟踪的能力，具备多飞行器协同飞行水平［3］。麻省理工学院无人机集群健康管理计划实现了通过地面操作实现多个无人机对动态环境感知、重建并规划飞行［4］。考虑到四旋翼飞行器具有非线性、多变量、强耦合等特点，要通过无刷电调控制4个无刷电机的转速来实现由4个输入量，6个自由度的欠驱动系统的控制［5］。在四旋收稿日期:2014—06—05*基金项目:浙江省科技厅公益项目(2012C21082)翼飞行器控制系统设计的过程中对飞行原理进行定性定量的分析，可以减少飞行实验平台的搭建时间，也可为电源模块、飞行控制模块的设计提供理论基础。为实现四旋翼飞行器的自稳控制，通过陀螺仪、大气压力传感器、三轴加速度传感器采集到的数据对飞行姿态进行解析，但是飞行时所产生的机体震动、温漂、零漂所带来的误差以及外界环境的干扰［6］，使位置姿态的估计与飞行高度的保持产生了较大的困难。对此，本文在飞行控制系统设计中对加速度传感器与陀螺仪融合使用，解析姿态数据的过程中使用卡尔曼滤波算法，不但有效地减弱了陀螺仪的温漂、零漂现象，还使得多传感器间的优缺点互补，提高了四旋翼飞行器的控制精度。
1飞行原理与机械结构
四旋翼飞行器的旋翼对称地安装在呈十字交叉的支架顶端，位置相邻的旋翼旋转方向相反，同一对角线上的旋翼旋转方向相同，以此确保了飞行系统的扭矩平衡［7］，如图1所示。四旋翼飞行器旋翼的旋转切角是固定值，因此，要通过调节每个电机的转速来实现六自由度的飞行姿态控制。增大或减少4个电机的转速来完成垂直方向上的升降运动，调节1，3旋翼的转速差来控制仰俯速率和进退运动，调节2，4旋翼的转速差来控制横滚速率和倾飞运动，调节2个顺时针旋转电机和2个逆时针旋转电机的相对速率来控制偏航运动。通过对飞行原理的分析，把可行性、低成本、易维护作为主要考虑因素，设计的样机如图2所示。机臂由镂空工程塑料材料PA66和30%玻璃纤维制成，质量相对较轻，强度大，对称电机轴距55cm，为保证水平起飞与平稳着陆，四旋翼飞行器底部安装起落架。电机旋翼等具体参数为:机体质量为857g;最大负载约为300g;机身高度为31cm;飞行时间约为8min。在整机安装过程中尽量保证重心在机械机构的对称中心，实际飞行实验证明了系统动力设备与机械结构的可行性。
2总体结构设计
四旋翼飞行器的硬件系统设计以飞控板为核心，搭载动力设备、电源模块与遥控模块。图3描述了以ATMEGA644P—AU为核心芯片搭载多传感器的飞行控制系统总体结构框图，整体系统利用11．1V锂电池供电，飞控与无刷电调以I2C总线数据传输来调节4个电机的转速;在遥控模块中，2．4MHz的控制信号通过PPM解码板与飞控板进行数据传输;在多传感器系统中，大气压力感器用于飞行高度检测，陀螺仪与加速度计的融合使用用于姿态解算。
3电源模块
四旋翼飞行器由2200MAh，11．1V，持续放电倍率30C锂电池供电，通过稳压电路的设计对不同电路进行供电，确保各模块正常稳定的工作。控制系统设计需要5，3V两种电平供电，电压转换电路如图4所示。由锂电池提供的11．1电压经两块7805稳压芯片后转为5V电压，一部分用于飞控板供电，一部分向预留的外部接口供电。经7805输出的5V电压经过2个MCP1700T稳压芯片输出3V电压，一部分供给控制系统的数字电路，一部分供给控制系统的模拟电路。330μF/25V电解电容器，10nF/16V钽电容器，贴片电容器的并联使用起到了防止电压抖动与滤波的作用。
4多传感器控制模块
为了准确地控制四旋翼飞行器的飞行姿态，需要在控制系统中加入不同的传感器，加速度传感器与三个陀螺仪来测量三轴加速度与角速度，大气压力传感器通过测量起始位置与飞行位置的气压差对飞行高度控制，为自主导航功能提供支持。大气压力传感器选择的是Freescale公司的MPX4250A，在该集成传感器芯片上，除具有压阻式压力传感器外，还有用作温度补偿的薄膜电阻网络，测压范围为20～250kPa，输出电压为0．2～4．9V，工作温度范围为－40～+125℃。电路如图5所示，可以根据压力的大小，通过控制P_1和P_2选择不同的放大倍数，提高采样的精度。LIS344ALH是一种低功耗、高性能、高精度的三轴加速度传感器，通过模拟输出为外部电路提供直接测量信号，加速度传感器的工作电压为2．2～3．6V，检测量程可以在±2gn或±4gn间选择。其中，VＲEF为通过稳压芯片MCP1700T转换为3V的稳定电压输入。应用电路如图6所示，选择100nF的贴片电容器作为VCC端的解耦电容，在输出端使用1μF的滤波电容减小噪声。考虑到振动误差无法通过加速度传感器进行补偿，因此，陀螺仪选型的过程中把机械性能作为重要的考虑因素，选择了可以在单芯片上实现完整单轴角速度响应的ADXＲS610陀螺仪传感器。3个ADXＲS610陀螺仪分别安装于垂直于机体坐标系的XYZ轴来实现系统三轴角速度的测量。
5实验与仿真
四旋翼飞行器在姿态解算时，陀螺仪传感器直接测量的是角速度，在积分得到角度的过程中随着时间的增长会产生累计积分误差，积分误差产生的原因一方面是积分时间，另一方面，由于自身的机械特性会产生零漂温漂等现象［8］。在陀螺仪的使用过程中融合加速度传感器，不仅为陀螺仪提供了绝对参考系，而且使加速度传感器优秀的静态性能与陀螺仪良好的动态性能相结合［9］，较好地抑制了外界干扰。数据经卡尔曼滤波算法处理后，可有效地降低数据噪声。图8为加速度传感器采样数据与卡尔曼滤波后的数据比较，可以明显地看到噪声信号减小了，但是仍有少量的扰动存在。图9的曲线表明了陀螺仪采集角速度数据存在零漂、温漂现象，当确定零漂为0．05°，静态输出电压为2．63V时，从波形图中可以观察到通过卡尔曼滤波处理后的积分数据平滑收敛，不但对零点漂移进行了补偿，而且对累计积-10-5051015角度/（°）012345时间/s卡尔曼滤波后的数据加速度计采集数据图8加速度计采样数据经卡尔曼滤波后的数据图Fig8DatadiagramofsamplingdatasofaccelerometerprocessedbyKalmanfiltering分误差，温漂有较好的抑制作用。-10-5051015角度/（°）012345时间/s卡尔曼滤波后的陀螺仪数据陀螺仪积分数据采集角速度数据。
6结论
本文从四旋翼飞行器的飞行原理入手，整合各个功能模块并通过对主要传感器的选型完成四旋翼飞行器控制系统的硬件电路设计，实现了飞行实验平台的搭建，多次飞行实验证明了硬件系统的可行性，达到了预期设计目标。在加速度传感器与陀螺仪的融合使用过程中，通过卡尔曼滤波算法对数据进行处理，有效地抑制了在硬件电路设计中无法避免的零漂、温漂等干扰因素，仿真结果证明了该方法的有效性。
作者:李运堂 单位: 中国计量学院机电工程学院
相关专题：2014中国直销企业名单 电商对传统行业的冲击
