CN113039502B - 多旋翼无人机及其控制方法、控制装置和计算机可读存储介质 - Google Patents
多旋翼无人机及其控制方法、控制装置和计算机可读存储介质 Download PDFInfo
- Publication number
- CN113039502B CN113039502B CN202080005960.0A CN202080005960A CN113039502B CN 113039502 B CN113039502 B CN 113039502B CN 202080005960 A CN202080005960 A CN 202080005960A CN 113039502 B CN113039502 B CN 113039502B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- acquiring
- rotor
- control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 85
- 238000003860 storage Methods 0.000 title claims abstract description 15
- 238000006073 displacement reaction Methods 0.000 claims abstract description 46
- 238000009826 distribution Methods 0.000 claims description 63
- 238000013507 mapping Methods 0.000 claims description 23
- 230000001133 acceleration Effects 0.000 claims description 13
- 238000005259 measurement Methods 0.000 claims description 12
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000005457 optimization Methods 0.000 claims description 7
- 238000005192 partition Methods 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 5
- 238000004590 computer program Methods 0.000 claims description 5
- 230000001276 controlling effect Effects 0.000 claims 42
- 230000001105 regulatory effect Effects 0.000 claims 3
- 230000006870 function Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000003491 array Methods 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000009987 spinning Methods 0.000 description 2
- ATJFFYVFTNAWJD-UHFFFAOYSA-N Tin Chemical compound [Sn] ATJFFYVFTNAWJD-UHFFFAOYSA-N 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
- B64U10/00—Type of UAV
- B64U10/10—Rotorcrafts
- B64U10/13—Flying platforms
- B64U10/14—Flying platforms with four distinct rotor axes, e.g. quadcopters
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C39/00—Aircraft not otherwise provided for
- B64C39/02—Aircraft not otherwise provided for characterised by special use
- B64C39/024—Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/0055—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements
- G05D1/0072—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots with safety arrangements to counteract a motor failure
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种多旋翼无人机的控制方法、多旋翼无人机(100)、控制装置(200)和非易失性计算机可读存储介质(300)。多旋翼无人机的控制方法包括：(01)获取无人机的每个旋翼的动力状态；及(02)在基于动力状态确定无人机的任意一个旋翼的动力失效时，控制无人机进入平衡模式。其中，在平衡模式下，无人机以大于第一阈值的角速度进行自转，且无人机在水平方向的位移小于预设位移量。
Description
技术领域
本申请涉及飞行器安全技术领域，特别涉及一种多旋翼无人机的控制方法、多旋翼无人机、控制装置和非易失性计算机可读存储介质。
背景技术
多旋翼无人机由于其结构简单、成本低、易于控制等特点，已经广泛应用于教育科研、航拍摄影、军用侦察、警用安全等多个领域。
多旋翼无人机包括多个电机与螺旋桨，电机驱动螺旋桨旋转产生升力与反扭距，通过一系列的控制算法与分配策略产生无人机飞行所需要的升力与控制力矩，用以控制无人机的位置与姿态。然而，当某个旋翼的动力完全失效，即某个电机停转或桨叶射桨时，无人机会立即坠毁，引起安全问题。
发明内容
本申请实施方式提供一种多旋翼无人机的控制方法、多旋翼无人机、控制装置和非易失性计算机可读存储介质。
本申请实施方式的多旋翼无人机的控制方法包括：获取所述无人机的每个旋翼的动力状态；及在基于所述动力状态确定所述无人机的任意一个旋翼的动力失效时，控制所述无人机进入平衡模式。其中，在所述平衡模式下，所述无人机以大于第一阈值的角速度进行自转，且所述无人机在水平方向的位移小于预设位移量。
本申请实施方式的多旋翼无人机包括多个旋翼及一个或多个控制器。一个或多个所述控制器用于：获取所述无人机的每个旋翼的动力状态；及在基于所述动力状态确定所述无人机的任意一个旋翼的动力失效时，控制所述无人机进入平衡模式。其中，在所述平衡模式下，所述无人机以大于第一阈值的角速度进行自转，且所述无人机在水平方向的位移小于预设位移量。
本申请实施方式的控制装置，用于多旋翼无人机。所述多旋翼无人机包括机身及设置在所述机身上的多个旋翼。所述控制装置包括一个或多个控制器，一个或多个所述控制器用于：获取所述无人机的每个旋翼的动力状态；及在基于所述动力状态确定所述无人机的任意一个旋翼的动力失效时，控制所述无人机进入平衡模式。其中，在所述平衡模式下，所述无人机以大于第一阈值的角速度进行自转，且所述无人机在水平方向的位移小于预设位移量。
本申请实施方式的非易失性计算机可读存储介质上存储有计算机程序，所述计算机程序被处理器执行时实现：获取所述无人机的每个旋翼的动力状态；及在基于所述动力状态确定所述无人机的任意一个旋翼的动力失效时，控制所述无人机进入平衡模式。其中，在所述平衡模式下，所述无人机以大于第一阈值的角速度进行自转，且所述无人机在水平方向的位移小于预设位移量。
本申请实施方式的多旋翼无人机的控制方法、多旋翼无人机、控制装置和非易失性计算机可读存储介质中，在无人机的任意一个旋翼的动力失效，例如某个电机停转或桨叶射桨时，控制无人机以大于第一阈值的角速度进行自转，且无人机在水平方向的位移小于预设位移量，使得在无人机坠机前用户可以采取有效的安全措施，能够降低无人机的坠机概率，保证了无人机的安全，从而可以很好地解决由于动力失效造成的飞行安全问题。
本申请实施方式的附加方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本申请的实践了解到。
附图说明
本申请的上述和/或附加的方面和优点可以从结合下面附图对实施方式的描述中将变得明显和容易理解，其中：
图1是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图2是本申请某些实施方式的多旋翼无人机的结构示意图；
图3是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图4是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图5是本申请某些实施方式的多旋翼无人机的控制方法的原理示意图；
图6是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图7是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图8是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图9是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图10是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图11是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图12是本申请某些实施方式的多旋翼无人机的控制方法的原理示意图；
图13是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图14是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图15是本申请某些实施方式的多旋翼无人机的控制方法的原理示意图；
图16是本申请某些实施方式的多旋翼无人机的控制方法的流程示意图；
图17是本申请某些实施方式的控制装置与多旋翼无人机的结构示意图；
图18是本申请某些实施方式的计算机可读存储介质的模块示意图。
具体实施方式
以下结合附图对本申请的实施方式作进一步说明。附图中相同或类似的标号自始至终表示相同或类似的元件或具有相同或类似功能的元件。
另外，下面结合附图描述的本申请的实施方式是示例性的，仅用于解释本申请的实施方式，而不能理解为对本申请的限制。
请参阅图1和图2，本申请实施方式提供一种多旋翼无人机的控制方法。该控制方法适用于多旋翼无人机100，其中，多旋翼无人机100包括机身10及设置在机身10上的多个旋翼20，例如设置在机身10上的两个旋翼、三个旋翼、四个旋翼、五个旋翼、六个旋翼、或者更多个旋翼。该控制方法包括：
01：获取无人机100的每个旋翼20的动力状态；
02：在基于动力状态确定无人机100的任意一个旋翼20的动力失效时，控制无人机100进入平衡模式；其中，在平衡模式下，无人机100以大于第一阈值的角速度进行自转，且无人机100在水平方向的位移小于预设位移量。
请参阅图2，本申请实施方式还提供一种多旋翼无人机100。多旋翼无人机100机身10、设置在机身10上的多个旋翼20、及设置在机身10上的一个或多个控制器30。一个或多个控制器30可用于执行01及02中的方法，即，一个或多个控制器30可用于：获取无人机100的每个旋翼20的动力状态；及在基于动力状态确定无人机100的任意一个旋翼20的动力失效时，控制无人机100进入平衡模式；其中，在平衡模式下，无人机100以大于第一阈值的角速度进行自转，且无人机100在水平方向的位移小于预设位移量。
其中，旋翼20可以是两个、三个、四个、五个、六个、或者更多个，在此不作限制。每个旋翼20均包括一个螺旋桨22及用于驱动螺旋桨22转动以为无人机100提供升力的电机24。无人机100的每个旋翼20的动力状态可以由各类参数来体现，在一个实施方式中，每个旋翼20的动力状态可以由电机24的参数，例如电压、电流、转速来体现，在一个例子中，当电机24的电压超出预设电压范围，则表明对应的旋翼20的动力失效；在另一个例子中，当电机24的电流超出预设电流范围，则表明对应的旋翼20的动力失效；在再一个例子中，当电机24的转速超出预设转速范围，则表明对应的旋翼20的动力失效。在另一个实施方式中，每个旋翼20的动力状态可以由螺旋桨22的参数，例如拉力来体现，在一个例子中，当螺旋桨22的拉力超出预设拉力范围，则表明对应的旋翼20的动力失效。
另外，无人机100以大于第一阈值的角速度进行自转是指：无人机100绕着自身机体的Z轴的转动，第一阈值一般取较大值，由此使得无人机100自转的角速度较大以能在任意一个旋翼20失效时，无人机100也能维持平衡。无人机100在水平方向的位移小于预设位移量是指：无人机100在世界坐标系下的XY面(世界坐标系下的Z轴(竖直方向)垂直世界坐标系下的XY面)的位移小于预设位移量，预设位移量一般取较小值，由此在任意一个旋翼20失效时，无人机100并不会飘走，而尽量保持在动力失效发生时的最初位置。
本申请实施方式的多旋翼无人机的控制方法及多旋翼无人机100，在无人机100的任意一个旋翼20的动力失效，例如某个电机24停转或螺旋桨22射桨时，控制无人机100以大于第一阈值的角速度进行自转，且无人机100在水平方向的位移小于预设位移量，使得在无人机坠机前用户可以采取有效的安全措施，能够降低无人机100的坠机概率，保证了无人机100的安全，从而可以很好地解决由于动力失效造成的飞行安全问题。
请参阅图2及图3，在某些实施方式中，02：控制无人机100进入平衡模式，包括：
021：控制无人机100以小于第二阈值的角速度自转；及
022：控制无人机100自转的角速度逐渐增大，直至达到平衡模式下的角速度，以进入平衡模式。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行021及022中的方法，即，一个或多个控制器30可用于：控制无人机100以小于第二阈值的角速度自转；及控制无人机100自转的角速度逐渐增大，直至达到平衡模式下的角速度，以进入平衡模式。
其中，第二阈值小于第一阈值，在任意一个旋翼20发生动力失效的时刻，往往无人机100的自转角速度为零或很小，只有控制无人机100的自转角速度逐渐增大，直至大于第一阈值，才能减小由于动力失效而产生的扰动，使得无人机100处于平衡的状态。
请参阅图2、图4及图5，在某些实施方式中，02：控制无人机100进入平衡模式，包括：
023：获取无人机100的第一控制参数；
024：获取无人机100的前馈参数；
025：根据前馈参数及第一控制参数对无人机100的每个旋翼20重新分配升力；及
026：根据每个旋翼20重新分配的升力控制无人机100的对应旋翼20的电机24转动，以使无人机100以大于第一阈值的角速度进行自转，及无人机100在水平方向的位移小于预设位移量。
多旋翼无人机100中的一个或多个控制器30可用于执行023、024、025及026中的方法，即，一个或多个控制器30可用于：获取无人机100的第一控制参数；获取无人机100的前馈参数；根据前馈参数及第一控制参数对无人机100的每个旋翼20重新分配升力；及根据每个旋翼20重新分配的升力控制无人机100的对应旋翼20的电机24转动，以使无人机100以大于第一阈值的角速度进行自转，及无人机100在水平方向的位移小于预设位移量。
具体地，第一控制参数为Falloc＝(Mx,My,Mz,Tall)T，包括旋翼20失效前无人机100的第一控制力矩及第一控制总升力，第一控制力矩包括无人机100在机体坐标系下的三轴控制力矩，分别为机体坐标系下的X轴控制力矩Mx、Y轴控制力矩My、及Z轴控制力矩Mz；第一控制总升力为Tall。请参阅图2、图5及图6，在一个实施方式中，023：获取无人机100的第一控制参数，包括：
0231：获取无人机100期望姿态；
0233：获取无人机100的测量姿态；
0235：根据期望姿态及测量姿态获取期望角速度；及
0237：根据无人机100的测量角速度及期望角速度获取第一控制参数。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行0231、0233、0235及0237中的方法，即，一个或多个控制器30可用于：获取无人机100期望姿态；获取无人机100的测量姿态；根据期望姿态及测量姿态获取期望角速度；及根据无人机100的测量角速度及期望角速度获取第一控制参数。其中，期望姿态可以是遥控器传输给无人机100上的通讯单元，一个或多个控制器30从该通讯单元读取到的。测量姿态可以是无人机100上的一个或多个传感器，例如惯性测量单元实时检测得到，然后由一个或多个控制器30从传感器读取到的。请参阅图5，在一个例子中，一个或多个控制器30可包括姿态控制器和角速度控制器，姿态控制器可用于执行0235中的方法，即，姿态控制器可用于根据期望姿态及测量姿态获取期望角速度。角速度控制器可用于执行0237中的方法，即，角速度控制器可用于根据无人机100的测量角速度及期望角速度获取第一控制参数。
前馈参数为Ffwd＝(Mfx,Mfy,Mfz,Tf)T，包括旋翼20失效后无人机100的前馈力矩及前馈总升力，前馈力矩包括无人机100在机体坐标系下的三轴前馈力矩，分别为机体坐标系下的X轴前馈力矩Mfx、Y轴前馈力矩Mfy、及Z轴前馈力矩Mfz；前馈总升力为Tf。请参阅图2、图5及图7，在一个实施方式中，024：获取无人机100的前馈参数，包括：
0241：获取每个旋翼20的电机24关于前馈参数的升力分配映射关系；
0243：利用迭代优化算法根据升力分配映射关系获取前馈参数，前馈参数使得动力失效的旋翼20的升力小于预设值。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行0241及0243中的方法，即，一个或多个控制器30可用于：获取每个旋翼20的电机24关于前馈参数的升力分配映射关系；及利用迭代优化算法根据升力分配映射关系获取前馈参数，前馈参数使得动力失效的旋翼20的升力小于预设值。请参阅图5，在一个例子中，一个或多个控制器30可包括过渡阶段前馈控制器，过渡阶段前馈控制器可用于执行0241及0243中的方法，即，过渡阶段前馈控制器可用于：获取每个旋翼20的电机24关于前馈参数的升力分配映射关系；及利用迭代优化算法根据升力分配映射关系获取前馈参数，前馈参数使得动力失效的旋翼20的升力小于预设值。
升力分配映射关系可以由以未知的前馈参数为变量的函数h表示为：Tm＝h(Mfx,Mfy,Mfz,Tf)T，Tm≥0。其中，Tm为分配到每个电机24的升力。获取该升力分配映射关系的过程如下：
由于在任意一个旋翼20发生动力失效的时刻，无人机100的自转角速度为零或很小，因此，需要使得无人机100快速进入高速自转以提供足够的陀螺力矩来使得无人机100的姿态平衡。然而，由于开始时，无人机100自转速度较低，无法依靠陀螺力矩来消除扰动，因此可假设借助一个前馈参数(未知量)来减少动力失效而产生的扰动。
未知的前馈参数施加到无人机100之后新的控制参数可用函数g表示为：
F′alloc＝Falloc+Ffwd＝(Mx+Mfx,My+Mfy,Mz+Mfz,Tall+Tf)T＝g(Mfx,Mfy,Mfz,Tf)T。
分配到每个电机的升力为：
Tm＝MallocF′alloc＝Mallocg(Mfx,Mfy,Mfz,Tf)T＝h(Mfx,Mfy,Mfz,Tf)T；其中，Malloc为预设的分配矩阵，为已知量。
由于Tm＝(T1,T2,……,Ti)T；其中，i为旋翼20的总数量，只要使得动力失效的旋翼20的升力Ti尽可能小，例如小于预设值即可。一般地，X轴前馈力矩Mfx、Y轴前馈力矩Mfy、及Z轴前馈力矩Mfz的取值范围均在(-100,100)，前馈总升力Tf的取值范围在(0，100)。因此，利用迭代优化算法根据升力分配映射关系获取前馈参数的具体步骤可以是：
选取X轴前馈力矩Mfx、Y轴前馈力矩Mfy、Z轴前馈力矩Mfz、及前馈总升力为Tf的一个初值代入升力分配映射关系中，求得失效的旋翼20的升力Ti1，若Ti1的值大于预设值，则在Mfx、Mfy、Mfz、及Tf的初值上增加一个迭代值，并继续代入升力分配映射关系中，继续求得失效的旋翼20的升力Ti2，直至Tin的值小于预设值(n为代入映射关系的次数)，此时无人机100因某个旋翼20动力失效而损失的力矩Mlost则可消除。与此同时，Mfx、Mfy、Mfz、及Tf值即为024中的前馈参数，至此便求解出需要的前馈参数。
请参阅图2、图5及图8，在一个实施方式中，025：根据前馈参数及第一控制参数对无人机100的每个旋翼20重新分配升力，包括：
0251：根据前馈参数及第一控制参数获取第二控制参数；及
0253：根据预设的分配矩阵及第二控制参数对无人机100的每个旋翼20重新分配升力。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行0251及0253中的方法，即，一个或多个控制器30可用于：根据前馈参数及第一控制参数获取第二控制参数；及根据预设的分配矩阵及第二控制参数对无人机100的每个旋翼20重新分配升力。
其中，第一控制参数为Falloc＝(Mx,My,Mz,Tall)T，前馈参数为Ffwd＝(Mfx,Mfy,Mfz,Tf)T，第二控制参数为包括旋翼失效后无人机的第二控制力矩及第二控制总升力。根据预设的分配矩阵及第二控制参数对无人机100的每个旋翼20重新分配升力，即为/>同前，Malloc为预设的分配矩阵，为已知量。升力重新分配后，使得动力消失的旋翼20的升力尽可能最小，扰动可以减小到最小，无人机100平稳过渡到平衡状态。
本申请实施方式的多旋翼无人机的控制方法及多旋翼无人机100，通过设计前馈参数Ffwd就可以尽可能地减小由于动力失效产生的扰动，从而使得无人机100平稳过渡到平衡状态，以避免因动力失效导致无人机100坠机，保证了无人机100的安全。
请一并参阅图2及图9，在某些实施方式中，控制方法还可包括：
03：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩控制无人机100的姿态，以进入稳定模式；其中，在稳定模式下，无人机100能够保持以大于第一阈值的角速度进行自转，且无人机100能够根据指令执行对应的操作。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行03中的方法，即，一个或多个控制器30可用于：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩控制无人机100的姿态，以进入稳定模式；其中，在稳定模式下，无人机100能够保持以大于第一阈值的角速度进行自转，且无人机100能够根据指令执行对应的操作。
在一个例子中，指令可包括返航指令，无人机100能够根据指令执行对应的操作包括：无人机100根据返航指令返航。对应地，一个或多个控制器30可用于控制无人机100根据返航指令返航。
在一个例子中，指令可包括悬停指令，无人机100能够根据指令执行对应的操作包括：无人机100根据悬停指令悬停。对应地，一个或多个控制器30可用于控制无人机100根据悬停指令悬停。
在一个例子中，指令可包括降落指令，无人机100能够根据指令执行对应的操作包括：无人机100根据降落指令降落。对应地，一个或多个控制器30可用于控制无人机100根据降落指令降落。
在一个例子中，指令包括飞行控制指令，飞行控制指令包括飞行方向和/或飞行速度，无人机100能够根据指令执行对应的操作包括：无人机100根据飞行控制指令飞行。对应地，一个或多个控制器30可用于控制无人机100根据飞行控制指令飞行。
当无人机100进入高速自转的平衡状态后，由于某个旋翼20的动力失效后，该旋翼20对应的电机24能够产生的控制参数(包括控制力矩及控制总升力)不足，此时将由高速自转产生的陀螺力矩参与无人机100的姿态控制，使得无人机100能够进入稳定模式，且能够响应用户指令并执行对应的操作，使得用户能够在无人机100发生动力失效时，结合当前情况有效地选择对无人机控制有利的策略，由此不仅能够大大地降低因动力失效导致无人机100的坠机概率，保证了无人机100的安全，还能提高动力失效的无人机100的飞行稳定性。
请一并参阅图2及图10，在某些实施方式中，03：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩控制无人机100的姿态，以进入稳定模式，包括：
031：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩，控制无人机100的横滚角和/或俯仰角在预定范围内变化，以进入稳定模式。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行031中的方法，即，一个或多个控制器30可用于：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩，控制无人机100的横滚角和/或俯仰角在预定范围内变化，以进入稳定模式。
其中，无人机100因为某个旋翼20的动力失效，会产生极大的扰动，尽管在平衡模式下，该扰动被减小到最小，但扰动仍然会存在。本实施方式通过由高速自转产生的陀螺力矩来参与无人机100的姿态控制，能够使得横滚角和/或俯仰角在预定范围(非常小的范围)内变化，以进一步地控制扰动在一个较小的范围，使得无人机100能够保持在一个稳定状态，在任意旋翼20发生动力失效时也能保证无人机100的安全。
请一并参阅图2、图11及图12，在某些实施方式中，03：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩控制无人机100的姿态，以进入稳定模式，包括：
032：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩获取期望参数；
033：根据期望参数及测量参数获取第三控制参数；及
034：根据第三控制参数控制无人机100的姿态以进入稳定模式。
多旋翼无人机100中的一个或多个控制器30可用于执行032、033、及034中的方法，即，一个或多个控制器30可用于：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩获取期望参数；根据期望参数及测量参数获取第三控制参数；及根据第三控制参数控制无人机100的姿态以进入稳定模式。
具体地，期望参数包括无人机100的横滚轴的期望角速度pdes及俯仰轴的期望角速度qdes。请一并参阅图2、图12及图13，在一个实施方式中，032：根据无人机100以大于第一阈值的角速度自转时产生的陀螺力矩获取期望参数，包括：
0321：获取无人机100在横滚轴及俯仰轴上的分配力矩；
0322：根据分配力矩及预设的第一分配系数及预设的第二分配系数获取陀螺力矩；及
0323：根据陀螺力矩及陀螺力矩映射关系获取期望参数。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行0321、0322、0323中的方法，即，一个或多个控制器30可用于：获取无人机100在横滚轴及俯仰轴上的分配力矩；根据分配力矩及预设的第一分配系数及预设的第二分配系数获取陀螺力矩；及根据陀螺力矩及陀螺力矩映射关系获取期望参数。其中，在一个例子中，一个或多个控制器30可包括角速度控制器，角速度控制器可用于执行0321中的方法，即，角速度控制器可用于获取无人机100在横滚轴及俯仰轴上的分配力矩，分配力矩可为Fxy＝(Mx,My)T，为由角速度控制器输出的已知量。其中，分别为进入平衡模式后无人机100的X轴控制力矩Mx及Y轴控制力矩My。
若部分分配力矩由陀螺力矩提供，则陀螺力矩为Mgyro＝(a1Mx,a2My)T，a1为第一分配系数，a2为第二分配系数。更具体地，在一个例子中，第一分配系数a1大于0小于等于1，例如a1可取值0.1、0.2、0.3、0.4、0.5、0.6、0.7、0.8、0.9及1.0中的任意一个值或相邻两个值之间的任意数值。较佳地，第一分配系数a1大于等于0.2小于等于0.5。在一个例子中，第二分配系数a2大于0小于等于1，例如a2可取值0.1、0.2、0.3、0.4、0.5、0.6、0.7、0.8、0.9及1.0中的任意一个值或相邻两个值之间的任意数值。较佳地，第二分配系数a2大于等于0.2小于等于0.5。在一个例子中，第一分配系数a1大于0小于等于1，且第二分配系数a2也大于0小于等于1。在某些实施方式中，第一分配系数a1与第二分配系数a2相同。
陀螺力矩映射关系可以是陀螺力矩公式，即Mgyro＝(-qr,pr,0)TIZ，其中，p为无人机100的横滚轴(X轴)的角速度，q为无人机100的俯仰轴(Y轴)的角速度，r为无人机100的偏航轴(Z轴)的角速度，IZ为无人机100的偏航轴的惯量。根据陀螺力矩Mgyro＝(a1Mx,a2My)T及陀螺力矩公式Mgyro＝(-qr,pr,0)TIZ可计算出无人机100的期望参数，即无人机100的横滚轴的期望角速度pdes及俯仰轴的期望角速度其中，r为由传感器检测出的已知量，IZ也为已知量。
请参阅图12，在一个例子中，一个或多个控制器30可包括角速度控制器，角速度控制器可用于执行033中的方法，即，角速度控制器可用于根据期望参数及测量参数获取第三控制参数。测量参数包括无人机100的横滚轴的测量角速度及俯仰轴的测量角速度，二者均可由传感器检测出。根据期望参数及测量参数可获取参数误差，即无人机100的横滚轴的角速度误差及俯仰轴的角速度误差。角速度控制器再根据参数误差获取第三控制参数。此时，第三控制参数包括：旋翼20失效后在稳定模式下，无人机100的第三控制力矩及第三控制总升力。
请继续参阅图12，在一个实施方式中，034：根据第三控制参数控制无人机100的姿态以进入稳定模式，可以包括：
根据预设的分配矩阵及第三控制参数对无人机100的每个旋翼20重新分配升力；及
根据每个旋翼20重新分配的升力控制无人机100的对应旋翼20的电机24转动，以使无人机100的姿态处于稳定模式。
其中，对无人机100的每个旋翼20重新分配升力可以参考0253中的方法，在此不再展开介绍。
另外，需要说明的是：请参阅图12，如前所述，一个或多个控制器30可包括姿态控制器，姿态控制器可用于根据期望姿态及测量姿态获取指令参数，指令参数包括无人机100的横滚轴的指令望角速度pcommand及俯仰轴的期望角速度qcommand，在获取了无人机100的横滚轴的期望角速度pdes及俯仰轴的期望角速度qdes之后，可以获取无人机100的横滚轴的前馈角速度pfwd及俯仰轴的前馈角速度qfwd，即(pfwd，qfwd)T＝(pdes-pcommand，qdes-qcommand)T。一个或多个控制器30还可包括角速度指令前馈补偿控制器，角速度指令前馈补偿控制器可输出无人机100的横滚轴的前馈角速度pfwd及俯仰轴的前馈角速度qfwd。
请一并参阅图2及图14，在某些实施方式中，控制方法还可包括：
04：根据无人机100的当前飞行状态控制无人机100的水平速度，以使得无人机100的水平加速度在预定范围内。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行04中的方法，即，一个或多个控制器30可用于：根据无人机100的当前飞行状态控制无人机100的水平速度，以使得无人机100的水平加速度在预定范围内。
请一并参阅图2、图15及图16，在某些实施方式中，04：根据无人机100的当前飞行状态控制无人机100的水平速度，以使得无人机100的水平加速度在预定范围内，包括：
041：获取无人机100的期望水平速度；
043：获取无人机100的测量水平速度；
045：根据期望水平速度、测量水平速度、及无人机100的当前飞行状态输出速度调节信号；及
047：根据速度调节信号控制无人机100的水平速度，以使得无人机100的水平加速度在预定范围内。
对应地，多旋翼无人机100中的一个或多个控制器30可用于执行041、043、045、及047中的方法，即，一个或多个控制器30可用于：获取无人机100的期望水平速度；获取无人机100的测量水平速度；根据期望水平速度、测量水平速度、及无人机100的当前飞行状态输出速度调节信号；及根据速度调节信号控制无人机100的水平速度，以使得无人机100的水平加速度在预定范围内。
请参阅图15，在一个例子中，一个或多个控制器30可包括速度控制器调节模块和速度控制器，速度控制器调节模块可用于执行045中的方法，即，速度控制器调节模块可用于根据期望水平速度、测量水平速度、及无人机100的当前飞行状态输出速度调节信号。速度控制器可用于执行047中的方法，即，速度控制器可用于根据速度调节信号控制无人机100的水平速度，以使得无人机100的水平加速度在预定范围内。
如前所述，本申请的多旋翼无人机的控制方法及多旋翼无人机100中，在无人机100的任意一个旋翼20的动力失效后，无人机100将逐渐进入高速自转的平衡模式，并且切换施加了角速度指令前馈补偿时的姿态控制算法来控制无人机100的姿态，使无人机100进入姿态稳定的稳定模式，此时无人机100的航向将放开控制为随动状态，即控制器30不产生航向控制力矩，并且由于处于特殊飞行状态，无人机100的+-速度控制器将根据当前飞行状态进行实时调节，避免无人机100的姿态过大而使无人机100发散，从而进一步提高了无人机100的稳定性。
请参阅图17，本申请还提供一种控制装置200，该控制装置200用于多旋翼无人机100。多旋翼无人机100包括机身10及设置在机身10上的多个旋翼20。控制装置200包括一个或多个控制器30，一个或多个控制器30用于执行上述任意一项实施方式的多旋翼无人机的控制方法。该多旋翼无人机的控制方法包括01、02、021、022、023、024、025、026、0231、0233、0235、0237、0241、0243、0251、0253、03、031、032、033、034、0321、0322、0323、04、041、043、045、047中的方法，例如，一个或多个控制器30可用于执行：
01：获取无人机100的每个旋翼20的动力状态；
02：在基于动力状态确定无人机100的任意一个旋翼20的动力失效时，控制无人机100进入平衡模式；其中，在平衡模式下，无人机100以大于第一阈值的角速度进行自转，且无人机100在水平方向的位移小于预设位移量。
需要说明的是：控制装置200可以独立在无人机100之外，也可以集成在无人机100上，并设置在无人机100的机身10内部或外部，在此不作限制。
本申请实施方式的控制装置200在无人机100的任意一个旋翼20的动力失效，例如某个电机24停转或螺旋桨22射桨时，一个或多个控制器30控制无人机100以大于第一阈值的角速度进行自转，且无人机100在水平方向的位移小于预设位移量，使得在无人机100坠机前用户可以采取有效的安全措施，能够降低无人机100的坠机概率，保证了无人机100的安全，从而可以很好地解决由于动力失效造成的飞行安全问题。
请参阅图18，本申请还提供一种非易失性计算机可读存储介质300。计算机可读存储介质300上存储有计算机程序。计算机程序被处理器40执行时实现上述任意一项实施方式的多旋翼无人机的控制方法。多旋翼无人机的控制方法包括01、02、021、022、023、024、025、026、0231、0233、0235、0237、0241、0243、0251、0253、03、031、032、033、034、0321、0322、0323、04、041、043、045、047中的方法，例如处理器40执行：
01：获取无人机100的每个旋翼20的动力状态；
02：在基于动力状态确定无人机100的任意一个旋翼20的动力失效时，控制无人机100进入平衡模式；其中，在平衡模式下，无人机100以大于第一阈值的角速度进行自转，且无人机100在水平方向的位移小于预设位移量。
本申请实施方式的非易失性计算机可读存储介质300，在无人机100的任意一个旋翼20的动力失效，例如某个电机24停转或螺旋桨22射桨时，处理器40控制无人机100以大于第一阈值的角速度进行自转，且无人机100在水平方向的位移小于预设位移量，使得在无人机100坠机前用户可以采取有效的安全措施，能够降低无人机100的坠机概率，保证了无人机100的安全，从而可以很好地解决由于动力失效造成的飞行安全问题。
在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任一个或多个实施例或示例中以合适的方式结合。此外，在不相互矛盾的情况下，本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。
此外，术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本申请的描述中，“多个”的含义是至少两个，例如两个，三个等，除非另有明确具体的限定。
流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为，表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分，并且本申请的优选实施方式的范围包括另外的实现，其中可以不按所示出或讨论的顺序，包括根据所涉及的功能按基本同时的方式或按相反的顺序，来执行功能，这应被本申请的实施例所属技术领域的技术人员所理解。
在流程图中表示或在此以其他方式描述的逻辑和/或步骤，例如，可以被认为是用于实现逻辑功能的可执行指令的定序列表，可以具体实现在任何计算机可读介质中，以供指令执行***、装置或设备(如基于计算机的***、包括处理器的***或其他可以从指令执行***、装置或设备取指令并执行指令的***)使用，或结合这些指令执行***、装置或设备而使用。就本说明书而言，"计算机可读介质"可以是任何可以包含、存储、通信、传播或传输程序以供指令执行***、装置或设备或结合这些指令执行***、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下：具有一个或多个布线的电连接部(电子装置)，便携式计算机盘盒(磁装置)，随机存取存储器(RAM)，只读存储器(ROM)，可擦除可编辑只读存储器(EPROM或闪速存储器)，光纤装置，以及便携式光盘只读存储器(CDROM)。另外，计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质，因为可以例如通过对纸或其他介质进行光学扫描，接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序，然后将其存储在计算机存储器中。
应当理解，本申请的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中，多个步骤或方法可以用存储在存储器中且由合适的指令执行***执行的软件或固件来实现。例如，如果用硬件来实现，和在另一实施方式中一样，可用本领域公知的下列技术中的任一项或他们的组合来实现：具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路，具有合适的组合逻辑门电路的专用集成电路，可编程门阵列(PGA)，现场可编程门阵列(FPGA)等。
本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成，所述的程序可以存储于一种计算机可读存储介质中，该程序在执行时，包括方法实施例的步骤之一或其组合。
此外，在本申请各个实施例中的各功能单元可以集成在一个处理模块中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现，也可以采用软件功能模块的形式实现。所述集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时，也可以存储在一个计算机可读取存储介质中。
上述提到的存储介质可以是只读存储器，磁盘或光盘等。尽管上面已经示出和描述了本申请的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本申请的限制，本领域的普通技术人员在本申请的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (45)
1.一种多旋翼无人机的控制方法，其特征在于，包括：
获取所述无人机的每个旋翼的动力状态；及
在基于所述动力状态确定所述无人机的任意一个旋翼的动力失效时，控制所述无人机进入平衡模式；
其中，在所述平衡模式下，所述无人机以大于第一阈值的角速度进行自转，且所述无人机在水平方向的位移小于预设位移量；所述控制所述无人机进入平衡模式，包括：
获取所述无人机的第一控制参数；
获取所述无人机的前馈参数；
根据所述前馈参数及所述第一控制参数对所述无人机的每个旋翼重新分配升力；及
根据每个旋翼重新分配的升力控制所述无人机的对应旋翼的电机转动，以使所述无人机以大于所述第一阈值的角速度进行自转，及所述无人机在水平方向的位移小于所述预设位移量。
2.根据权利要求1所述的控制方法，其特征在于，所述控制所述无人机进入平衡模式，包括：
控制所述无人机以小于第二阈值的角速度自转；及
控制所述无人机自转的角速度逐渐增大，直至达到所述平衡模式下的角速度，以进入所述平衡模式。
3.根据权利要求1所述的控制方法，其特征在于，所述控制所述无人机进入平衡模式，包括：
所述第一控制参数包括所述旋翼失效前所述无人机的第一控制力矩及第一控制总升力；
所述前馈参数包括所述旋翼失效后所述无人机的前馈力矩及前馈总升力。
4.根据权利要求1所述的控制方法，其特征在于，所述根据所述前馈参数及所述第一控制参数对所述无人机的每个旋翼重新分配升力，包括：
根据所述前馈参数及所述第一控制参数获取第二控制参数，所述第二控制参数包括所述旋翼失效后所述无人机的第二控制力矩及第二控制总升力；及
根据预设的分配矩阵及所述第二控制参数对所述无人机的每个旋翼重新分配升力。
5.根据权利要求1所述的控制方法，其特征在于，所述获取所述无人机的前馈参数，包括：
获取每个旋翼的电机关于前馈参数的升力分配映射关系；及
利用迭代优化算法根据所述升力分配映射关系获取所述前馈参数，所述前馈参数使得动力失效的旋翼的升力小于预设值。
6.根据权利要求1所述的控制方法，其特征在于，所述获取所述无人机的第一控制参数，包括：
获取所述无人机的期望姿态；
获取所述无人机的测量姿态；
根据所述期望姿态及所述测量姿态获取期望角速度；及
根据所述无人机的测量角速度及所述期望角速度获取所述第一控制参数。
7.根据权利要求1所述的控制方法，其特征在于，还包括：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩控制所述无人机的姿态，以进入稳定模式；
其中，在所述稳定模式下，所述无人机能够保持以大于第一阈值的角速度进行自转，且所述无人机能够根据指令执行对应的操作。
8.根据权利要求7所述的控制方法，其特征在于，所述指令包括返航指令，所述无人机能够根据指令执行对应的操作包括：所述无人机根据所述返航指令返航；和/或
所述指令包括悬停指令，所述无人机能够根据指令执行对应的操作包括：所述无人机根据所述悬停指令悬停；和/或
所述指令包括降落指令，所述无人机能够根据指令执行对应的操作包括：所述无人机根据所述降落指令降落；和/或，
所述指令包括飞行控制指令，所述飞行控制指令包括飞行方向和/或飞行速度，所述无人机能够根据指令执行对应的操作包括：所述无人机根据所述飞行控制指令飞行。
9.根据权利要求7所述的控制方法，其特征在于，所述根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩控制所述无人机的姿态，以进入稳定模式，包括：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩，控制所述无人机的横滚角和/或俯仰角在预定范围内变化，以进入稳定模式。
10.根据权利要求7所述的控制方法，其特征在于，所述根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩控制所述无人机的姿态，以进入稳定模式，包括：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩获取期望参数，所述期望参数包括所述无人机的横滚轴的期望角速度及俯仰轴的期望角速度；
根据所述期望参数及测量参数获取第三控制参数，所述第三控制参数包括所述旋翼失效后所述无人机的第三控制力矩及第三控制总升力；及
根据所述第三控制参数控制所述无人机的姿态以进入所述稳定模式。
11.根据权利要求10所述的控制方法，其特征在于，所述根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩获取期望参数，包括：
获取所述无人机在横滚轴及俯仰轴上的分配力矩；
根据所述分配力矩及预设的第一分配系数及预设的第二分配系数获取所述陀螺力矩；及
根据所述陀螺力矩及陀螺力矩映射关系获取所述期望参数。
12.根据权利要求11所述的控制方法，其特征在于，所述第一分配系数大于0小于等于1；和/或
所述第二分配系数大于0小于等于1。
13.根据权利要求11所述的控制方法，其特征在于，所述第一分配系数与所述第二分配系数相同。
14.根据权利要求1所述的控制方法，其特征在于，还包括：
根据所述无人机的当前飞行状态控制所述无人机的水平速度，以使得所述无人机的水平加速度在预定范围内。
15.根据权利要求14所述的控制方法，其特征在于，所述根据所述无人机的当前飞行状态控制所述无人机的水平速度，以使得所述无人机的水平加速度在预定范围内，包括：
获取所述无人机的期望水平速度；
获取所述无人机的测量水平速度；
根据所述期望水平速度、所述测量水平速度、及所述无人机的当前飞行状态输出速度调节信号；及
根据所述速度调节信号控制所述无人机的水平速度，以使得所述无人机的水平加速度在预定范围内。
16.一种多旋翼无人机，其特征在于，包括：
机身；
设置在所述机身上的多个旋翼；及
设置在所述机身上的一个或多个控制器，一个或多个所述控制器用于：
获取所述无人机的每个旋翼的动力状态；及
在基于所述动力状态确定所述无人机的任意一个旋翼的动力失效时，控制所述无人机以小于第二阈值的角速度自转；及
控制所述无人机自转的角速度逐渐增大，直至达到平衡模式下的角速度，以进入所述平衡模式；
其中，在所述平衡模式下，所述无人机以大于第一阈值的角速度进行自转，且所述无人机在水平方向的位移小于预设位移量。
17.根据权利要求16所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
获取所述无人机的第一控制参数，所述第一控制参数包括所述旋翼失效前所述无人机的第一控制力矩及第一控制总升力；
获取所述无人机的前馈参数，所述前馈参数包括所述旋翼失效后所述无人机的前馈力矩及前馈总升力；
根据所述前馈参数及所述第一控制参数对所述无人机的每个旋翼重新分配升力；及
根据每个旋翼重新分配的升力控制所述无人机的对应旋翼的电机转动，以使所述无人机以大于第一阈值的角速度进行自转，及所述无人机在水平方向的位移小于预设位移量。
18.根据权利要求17所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
根据所述前馈参数及所述第一控制参数获取第二控制参数，所述第二控制参数包括所述旋翼失效后所述无人机的第二控制力矩及第二控制总升力；及
根据预设的分配矩阵及所述第二控制参数对所述无人机的每个旋翼重新分配升力。
19.根据权利要求17所述的多旋翼无人机，其特征在于，所一个或多个所述控制器还用于：
获取每个旋翼的电机关于前馈参数的升力分配映射关系；及
利用迭代优化算法根据所述升力分配映射关系获取所述前馈参数，所述前馈参数使得动力失效的旋翼的升力小于预设值。
20.根据权利要求17所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
获取所述无人机的期望姿态；
获取所述无人机的测量姿态；
根据所述期望姿态及所述测量姿态获取期望角速度；及
根据所述无人机的测量角速度及所述期望角速度获取所述第一控制参数。
21.根据权利要求16所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩控制所述无人机的姿态，以进入稳定模式；
其中，在所述稳定模式下，所述无人机能够保持以大于第一阈值的角速度进行自转，且所述无人机能够根据指令执行对应的操作。
22.根据权利要求21所述的多旋翼无人机，其特征在于，所述指令包括返航指令，一个或多个所述控制器还用于：控制所述无人机根据所述返航指令返航；和/或
所述指令包括悬停指令，一个或多个所述控制器还用于：控制所述无人机根据所述悬停指令悬停；和/或
所述指令包括降落指令，一个或多个所述控制器还用于：控制所述无人机根据所述降落指令降落；和/或，
所述指令包括飞行控制指令，所述飞行控制指令包括飞行方向和/或飞行速度，一个或多个所述控制器还用于：控制所述无人机根据所述飞行控制指令飞行。
23.根据权利要求21所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩，控制所述无人机的横滚角和/或俯仰角在预定范围内变化，以进入稳定模式。
24.根据权利要求21所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩获取期望参数，所述期望参数包括所述无人机的横滚轴的期望角速度及俯仰轴的期望角速度；
根据所述期望参数及测量参数获取第三控制参数，所述第三控制参数包括所述旋翼失效后所述无人机的第三控制力矩及第三控制总升力；及
根据所述第三控制参数控制所述无人机的姿态以进入所述稳定模式。
25.根据权利要求24所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
获取所述无人机在横滚轴及俯仰轴上的分配力矩；
根据所述分配力矩及预设的第一分配系数及预设的第二分配系数获取所述陀螺力矩；及
根据所述陀螺力矩及陀螺力矩映射关系获取所述期望参数。
26.根据权利要求25所述的多旋翼无人机，其特征在于，所述第一分配系数大于0小于等于1；和/或
所述第二分配系数大于0小于等于1。
27.根据权利要求25所述的多旋翼无人机，其特征在于，所述第一分配系数与所述第二分配系数相同。
28.根据权利要求16所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
根据所述无人机的当前飞行状态控制所述无人机的水平速度，以使得所述无人机的水平加速度在预定范围内。
29.根据权利要求28所述的多旋翼无人机，其特征在于，一个或多个所述控制器还用于：
获取所述无人机的期望水平速度；
获取所述无人机的测量水平速度；
根据所述期望水平速度、所述测量水平速度、及所述无人机的当前飞行状态输出速度调节信号；及
根据所述速度调节信号控制所述无人机的水平速度，以使得所述无人机的水平加速度在预定范围内。
30.一种控制装置，用于多旋翼无人机，所述多旋翼无人机包括机身及设置在所述机身上的多个旋翼，其特征在于，所述控制装置包括一个或多个控制器，一个或多个所述控制器用于：
获取所述无人机的每个旋翼的动力状态；及
在基于所述动力状态确定所述无人机的任意一个旋翼的动力失效时，控制所述无人机进入平衡模式；
其中，在所述平衡模式下，所述无人机以大于第一阈值的角速度进行自转，且所述无人机在水平方向的位移小于预设位移量；一个或多个所述控制器还用于：
所述控制所述无人机进入平衡模式，包括：
获取所述无人机的第一控制参数；
获取所述无人机的前馈参数；
根据所述前馈参数及所述第一控制参数对所述无人机的每个旋翼重新分配升力；及
根据每个旋翼重新分配的升力控制所述无人机的对应旋翼的电机转动，以使所述无人机以大于所述第一阈值的角速度进行自转，及所述无人机在水平方向的位移小于所述预设位移量。
31.根据权利要求30所述的控制装置，其特征在于，一个或多个所述控制器还用于：
控制所述无人机以小于第二阈值的角速度自转；及
控制所述无人机自转的角速度逐渐增大，直至达到所述平衡模式下的角速度，以进入所述平衡模式。
32.根据权利要求30所述的控制装置，其特征在于，所述第一控制参数包括所述旋翼失效前所述无人机的第一控制力矩及第一控制总升力；
所述前馈参数包括所述旋翼失效后所述无人机的前馈力矩及前馈总升力。
33.根据权利要求30所述的控制装置，其特征在于，一个或多个所述控制器还用于：
根据所述前馈参数及所述第一控制参数获取第二控制参数，所述第二控制参数包括所述旋翼失效后所述无人机的第二控制力矩及第二控制总升力；及
根据预设的分配矩阵及所述第二控制参数对所述无人机的每个旋翼重新分配升力。
34.根据权利要求30所述的控制装置，其特征在于，所一个或多个所述控制器还用于：
获取每个旋翼的电机关于前馈参数的升力分配映射关系；及
利用迭代优化算法根据所述升力分配映射关系获取所述前馈参数，所述前馈参数使得动力失效的旋翼的升力小于预设值。
35.根据权利要求30所述的控制装置，其特征在于，一个或多个所述控制器还用于：
获取所述无人机的期望姿态；
获取所述无人机的测量姿态；
根据所述期望姿态及所述测量姿态获取期望角速度；及
根据所述无人机的测量角速度及所述期望角速度获取所述第一控制参数。
36.根据权利要求30所述的控制装置，其特征在于，一个或多个所述控制器还用于：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩控制所述无人机的姿态，以进入稳定模式；
其中，在所述稳定模式下，所述无人机能够保持以大于第一阈值的角速度进行自转，且所述无人机能够根据指令执行对应的操作。
37.根据权利要求36所述的控制装置，其特征在于，所述指令包括返航指令，一个或多个所述控制器还用于：控制所述无人机根据所述返航指令返航；和/或
所述指令包括悬停指令，一个或多个所述控制器还用于：控制所述无人机根据所述悬停指令悬停；和/或
所述指令包括降落指令，一个或多个所述控制器还用于：控制所述无人机根据所述降落指令降落；和/或，
所述指令包括飞行控制指令，所述飞行控制指令包括飞行方向和/或飞行速度，一个或多个所述控制器还用于：控制所述无人机根据所述飞行控制指令飞行。
38.根据权利要求36所述的控制装置，其特征在于，一个或多个所述控制器还用于：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩，控制所述无人机的横滚角和/或俯仰角在预定范围内变化，以进入稳定模式。
39.根据权利要求36所述的控制装置，其特征在于，一个或多个所述控制器还用于：
根据所述无人机以大于第一阈值的角速度自转时产生的陀螺力矩获取期望参数，所述期望参数包括所述无人机的横滚轴的期望角速度及俯仰轴的期望角速度；
根据所述期望参数及测量参数获取第三控制参数，所述第三控制参数包括所述旋翼失效后所述无人机的第三控制力矩及第三控制总升力；及
根据所述第三控制参数控制所述无人机的姿态以进入所述稳定模式。
40.根据权利要求39所述的控制装置，其特征在于，一个或多个所述控制器还用于：
获取所述无人机在横滚轴及俯仰轴上的分配力矩；
根据所述分配力矩及预设的第一分配系数及预设的第二分配系数获取所述陀螺力矩；及
根据所述陀螺力矩及陀螺力矩映射关系获取所述期望参数。
41.根据权利要求40所述的控制装置，其特征在于，所述第一分配系数大于0小于等于1；和/或
所述第二分配系数大于0小于等于1。
42.根据权利要求40所述的控制装置，其特征在于，所述第一分配系数与所述第二分配系数相同。
43.根据权利要求30所述的控制装置，其特征在于，一个或多个所述控制器还用于：
根据所述无人机的当前飞行状态控制所述无人机的水平速度，以使得所述无人机的水平加速度在预定范围内。
44.根据权利要求43所述的控制装置，其特征在于，一个或多个所述控制器还用于：
获取所述无人机的期望水平速度；
获取所述无人机的测量水平速度；
根据所述期望水平速度、所述测量水平速度、及所述无人机的当前飞行状态输出速度调节信号；及
根据所述速度调节信号控制所述无人机的水平速度，以使得所述无人机的水平加速度在预定范围内。
45.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，所述计算机程序被处理器执行时实现权利要求1-15任意一项所述的控制方法。
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/CN2020/089021 WO2021223173A1 (zh) | 2020-05-07 | 2020-05-07 | 多旋翼无人机及其控制方法、控制装置和计算机可读存储介质 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113039502A CN113039502A (zh) | 2021-06-25 |
| CN113039502B true CN113039502B (zh) | 2024-04-12 |
Family
ID=76460408
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202080005960.0A Active CN113039502B (zh) | 2020-05-07 | 2020-05-07 | 多旋翼无人机及其控制方法、控制装置和计算机可读存储介质 |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US20230315124A1 (zh) |
| CN (1) | CN113039502B (zh) |
| WO (1) | WO2021223173A1 (zh) |
Families Citing this family (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI800102B (zh) * | 2021-11-16 | 2023-04-21 | 財團法人工業技術研究院 | 載具頭向補償方法及系統 |
| CN114476052B (zh) * | 2022-03-08 | 2024-03-05 | 广州极飞科技股份有限公司 | 无人机控制方法、装置、控制设备及可读存储介质 |
| CN115826596B (zh) * | 2022-09-19 | 2023-08-25 | 国家能源集团宝庆发电有限公司 | 基于多旋翼无人机的智能火电厂烟囱巡检方法及*** |
| CN116088557B (zh) * | 2023-03-31 | 2023-06-23 | 湖南大学 | 一种全驱动型六旋翼无人机位姿控制方法及装置 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107077142A (zh) * | 2016-10-25 | 2017-08-18 | 深圳市大疆创新科技有限公司 | 多旋翼飞行器及其控制方法、控制装置及飞行控制*** |
| CN107226206A (zh) * | 2016-03-24 | 2017-10-03 | 深圳市创翼睿翔天空科技有限公司 | 多旋翼无人机安全降落***及方法 |
| CN110531778A (zh) * | 2019-07-17 | 2019-12-03 | 北京航空航天大学 | 一种多旋翼无人机自驾仪桨叶损伤的估计与自愈控制方法 |
| CN110888451A (zh) * | 2019-12-20 | 2020-03-17 | 国网山西省电力公司电力科学研究院 | 一种多旋翼无人机容错控制方法及*** |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20020104922A1 (en) * | 2000-12-08 | 2002-08-08 | Mikio Nakamura | Vertical takeoff and landing aircraft with multiple rotors |
| US20050178879A1 (en) * | 2004-01-15 | 2005-08-18 | Youbin Mao | VTOL tailsitter flying wing |
| CN102126554A (zh) * | 2011-01-28 | 2011-07-20 | 南京航空航天大学 | 面对称布局的多旋翼无人飞行器 |
| CN103359283A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 一种高可靠性倾转旋翼无人飞行器 |
| CN103963963B (zh) * | 2014-04-22 | 2016-01-13 | 深圳市大疆创新科技有限公司 | 多旋翼飞行器的飞行控制方法及*** |
| WO2018110598A1 (ja) * | 2016-12-13 | 2018-06-21 | 株式会社自律制御システム研究所 | 無人航空機、無人航空機の制御装置、無人航空機の制御方法、及び無人航空機の障害検出装置 |
-
2020
- 2020-05-07 CN CN202080005960.0A patent/CN113039502B/zh active Active
- 2020-05-07 WO PCT/CN2020/089021 patent/WO2021223173A1/zh active Application Filing
-
2022
- 2022-11-02 US US17/979,483 patent/US20230315124A1/en active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107226206A (zh) * | 2016-03-24 | 2017-10-03 | 深圳市创翼睿翔天空科技有限公司 | 多旋翼无人机安全降落***及方法 |
| CN107077142A (zh) * | 2016-10-25 | 2017-08-18 | 深圳市大疆创新科技有限公司 | 多旋翼飞行器及其控制方法、控制装置及飞行控制*** |
| CN110531778A (zh) * | 2019-07-17 | 2019-12-03 | 北京航空航天大学 | 一种多旋翼无人机自驾仪桨叶损伤的估计与自愈控制方法 |
| CN110888451A (zh) * | 2019-12-20 | 2020-03-17 | 国网山西省电力公司电力科学研究院 | 一种多旋翼无人机容错控制方法及*** |
Also Published As
| Publication number | Publication date |
|---|---|
| WO2021223173A1 (zh) | 2021-11-11 |
| US20230315124A1 (en) | 2023-10-05 |
| CN113039502A (zh) | 2021-06-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN113039502B (zh) | 多旋翼无人机及其控制方法、控制装置和计算机可读存储介质 | |
| AU2019260589B2 (en) | Thrust allocation for aerial vehicle | |
| AU2017252251B2 (en) | Wind finding and compensation for unmanned aircraft systems | |
| US20240002047A1 (en) | Online optimization-based flight control system | |
| US11453492B2 (en) | Transformable hovering rotorcraft | |
| EP3805893B1 (en) | Method of controlling an actuator system and aircraft using same | |
| US10435147B2 (en) | Multirotor aircraft control systems | |
| WO2012134460A1 (en) | Flight control laws for constant vector flat turns | |
| US10860038B2 (en) | System and method for automatic rotorcraft tail strike protection | |
| WO2020237528A1 (zh) | 垂直起降无人机的飞行控制方法、设备及垂直起降无人机 | |
| Flores et al. | 6-dof hovering controller design of the quad tiltrotor aircraft: Simulations and experiments | |
| WO2021072089A1 (en) | Airflow sensing based adaptive nonlinear flight control of a flying car or fixed-wing vtol | |
| EP3546346B1 (en) | Rotorcraft with weight-on-wheels sensors and fcc (flight control computer) | |
| Raj et al. | Iterative learning based feedforward control for transition of a biplane-quadrotor tailsitter UAS | |
| CN108107902B (zh) | 横航向姿态控制方法及相关装置 | |
| US10189559B2 (en) | Rotor speed control using a feed-forward rotor speed command | |
| Kang et al. | Flight test results of automatic tilt control for small scaled tilt rotor aircraft | |
| Benzaid et al. | Robust trajectory tracking control of a quadrotor UAV | |
| Zhu et al. | Design and experimental testing of safe flight control system for novel vertical take-off and landing aircraft | |
| Chen et al. | Identification and control of a hovering tiltrotor UAV | |
| CN114348250B (zh) | 横列式双旋翼飞行器及其飞行控制方法、电子设备 | |
| CN111392036A (zh) | 用于控制旋翼飞行器的***及方法 | |
| CN112799419B (zh) | 用于双旋翼无人机的控制方法、装置、无人机和存储介质 | |
| Gu | Model Based Design and Optimization of Winged UAVs | |
| CN117806352A (zh) | 基于超前校正的无人机抗饱和控制方法及装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |