，保持PWM输出不变，测量电池电压与主桨实际升力值，得到该PWM输出下电池电压与主桨实际升力之间关系的主桨电池电压-升力曲线;然后将多组不同HVM输出下得到的主桨电池电压-升力曲线进行拟合，得到补偿参考曲面；
[0032]在实际飞行过程中，实时采集得到对应时刻的主桨动力电池电压值，第2部分理想升力值即为PWM输出，查找补偿参考曲面，得到该PWM输出和该主桨动力电池电压值所对应的主桨实际升力值，即为第2部分实际升力值，从而使主桨产生的实际升力在电池电压变化过程中保持稳定。
[0033]本发明提供的应用于微小型飞行器的多动力融合飞控系统以及方法具有以下优占.
[0034](1)采用主桨、姿态桨和偏航桨的布局方式，通过主桨提供主要升力;通过姿态桨提供次要升力，由于通过主桨和姿态桨共同提供飞行器飞行所需升力，因此，可有效降低在飞行过程中姿态桨负荷，从而有效的提升飞行器动力系统效率，提升飞行器续航时间。
[0035](2)对飞行器多套动力系统进行融合控制，解决了该飞行器主桨升力不稳定以及主桨反向扭矩平衡的问题，最终实现该新布局多旋翼飞行器的自主飞行。
【附图说明】
[0036]图1为本发明提供的多动力融合飞控系统所对应的飞行器的布局示意图；
[0037]图2为本发明提供的多动力融合飞控系统的硬件结构示意图；
[0038]图3为本发明提供的多动力融合飞控方法的原理示意图；
[0039]图4为本发明提供的飞行器姿态控制模块的工作原理图；
[0040]图5为本发明提供的飞行器飞行高度控制模块的工作原理图。
【具体实施方式】
[0041]为了使本发明所解决的技术问题、技术方案及有益效果更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。
[0042]本发明公开了一种应用于微小型飞行器的多动力融合飞控系统，包括硬件部分和软件部分。该多动力融合飞控系统具有三套动力系统，分别为偏航桨动力系统、姿态桨动力系统和主桨动力系统;其中，主桨动力系统与主桨连接，主桨采用大尺寸、高效率主桨，用于产生主要升力，提高全机飞行效率，使其达到更长的续航时间;姿态桨动力系统与桨态桨连接，用于产生飞行所需次要升力并维持飞行器姿态稳定，并配合主桨进行必要机动;偏航桨动力系统与偏航桨连接，用于抵消主桨的反向扭矩，保持飞机航向稳定。本发明所设计的多动力融合飞控系统，对三套动力系统进行融合控制，解决了飞行器主桨升力不稳定以及主桨反向力矩平衡等技术问题，使其实现稳定控制，并可以进行自主飞行;此外，还有效提高了飞行器飞行效率，保证飞行器长期稳定飞行。
[0043]结合图1和图2，本发明提供一种应用于微小型飞行器的多动力融合飞控系统，包括飞控计算机、飞行参数传感器、PID控制器、偏航桨动力系统、姿态桨动力系统和主桨动力系统；
[0044]其中，飞控计算机采用意法半导体的STM32F427处理器，该处理器带有浮点运算单元，能对大量传感器数据进行快速运算，计算精度高，能提高姿态解算水平和控制输出精度。此外，该处理器还集成了丰富的外设接口，方便了传感器的数据传输。
[0045]飞行参数传感器包括:陀螺仪、加速度计和气压高度计，用于全面采集飞行器实时飞行参数，可均采用MEMS传感器，极大减小飞控系统的重量和尺寸。其中，陀螺仪使用MPU6050，可以以数字方式输出6轴或9轴旋转矩阵、四元数、欧拉角格式的姿态融合演算数据。气压高度计使用高分辨率的MS5611，具有温度补偿功能，使分辨率达到10cm。
[0046]主桨动力系统用于为主桨提供动力，主桨指布设于飞行器中心位置的螺旋桨；
[0047]姿态桨动力系统用于为姿态桨提供动力，姿态桨即为俯仰/滚转螺旋桨，每个姿态桨唯一对应一个姿态桨动力系统;姿态桨的设置数量为多个，其布置方式为:从飞行器中心位置向外发散状延伸出若干个机臂，在每个机臂的末端设置一个姿态桨；
[0048]偏航桨动力系统用于为偏航桨提供动力，每个偏航桨唯一对应一个偏航桨动力系统;偏航桨的设置数量为多个，其布置方式为:对于位于同一直线的两个机臂，分别记为第1机臂和第2机臂，分别在第1机臂和第2机臂的对称位置安装一个偏航桨；
[0049]在图1中，主桨用数字1表示;姿态桨用数字2表示;偏航桨用数字3表示;在图1中，共有1个主桨，4个姿态桨和2个偏航桨。
[0050]通过采用上述主桨、姿态桨和偏航桨的布局方式，通过主桨提供主要升力;通过姿态桨提供次要升力，由于通过主桨和姿态桨共同提供飞行器飞行所需升力，因此，可有效降低在飞行过程中姿态桨负荷，从而有效的提升飞行器动力系统效率，提升飞行器续航时间。另外，通过偏航桨的设置，抵消主桨产生的扭矩，保证飞行器正常稳定的运行。
[0051]飞行参数传感器的输出端连接到飞控计算机的输入端，飞控计算机的输出端通过P ID控制器分别连接到偏航桨动力系统、姿态桨动力系统和主桨动力系统。
[0052]可见，本发明中，飞控计算机根据实际飞行参数，实时分别对偏航桨、姿态桨和主桨进行控制，可保证飞行器长期稳定的运行，具有高飞行效率。
[0053]另外，实际应用中，飞控计算机还连接有GPS定位装置和存储器。存储器可采用SD卡，可对飞行器的飞行日志进行记录，通过飞行日志中的数据，可以对飞行器的飞行过程进行回放，同时可以为参数调整提供依据。
[0054]GPS定位装置采用功耗低、精度高，支持多种导航系统的定位装置，使用I2C方式与飞控计算机进行通信，提供飞行器当前位置信息，为飞行器导航提供参考。
[0055]飞控计算机还通过数据通信装置与地面站连接。
[0056]数据通信装置将飞行器的各项数据通过UART接口进行无线传输，由地面站接收并进行处理。
[0057]实际应用中，飞行参数传感器、GPS定位装置、存储器和数据通信接口集成在1块PCB板上。
[0058]目前，常规多旋翼飞行器多采用多个相同动力系统驱动，且各个动力系统均布在机身周围。而本发明提供的新布局设计的多旋翼飞行器，在中心位置设置了主桨提供主要升力，在机臂侧面设置偏航桨平衡主桨的反向扭矩，采用非对称结构且具有多套动力系统。本发明针对该新布局多旋翼飞行器设计了一种多动力融合的控制算法，利用飞控计算机，对各个传感器的数据以及操作手的遥控指令进行融合计算，得到各个动力系统的输出量，实现对飞行器的稳定控制。
[0059]多动力融合控制算法主要由传感器、飞控计算机以及动力系统等部分组成。由各个传感器可得到飞行器当前的高度、姿态、角速率等信息，数据接收模块用于将操作手的遥控指令转换成控制信息，如俯仰、滚转、偏航、油门等，飞控计算机将各个传感器的数据以及遥控器控制指令进行融合计算。
[0060]具体的，如图3所示，为多动力融合飞控方法的原理示意图，基本思路为:所述多动力系统融合控制算法对飞控系统提供的传感器数据以及操作手发出的遥控指令进行数据融合，计算出各套动力系统各自对应的控制量，然后各套动力系统对飞行器的姿态和位置进行调整，实现飞行器稳定控制。
[0061 ]多动力融合飞控方法包括以下步骤:
[0062]步骤1，在微小型飞行器飞行过程中，飞控计算机实时接收飞行参数传感器采集到的实际飞行参数信息；其中，实际飞行参数信息包括飞行器实际姿态信息、飞行器实际飞行高度信息以及飞行器实际角速率信息；
[0063]另外，飞控计算机