飞行器及其电机控制方法、装置和系统的制作方法
【专利摘要】本发明公开了一种飞行器及其电机控制方法、装置和系统，该电机控制方法包括以下步骤：S1、利用获取到的电机的目标转速和电机当前的实际转速进行PID运算；S2、根据PID运算的运算结果判断是否需要刹车，并在判断为是时控制电机执行刹车操作及按照该运算结果调整驱动电机的驱动器的驱动量。本发明弥补了现有技术中控制电机的转速时不能使电机良好的跟随控制命令而导致控制效果不理想的不足，采用闭环调速的方式调整驱动器的驱动量，进而调整电机的转速，使得电机的转速得到精准地控制。
【专利说明】
飞行器及其电机控制方法、装置和系统
技术领域
[0001]本发明涉及一种飞行器及其电机控制方法、装置和系统。
【背景技术】
[0002]无刷直流电机，由于其无电刷、低干扰，噪音低、运转顺畅，寿命长、低维护成本等优点，通常被使用在控制要求较高、转速也较高的设备上，如航模、无人机等对电机转速控制严格且转速很高的设备。
[0003]现有技术中，无刷直流电机在航模、无人机等方面的应用，多采用开环控制方式，用于控制电机转速。我们知道，为了达到良好的飞行稳定性和机动性，电机转速需要实时跟随控制器设定的速度值。
[0004]然而，在实际应用于飞行器中时，电机转速易受到外部环境如颠簸、气流、振动方面的因素的影响。若只是通过现有技术中采用的开环控制方式，电机驱动器接收的控制命令为油门量，仅能实现当电机转速低于目标转速时快速提高转速，不能设定实际需要的目标转速值，并且当电机实际转速高于目标转速时，由于螺旋桨和电机具有较高的转动动能不能实现快速降速，进而不能获得良好的飞行稳定性和机动性。因此，飞行器的电机转速容易受到干扰，不能良好的跟随控制命令，控制效果不理想。
【发明内容】
[0005]本发明要解决的技术问题是为了克服现有技术中控制电机的转速时不能使电机良好的跟随控制命令而导致控制效果不理想的缺陷，提供一种飞行器及其电机控制方法、装置和系统。
[0006]本发明是通过下述技术方案来解决上述技术问题的:
[0007]本发明提供一种飞行器的电机控制方法，其特点是，该电机控制方法包括以下步骤:
[0008]S1、利用获取到的电机的目标转速和电机当前的实际转速进行PID(比例-积分-微分)运算；
[0009]S2、根据PID运算的运算结果判断是否需要刹车，并在判断为是时控制电机执行刹车操作及按照该运算结果调整驱动电机的驱动器的驱动量。
[0010]本技术方案通过闭环调速的方式调整驱动器的驱动量，进而调整电机的转速，使得电机的转速得到精准地控制，尤其是防止了电机当前的实际转速高于目标转速。本技术方案针对的电机可以为无刷直流电机(BLDC，Brushless DC Motor)，以其自身的优越特性能够进一步提高对其转速的控制精确性。该刹车操作可以为将电机的三相通过脉宽调制方式短接。该刹车操作中还可以通过调节脉宽调制方式的占空比控制刹车力度。
[0011 ] 较佳的，该电机控制方法还包括在执行S1之前执行以下步骤:
[0012]Sm、判断获取到的电机的目标转速是否大于零转速，若是，执行Sffi，若否，执行S03;
[0013]Sff1、判断电机当前的实际转速是否为零转速，若是，执行启动函数，若否，执行S1;
[0014]Sra、判断电机当前的实际转速是否为零转速，并判断为否时执行停机函数。
[0015]该启动函数为现有数字化控制中的一种控制电机启动的方式，该停机函数为现有数字化控制中的一种控制电机停止运行的方式。
[0016]较佳的，该电机控制方法还包括以下步骤:
[0017]在执行Sqi之前初始化该驱动器；
[0018]和/或，在电机当前的实际转速不为零转速时检测电机是否出现运行错误，并在检测出现运行错误时执行停机函数。
[0019]较佳的，该电机控制方法还包括从该飞行器的控制器获取目标转速的步骤。
[0020]较佳的，S2还包括在判断出不需要刹车时控制电机维持当前的实际转速或提升当前的实际转速。
[0021]本发明还提供一种飞行器的电机控制装置，其特点是，该电机控制装置包括一计算模块和一第一判断模块；
[0022]该计算模块用于利用获取到的电机的目标转速和电机当前的实际转速进行PID运算，然后调用该第一判断模块；
[0023]该第一判断模块用于根据PID运算的运算结果判断是否需要刹车，并在判断为是时控制电机执行刹车操作及按照该运算结果调整驱动电机的驱动器的驱动量。
[0024]较佳的，该电机控制装置还包括一第二判断模块、一第三判断模块和一第四判断丰吴块；
[0025]该第二判断模块用于在调用该计算模块之前判断获取到的电机的目标转速是否大于零转速，若是，调用该第三判断模块，若否，调用该第四判断模块；
[0026]该第三判断模块用于判断电机当前的实际转速是否为零转速，若是，执行启动函数，若否，调用该计算模块；
[0027]该第四判断模块用于判断电机当前的实际转速是否为零转速，并判断为否时执行停机函数。
[0028]较佳的，该电机控制装置还包括一初始化模块和/或一检测模块:
[0029]该初始化模块用于初始化该驱动器，然后调用该第二判断模块；
[0030]该检测模块用于在电机当前的实际转速不为零转速时检测电机是否出现运行错误，并在检测出现运行错误时执行停机函数。
[0031]较佳的，该电机控制装置还包括一获取模块，该获取模块用于从该飞行器的控制器获取目标转速。
[0032]较佳的，该第一判断模块还用于在判断出不需要刹车时控制电机维持当前的实际转速或提升当前的实际转速。
[0033]本发明还提供一种飞行器的电机控制系统，其特点是，该电机控制系统包括若干上述各优选条件任意组合的电机控制装置，该些电机控制装置均与该飞行器的控制器连接。
[0034]本发明还提供一种飞行器，其特点是，包括若干电机和一控制器，每一电机分别配有上述各优选条件任意组合的一电机控制装置和一如上所述的驱动器，每一电机控制装置是从该控制器获取目标转速的。
[0035]较佳的，该飞行器中电机的数量为4个、6个或8个。
[0036]在符合本领域常识的基础上，上述各优选条件，可任意组合，即得本发明各较佳实例。
[0037]本发明的积极进步效果在于:本发明采用闭环调速的方式调整驱动器的驱动量，进而调整电机的转速，使得电机的转速得到精准地控制。
【附图说明】
[0038]图1为本发明实施例1的控制方法的流程图。
[0039]图2为本发明实施例1的电机的驱动电路图。
[0040]图3为本发明实施例1的电机运行的控制时序图。
[0041]图4为本发明实施例1的电机控制装置的示意图。
【具体实施方式】
[0042]下面通过实施例的方式进一步说明本发明，但并不因此将本发明限制在所述的实施例范围之中。
[0043]实施例1
[0044]一种飞行器包括4个电机、4个驱动器和一控制器，其中电机为永磁无刷直流电机，驱动器为六路开关驱动器。虽然该些电机相互独立，分别由一个驱动器驱动，但每一电机的控制方法均相同，下面针对其中的一个电机说明一下其控制方法:
[0045]参见图1，该控制方法包括以下步骤:
[0046]步骤1001、初始化驱动电机的驱动器。
[0047]步骤1002、从该控制器获取一目标转速，该目标转速可以包含在该控制器发送的控制指令中。
[0048]步骤1003、判断获取到的电机的目标转速是否大于零转速，若是，则说明需要电机处于运行状态，执行步骤1004，若否，则说明电机不需要处于运行状态，执行步骤1005。
[0049]步骤1004、判断电机当前的实际转速是否为零转速，若是，执行启动函数，然后返回步骤1002，若否，执行步骤1006。该启动函数控制电机的驱动量使电机由停转状态进入运转状态。
[0050]步骤1005、判断电机当前的实际转速是否为零转速，若是，返回步骤1002，若否，执行停机函数，然后返回步骤1002。该停机函数控制电机的驱动量使电机由运转状态进入停转状态。
[0051]步骤1006、利用目标转速和实际转速进行PID运算。
[0052]步骤1007、根据PID运算的运算结果判断是否需要刹车，若是，执行步骤1008，若否，执行步骤1009。
[0053]步骤1008、控制电机执行刹车操作及按照该运算结果调整驱动电机的驱动器的驱动量，然后返回步骤1002。
[0054]步骤1009、控制电机维持当前的实际转速或提升当前的实际转速，然后返回步骤
1002ο
[0055]具体的，在步骤1007中，若该运算结果为负数则说明需要刹车，若该运算结果为正数则说明需要提升当前的实际转速，若该运算结果为O则说明需要维持当前的实际转速，至于步骤1008和步骤1009中驱动量的值则依该运算结果的绝对值的大小而定。
[0056]该控制方法还包括以下步骤:
[0057]在电机当前的实际转速不为零转速时检测电机是否出现运行错误，并在检测出现运行错误时执行停机函数。
[0058]为了实现上述刹车操作，电机采用如图2所示的驱动电路。电源通过三相逆变电路与电机连接，驱动器的控制管脚分别为A+、A-、B+、B_、C+和C-，通过控制该些控制管脚驱动电机。电机运行的控制时序图如图3所示。采用三相六步控制方式，控制管脚高电平时驱动器件导通，控制管脚低电平时驱动器件关断。其中图(a)为电机方波驱动简图，图(b)为正常运行时该些控制管脚的波形图，图(C)为刹车时该些控制管脚的波形图。需要启动电机时根据转子位置使电机三相中一相接通电源+，一相接通电源_，另一相悬空，连续驱动电机运转，通过脉宽调制方式控制电机转速。需要执行刹车操作时将电机三相通过脉宽调制方式短接，并通过调节脉宽调试方式的占空比控制刹车力度。
[0059]参见图4，用于实现该电机控制方法的电机控制装置包括一初始化模块2001、一获取模块2002、一第一判断模块2003、一第二判断模块2004、一第三判断模块2005、一第四判断模块2006、一计算模块2007和一检测模块2008。
[0060]该初始化模块2001用于初始化驱动电机的驱动器，然后调用该获取模块2002。
[0061]该获取模块2002用于从该飞行器的控制器获取目标转速然后调用该第二判断模块2004。目标转速可以包含在该控制器发送的控制指令中。
[0062]该第二判断模块2004用于判断获取到的电机的目标转速是否大于零转速，若是，调用该第三判断模块2005，若否，调用该第四判断模块2006。
[0063]该第三判断模块2005用于判断电机当前的实际转速是否为零转速，若是，执行启动函数然后调用该获取模块2002，若否，调用该计算模块2007。该启动函数控制电机的驱动量使电机由停转状态进入运转状态。
[0064]该第四判断模块2006用于判断电机当前的实际转速是否为零转速，若是，调用该获取模块2002，若否，执行停机函数然后调用该获取模块2002。该停机函数控制电机的驱动量使电机由运转状态进入停转状态。
[0065]该计算模块2007用于利用目标转速和实际转速进行PID运算，然后调用该第一判断模块2003。
[0066]该第一判断模块2003用于根据PID运算的运算结果判断是否需要刹车，若是，控制电机执行刹车操作及按照该运算结果调整驱动电机的驱动器的驱动量然后调用该获取模块2002，若否，控制电机维持当前的实际转速或提升当前的实际转速然后调用该获取模块 2002。
[0067]该检测模块2008用于在电机当前的实际转速不为零转速时检测电机是否出现运行错误，并在检测出现运行错误时执行停机函数。
[0068]该飞行器的该些电机的电机控制装置组成了本实施例的电机控制系统。
[0069]本实施例的飞行器除了包括4个电机、4个驱动器和控制器之外，还包括4个电机控制装置，每个电机控制装置分别对应一个电机，其中，每一电机控制装置均是从该控制器获取目标转速的。
[0070]实施例2
[0071]本实施例与实施例1的飞行器基本相同，不同之处在于，本实施例的飞行器包括6个电机、6个驱动器和一个与实施例1相同的控制器，每个电机分别对应一个电机控制装置。
[0072]虽然以上描述了本发明的【具体实施方式】，但是本领域的技术人员应当理解，这些仅是举例说明，本发明的保护范围是由所附权利要求书限定的。本领域的技术人员在不背离本发明的原理和实质的前提下，可以对这些实施方式做出多种变更或修改，但这些变更和修改均落入本发明的保护范围。
【主权项】
1.一种飞行器的电机控制方法，其特征在于，该电机控制方法包括以下步骤: 51、利用获取到的电机的目标转速和电机当前的实际转速进行PID运算； 52、根据PID运算的运算结果判断是否需要刹车，并在判断为是时控制电机执行刹车操作及按照该运算结果调整驱动电机的驱动器的驱动量。2.如权利要求1所述的电机控制方法，其特征在于，该电机控制方法还包括在执行SI之前执行以下步骤: Sm、判断获取到的电机的目标转速是否大于零转速，若是，执行Sffi，若否，执行Sid3; Sra、判断电机当前的实际转速是否为零转速，若是，执行启动函数，若否，执行S1; S113、判断电机当前的实际转速是否为零转速，并判断为否时执行停机函数。3.如权利要求2所述的电机控制方法，其特征在于，该电机控制方法还包括以下步骤: 在执行Stn之前初始化该驱动器； 和/或，在电机当前的实际转速不为零转速时检测电机是否出现运行错误，并在检测出现运行错误时执行停机函数。4.如权利要求1或2所述的电机控制方法，其特征在于，该电机控制方法还包括从该飞行器的控制器获取目标转速的步骤。5.如权利要求1或2所述的电机控制方法，其特征在于，S2还包括在判断出不需要刹车时控制电机维持当前的实际转速或提升当前的实际转速。6.一种飞行器的电机控制装置，其特征在于，该电机控制装置包括一计算模块和一第一判断模块； 该计算模块用于利用获取到的电机的目标转速和电机当前的实际转速进行PID运算，然后调用该第一判断模块； 该第一判断模块用于根据PID运算的运算结果判断是否需要刹车，并在判断为是时控制电机执行刹车操作及按照该运算结果调整驱动电机的驱动器的驱动量。7.如权利要求6所述的电机控制装置，其特征在于，该电机控制装置还包括一第二判断模块、一第三判断模块和一第四判断模块； 该第二判断模块用于在调用该计算模块之前判断获取到的电机的目标转速是否大于零转速，若是，调用该第三判断模块，若否，调用该第四判断模块； 该第三判断模块用于判断电机当前的实际转速是否为零转速，若是，执行启动函数，若否，调用该计算模块； 该第四判断模块用于判断电机当前的实际转速是否为零转速，并判断为否时执行停机函数。8.如权利要求7所述的电机控制装置，其特征在于，该电机控制装置还包括一初始化模块和/或一检测模块: 该初始化模块用于初始化该驱动器，然后调用该第二判断模块； 该检测模块用于在电机当前的实际转速不为零转速时检测电机是否出现运行错误，并在检测出现运行错误时执行停机函数。9.如权利要求6或7所述的电机控制装置，其特征在于，该电机控制装置还包括一获取模块，该获取模块用于从该飞行器的控制器获取目标转速。10.如权利要求6或7所述的电机控制装置，其特征在于，该第一判断模块还用于在判断出不需要刹车时控制电机维持当前的实际转速或提升当前的实际转速。11.一种飞行器的电机控制系统，其特征在于，该电机控制系统包括若干如权利要求6-10中任意一项所述的电机控制装置，该些电机控制装置均与该飞行器的控制器连接。12.—种飞行器，其特征在于，包括若干电机和一控制器，每一电机分别配有一如权利要求6-10中任意一项所述的电机控制装置和一权利要求6中的驱动器，每一电机控制装置是从该控制器获取目标转速的。13.如权利要求12所述的飞行器，其特征在于，该飞行器中电机的数量为4个、6个或8个。
【文档编号】H02P6/06GK105846731SQ201510023713
【公开日】2016年8月10日
【申请日】2015年1月16日
【发明人】田瑜, 江文彦
【申请人】优利科技有限公司