一种多旋翼无人机控制量分配方法组成比例

本发明专利技术涉及种多旋翼无人机控制量分配方法，包括，获取无人机正常工作状态下每个电机允许转速的最小值和最大值，为每个电机i建立转速与控制变量的关系；基于电机驱动方向与无人机机头方向的夹角构造控制矩阵；基于无人机的高度控制量、横滚角控制量和俯仰角控制量建立控制量向量，通过控制矩阵与控制量向量的乘积获得由n个电机的控制变量构成的控制变量向量；通过无人机的控制量优化控制变量向量，基于优化后的控制变量向量控制多旋翼无人机的飞行状态。本发明专利技术将各通道的控制量叠加之后，对控制量进行有效的再分配，减轻电机的饱和负担，充分利用未饱和电机的能力，从而在一些极限情况下也能够保证多旋翼飞行的性能和安全。和安全。和安全。

【技术实现步骤摘要】
一种多旋翼无人机控制量分配方法


[0001]本专利技术涉及多旋翼无人机
，尤其涉及一种多旋翼无人机控制量分配方法。

技术介绍

[0002]目前大部分多旋翼无人机通过动力分配矩阵将多旋翼各个通道(俯仰、横滚、航向、高度)的控制量叠加起来，然后将最终的控制量输入到各个电机上实现稳定飞行。例如公开号为CN107368091A的专利技术专利申请公开了一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法，通过飞行器实时的方位和姿态数据，基于微分思想分解控制过程，确定各电机的控制量。该方法虽然能够实现多旋翼无人飞行器的控制量分配，但在实际飞行过程中，考虑到飞行性能和动力的局限性，输入给动力系统控制量有一定的上限和下限，因此在某些情况下，给到某个或某些电机的控制量过大或过小会超过限幅，从而无法起到较好的控制效果甚至导致失控。

技术实现思路

[0003]本专利技术要解决的技术问题在于针对现有技术中的缺陷，提供一种针对多旋翼无人机，限制各电机控制量的极限值的控制量分配方法。
[0004]本专利技术解决其技术问题所采用的技术方案是：一种多旋翼无人机控制量分配方法，包括获取无人机正常工作状态下每个电机允许转速的最小值和最大值，为每个电机i建立转速与控制变量的关系，其中n为电机总数，时，电机i为最小转速，时，电机i为最大转速；基于电机驱动方向与无人机机头方向的夹角构造控制矩阵；基于无人机的高度控制量、横滚角控制量和俯仰角控制量建立控制量向量，通过控制矩阵与控制量向量的乘积获得由n个电机的控制变量构成的控制变量向量；通过无人机的控制量优化控制变量向量，基于优化后的控制变量向量控制多旋翼无人机的飞行状态。
[0005]优选的，所述电机i的转速与控制变量为线性关系，表达式为，根据时，电机i为最小转速，时，电机i为最大转速；得到得到
。
[0006]优选的，所述基于电机驱动方向与无人机机头方向的夹角构造的控制矩阵如下，其中，表示电机i的输出方向与机头方向的夹角；，、、、分别为高度、横滚、俯仰和航向的控制量分配向量。
[0007]优选的，所述控制变量向量的计算公式为：其中，为高度的控制量，为横滚角的控制量，为俯仰角的控制量，在上式中，航向角的控制量未参与计算，因此在控制矩阵中移除航向控制量分配向量。
[0008]优选的，所述通过无人机的控制量优化控制变量向量的方法包括:对控制变量向量中数值在范围外的控制变量，使用高度控制量优化，计算得到高度控制量修正系数，通过高度控制量修正系数更新控制变量向量得到高度优化控制变量向量；对高度优化控制变量向量中数值在范围外的控制变量，通过横滚角控制量优化，计算得到横滚角控制量修正系数，通过横滚角控制量修正系数更新高度优化控制变量向量得到横滚优化控制变量向量；对横滚优化控制变量向量中数值在范围外的控制变量，通过俯仰角控制量优化，计算得到俯仰角控制量修正系数，通过俯仰角控制量修正系数更新横滚优化控制变量向量得到俯仰优化控制变量向量；将航向控制量加入到修正后的俯仰优化控制变量向量中，得到航向控制变量向量；对航向控制变量向量中数值在范围外的控制变量，通过航向角控制量优化，计算得到航向角控制量修正系数，通过航向角控制量修正系数更新航向控制变量向量得到航向优化控制变量向量；通过航向优化控制变量向量计算各电机的转速，实现多旋翼无人机的控制。
[0009]优选的，对控制变量向量中数值在范围外的控制变量，其高度修正为
其中，表示分配向量的第i个数据， ；高度控制量修正系数的计算公式为：高度优化控制变量向量为： 。
[0010]优选的，对高度优化控制变量向量中数值在范围外的控制变量，其横滚修正系数为其中，表示分配向量的第i个数据，即；横滚角控制量修正系数的计算公式为：横滚优化控制变量向量为：。
[0011]优选的，对横滚优化控制变量向量中数值在范围外的控制变量，其俯仰修正系数为其中，表示分配向量的第i个数据，即；俯仰角控制量修正系数的计算公式为：
俯仰优化控制变量向量为： 。
[0012]优选的，所述航向控制量加入到修正后的俯仰优化控制变量向量中，得到航向控制变量向量的方法为： 。
[0013]优选的，对航向控制变量向量中数值在范围外的控制变量，其航向修正系数为其中，表示分配向量的第i个数据，即；航向角控制量修正系数的计算公式为：航向优化控制变量向量为： 。
[0014]本专利技术的有益效果是：通过建立控制变量与电机的转速关系，将无人机控制量分配问题转换为控制变量的优化问题，然后通过无人机得到控制量优化控制变量，确保控制变量的数值处于0~1之间，从而使电机能够在安全的转速范围内转动，实现多旋翼无人机控制量的有效分配，提高控制量分配计算速度，确保多旋翼无人机的安全飞行。将各通道的控制量叠加之后，对控制量进行有效的再分配，减轻电机的饱和负担，充分利用未饱和电机的能力，从而在一些极限情况下也能够保证多旋翼飞行的性能和安全。
附图说明
[0015]下面将结合附图及实例对本专利技术作进一步说明。
[0016]图1是本专利技术实施例提供的多旋翼无人机控制量分配方法的流程图；图2是本专利技术的实施例提供的多旋翼无人机控制量分配方法的控制变量优化方法
的流程图。
具体实施方式
[0017]下面结合具体实施例对本专利技术进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本专利技术，但不以任何形式限制本专利技术。应当指出的是，对本领域的普通技术人员来说，在不脱离本专利技术构思的前提下，还可以做出若干变形和改进。这些都属于本专利技术的保护范围。
[0018]本专利技术的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”、“第四”等(如果存在)是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的本专利技术的实施例，例如能够以除了在这里图示或描述的那些以外的顺序实施。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
[0019]下面以具体地实施例对本专利技术的技术方案进行详细说明。下面这几个具体的实施例可以相互结合，对于相同或相似的概念或过程可能在某些实施例不再赘述。
[0020]实施例1：如图1所示，本实施例提供了一种多旋翼无人机控制量分配方法，包括以下步骤：获取无人机正常工作状态下每个电机允许转速的最小值和最大值，为每个电机i建立转速与控制变量的关系，其中n为电机总数，时，电机i为最小转速，时，电机i为最大转速；基于电机驱动方向与无人机机头方向的夹角构造控制矩阵；基于无人机的高度控制量、横滚角控制量和俯仰角控制量建立控制量向量，通过控制矩阵与控制量向量的乘积获得由n个电机的控制变量构成的控制变量向量；通过无人机的控制量优化控制变量向量，基于优化后的控制变量向量控本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种多旋翼无人机控制量分配方法，其特征在于：包括获取无人机正常工作状态下每个电机允许转速的最小值和最大值，为每个电机i建立转速与控制变量的关系，其中n为电机总数，时，电机i为最小转速，时，电机i为最大转速；基于电机驱动方向与无人机机头方向的夹角构造控制矩阵；基于无人机的高度控制量、横滚角控制量和俯仰角控制量建立控制量向量，通过控制矩阵与控制量向量的乘积获得由n个电机的控制变量构成的控制变量向量；通过无人机的控制量优化控制变量向量，基于优化后的控制变量向量控制多旋翼无人机的飞行状态。2.根据权利要求1所述的一种多旋翼无人机控制量分配方法，其特征在于：所述电机i的转速与控制变量为线性关系，表达式为，根据时，电机i为最小转速，时，电机i为最大转速；得到得到 。3.根据权利要求1所述的一种多旋翼无人机控制量分配方法，其特征在于：所述基于电机驱动方向与无人机机头方向的夹角构造的控制矩阵如下，其中，表示电机i的输出方向与机头方向的夹角；，、、、分别为高度、横滚、俯仰和航向的控制量分配向量。4.根据权利要求3所述的一种多旋翼无人机控制量分配方法，其特征在于：所述控制变量向量的计算公式为：其中，为高度的控制量，为横滚角的控制量，为俯仰角的控制量，在上式中，航向角的控制量未参与计算，因此在控制矩阵中移除航向控制量分配向量。5.根据权利要求4所述的一种多旋翼无人机控制量分配方法，其特征在于：所述通过无
人机的控制量优化控制变量向量的方法包括:对控制变量向量中数值在范围外的控制变量，使用高度控制量优化，计算得到高度控制量修正系数，通过高度控制量修正系数更新控制变量向量得到高度优化控制变量向量；对高度优化控制变量向量中数值在范围外的控制变量，通过横滚角控制量优化，计算得到横滚角控制量修正系数，通过横滚角控制量修正系数更新高度优化控制变量向量得到横滚优化控制变量向量...

【专利技术属性】
技术研发人员：黄立，张原艺，王龙，林家民，张正飞，薛源，刘华斌，
申请(专利权)人：普宙科技深圳有限公司，
类型：发明
国别省市：