CN108341072B - 无人机动力系统故障检测的方法、装置及无人机 - Google Patents
无人机动力系统故障检测的方法、装置及无人机 Download PDFInfo
- Publication number
- CN108341072B CN108341072B CN201810141308.6A CN201810141308A CN108341072B CN 108341072 B CN108341072 B CN 108341072B CN 201810141308 A CN201810141308 A CN 201810141308A CN 108341072 B CN108341072 B CN 108341072B
- Authority
- CN
- China
- Prior art keywords
- disturbance
- module
- unmanned aerial
- aerial vehicle
- flight
- 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 16
- 238000001514 detection method Methods 0.000 claims abstract description 48
- 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 abstract description 26
- 239000011159 matrix material Substances 0.000 claims abstract description 14
- 239000013598 vector Substances 0.000 claims description 30
- 230000005856 abnormality Effects 0.000 claims description 3
- 230000002159 abnormal effect Effects 0.000 abstract description 8
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 230000000694 effects Effects 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 1
- 238000010586 diagram 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
- 239000000725 suspension Substances 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64F—GROUND OR AIRCRAFT-CARRIER-DECK INSTALLATIONS SPECIALLY ADAPTED FOR USE IN CONNECTION WITH AIRCRAFT; DESIGNING, MANUFACTURING, ASSEMBLING, CLEANING, MAINTAINING OR REPAIRING AIRCRAFT, NOT OTHERWISE PROVIDED FOR; HANDLING, TRANSPORTING, TESTING OR INSPECTING AIRCRAFT COMPONENTS, NOT OTHERWISE PROVIDED FOR
- B64F5/00—Designing, manufacturing, assembling, cleaning, maintaining or repairing aircraft, not otherwise provided for; Handling, transporting, testing or inspecting aircraft components, not otherwise provided for
- B64F5/60—Testing or inspecting aircraft components or systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01R—MEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
- G01R31/00—Arrangements for testing electric properties; Arrangements for locating electric faults; Arrangements for electrical testing characterised by what is being tested not provided for elsewhere
- G01R31/34—Testing dynamo-electric machines
- G01R31/343—Testing dynamo-electric machines in operation
-
- 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
-
- 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)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Transportation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种无人机动力系统故障检测的方法,包括:S1、在无人机飞行期间,获取扰动数据;S2、判断扰动数据是否大于预设值,是则进入S3;S3、根据扰动数据调整控制信号并输出抗扰动控制信号。本发明的有益效果在于:提供一种检测方法,将动力缺失异常的情况当作外部扰动处理,得到扰动的大小和方向,从而定位故障电机,让飞控系统及时改变控制分配矩阵,让余下的动力系统能够保持无人机机体稳定飞行,大大降低了多旋翼无人机因动力故障造成的坠机概率。
Description
技术领域
本发明涉及无人机飞行控制领域,尤其是指一种无人机动力系统故障检测的方法、装置及无人机。
背景技术
由于多旋翼飞行器的良好飞行性能和悬停特性,近些年来应用于越来越多的行业中,同时无人机的安全问题也愈发受到人们的重视,尤其是在运输行业应用领域,无人机自身的自重和负载都比较大,动力系统一旦出现异常,抛开财产损失不说,无人机坠落所造成的安全问题也很严峻,所以为了无人机飞行的安全性能,对多旋翼无人机动力系统的故障检测尤为重要。
发明内容
本发明所要解决的技术问题是:提供一种快速定位无人机动力系统中故障动力源,从而可以快速调整控制策略,保证无人机的平稳飞行并安全降落的装置及方法。
为了解决上述技术问题,本发明采用的技术方案为:一种无人机动力系统故障检测的方法,包括:
S1、在无人机飞行期间,获取扰动数据;
S2、判断扰动数据是否大于预设值,是则进入S3;
S3、根据扰动数据调整控制信号并输出抗扰动控制信号。
进一步的,步骤S3中,包括根据故障电机信息对剩余电机进行矩阵重新分配的步骤。
进一步的,步骤S3之后,还包括向地面站发送异常信息的步骤。
本发明还包括一种无人机动力系统故障检测装置,包括扰动观测模块、判断模块和混合模块,所述扰动观测模块分别与所述判断模块和混合模块连接,
所述扰动观测模块用于在无人机飞行期间,获取扰动数据;
所述判断模块用于判断扰动数据是否大于预设值;
所述混合模块用于根据扰动数据调整控制信号并输出抗扰动控制信号。
进一步的,所述扰动观测模块包括扰动方向检测单元和扰动数值检测单元,
本发明还包括一种无人机控制系统,所述遥控模块与飞控模块连接,所述飞控模块与所述故障检测装置的混合模块的一个输入端连接,所述故障检测装置与所述无人机连接,所述飞控模块包括加法单元,所述无人机包括平衡检测模块,所述平衡检测模块分别与加法单元和所述故障检测装置的扰动观测模块连接,所述扰动观测模块与所述混合模块的另一个输入端连接,
所述遥控模块用于对无人机发送飞行控制信号;
所述平衡检测模块用于输出无人机姿态信号;
所述加法单元用于将所述遥控模块发送的飞行控制信号和所述平衡检测模块输出的无人机姿态信号进行加法求和运算。
本发明的有益效果在于:提供一种检测方法,将动力缺失异常的情况当作外部扰动处理,得到扰动的大小和方向,从而定位故障电机,让飞控系统及时改变控制分配矩阵,让余下的动力系统能够保持无人机机体稳定飞行,大大降低了多旋翼无人机因动力故障造成的坠机概率。
附图说明
下面结合附图详述本发明的具体结构:
图1为本发明的检测方法流程示意图;
图2为本发明的一个实施例的结构模型示意图;
图3为本发明的一个实施例的装置系统框图。
1-遥控装置;2-飞控模块;3-混合模块;4-无人机;5-扰动观测模块;6-加法模块;7-平衡检测模块。
具体实施方式
为详细说明本发明的技术内容、构造特征、所实现目的及效果,以下结合实施方式并配合附图详予说明。
实施例1
请参阅图1以及图2,一种无人机动力系统故障检测的方法,包括:
本实施例中,以六旋翼无人机为例说明故障检测原理和实现过程,六旋翼无人机的动力分别分布在六个机臂上,由六个电机和螺旋桨共同提供升力,滚转,偏航和俯仰力矩,当各个臂的动力系统均正常时,由于结构的对称性,系统的动力模型如下:
上式中表示的是每个电机的转速,表示螺旋桨的升力系数,表示螺旋桨的反扭力
系数,表示系统所产生的总升力,表示横滚力矩,表示俯仰力矩,表示偏航力矩,表示动
力系统的动力矩阵,表示动力系统的动力矩阵的向量。
当某个动力出现缺失异常时,会反应到对应控制通道的控制量上,通过在控制环
路中加入扰动观测器,将缺失的动力部分作为外部扰动来估计,我们可以得到扰动向量
的大小和方向,表示第i个电机轴在XY平面的单位向量与扰动向量的夹角,当夹角
小于一定阈值,并且和扰动向量的模超过一定阈值,此时认为此电机发生故障。
数学表达如下:
在理想的,无外部环境扰动的情况下,当一个轴的动力缺失时,这部分缺失的动力
经过扰动估计会估计到与缺失动力轴的方向重合,大小与此时的油门大小有关,即为0,
扰动向量模值一般取悬停时的油门大小为0.4,考虑到环境的扰动影响和数据噪声,一般
不可能为0,需要根据实际飞行测试数据确定。
从上述描述可知,本发明的有益效果在于:提供一种检测方法,将动力缺失异常的情况当作外部扰动处理,得到扰动的大小和方向,从而定位故障电机,让飞控系统及时改变控制分配矩阵,让余下的动力系统能够保持无人机机体稳定飞行,大大降低了多旋翼无人机因动力故障造成的坠机概率。
实施例2
在实施例1的基础上,步骤S3中,包括根据故障电机信息对剩余电机进行矩阵重新分配的步骤。
本实施例中,当编号为1的电机出现故障时,故障动力模型如下:
系统中的飞控模块根据故障动力模型改变控制分配矩阵,让余下的动力系统能够正常的执行设定的控制指令,改善个别电机出现故障后,飞控模块对飞机的控制效果。
实施例3
在实施例2的基础上,步骤S3之后,还包括向地面站发送异常信息的步骤。
本实施例中,当检测到无人机动力系统故障后,及时向地面站发送无人机异常信息,有利于地面人员第一时间定位并追踪到故障无人机。
请参阅图3,本发明还包括一种无人机动力系统故障检测装置,包括扰动观测模块5、判断模块和混合模块3,所述扰动观测模块5分别与所述判断模块和混合模块3连接,
所述扰动观测模块5用于在无人机4飞行期间,获取扰动数据;
所述判断模块用于判断扰动数据是否大于预设值;
所述混合模块3用于根据扰动数据调整控制信号并输出抗扰动控制信号。
所述扰动观测模块5包括扰动方向检测单元和扰动数值检测单元,
本实施例中,通过在控制环路中加入扰动观测器,将缺失的动力部分作为外部扰
动来估计,我们可以得到扰动向量的大小和方向,表示第i个电机轴在XY平面的单位
向量与扰动向量的夹角,当夹角小于一定阈值,并且和扰动向量的模超过一定阈
值,此时认为此电机发生故障。
本发明还包括一种无人机控制系统,包括上述的故障检测装置、遥控模块1和无人机4,所述遥控模块1与飞控模块2连接,所述飞控模块2与所述故障检测装置的混合模块3的一个输入端连接,所述故障检测装置与所述无人机4连接,所述飞控模块2包括加法单元6,所述无人机4包括平衡检测模块7,所述平衡检测模块7分别与加法单元6和所述故障检测装置的扰动观测模块连接,所述扰动观测模块与所述混合模块3的另一个输入端连接,
所述遥控模块用于对无人机发送飞行控制信号;
所述平衡检测模块用于输出无人机姿态信号;
所述加法单元用于将所述遥控模块发送的飞行控制信号和所述平衡检测模块输出的无人机姿态信号进行加法求和运算。
本实施例中,无人机包括六个机臂,每个机臂对应设有电子调速器、电机和螺旋桨,加法模块6将无人机的平衡检测模块7反馈的飞机姿态信号及遥控模块1发送的遥控指令或飞行程序进行加法求和并输出至飞控模块2,飞控模块2分别对六个电子调速器发送控制信号,电子调速器控制电机的转速,使飞机做出悬停、前进、后退、平移、旋转等动作,当动力系统的某个部件出现异常时,对应机臂的动力就缺失,飞机的姿态即出现异常,无人机的平衡检测模块7将异常信号反应到飞控模块2对应控制通道的控制量上,此时用故障检测装置将缺失的动力部分作为外部扰动来估计,即可获得扰动数据,经过进一步分析即可定位出故障的机臂,进而飞控模块2改变控制分配矩阵,让余下的动力系统能够正常的达到设定的控制指令,改善单个电机出现故障后的控制效果。
以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。
Claims (6)
4.如权利要求3所述的方法,其特征在于:步骤S3之后,还包括向地面站发送异常信息的步骤。
6.一种无人机控制系统,其特征在于:包括如权利要求5所述的故障检测装置、遥控模块和无人机,所述遥控模块与飞控模块连接,所述飞控模块与所述故障检测装置的混合模块的一个输入端连接,所述故障检测装置与所述无人机连接,所述飞控模块包括加法单元,所述无人机包括平衡检测模块,所述平衡检测模块分别与加法单元和所述故障检测装置的扰动观测模块连接,所述扰动观测模块与所述混合模块的另一个输入端连接,
所述遥控模块用于对无人机发送飞行控制信号;
所述平衡检测模块用于输出无人机姿态信号;
所述加法单元用于将所述遥控模块发送的飞行控制信号和所述平衡检测模块输出的无人机姿态信号进行加法求和运算。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810141308.6A CN108341072B (zh) | 2018-02-11 | 2018-02-11 | 无人机动力系统故障检测的方法、装置及无人机 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810141308.6A CN108341072B (zh) | 2018-02-11 | 2018-02-11 | 无人机动力系统故障检测的方法、装置及无人机 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108341072A CN108341072A (zh) | 2018-07-31 |
CN108341072B true CN108341072B (zh) | 2021-06-04 |
Family
ID=62960164
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810141308.6A Active CN108341072B (zh) | 2018-02-11 | 2018-02-11 | 无人机动力系统故障检测的方法、装置及无人机 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108341072B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108873925B (zh) * | 2018-08-02 | 2021-08-24 | 深圳市吉影科技有限公司 | 一种水下无人机的定俯仰角运动控制方法及其装置 |
CN111114763A (zh) * | 2020-01-15 | 2020-05-08 | 亿航智能设备(广州)有限公司 | 螺旋桨动力失效的主动补偿方法、无人机以及存储介质 |
CN112373677B (zh) * | 2020-11-18 | 2021-06-22 | 三生万物(北京)人工智能技术有限公司 | 一种六旋翼无人机动力缺失保护系统、保护方法 |
WO2022193075A1 (zh) * | 2021-03-15 | 2022-09-22 | 深圳市大疆创新科技有限公司 | 无人飞行器控制方法、无人飞行器和存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE1756781C2 (de) * | 1967-07-18 | 1982-07-01 | Textron Inc., 02903 Providence, R.I. | Steuer- und Stabilisierungsanordnung für eine Steuereinrichtung eines Flugzeuges und Verfahren zur Steuerung des Flugzustandes |
CN102464108A (zh) * | 2010-11-01 | 2012-05-23 | 成都飞机工业(集团)有限责任公司 | 无人机发动机故障处理方法 |
CN104443425A (zh) * | 2013-09-20 | 2015-03-25 | 空中客车运营简化股份公司 | 用于识别飞行器中的有缺陷的设备的方法 |
CN106020222A (zh) * | 2016-06-24 | 2016-10-12 | 天津理工大学 | 一种三自由度直升机姿态的自抗扰控制方法 |
CN106451436A (zh) * | 2016-11-04 | 2017-02-22 | 广东电网有限责任公司电力科学研究院 | 一种综合量化评估发电机组动态特性的方法及系统 |
CN107074351A (zh) * | 2016-09-30 | 2017-08-18 | 深圳市大疆创新科技有限公司 | 无人机的控制方法、装置及无人飞行器 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7231319B2 (en) * | 2003-06-18 | 2007-06-12 | Eaton Corporation | System and method for proactive motor wellness diagnosis based on potential cavitation faults |
JP6451662B2 (ja) * | 2016-02-23 | 2019-01-16 | 株式会社安川電機 | 異常判定装置、異常判定プログラム、異常判定システム、及びモータ制御装置 |
-
2018
- 2018-02-11 CN CN201810141308.6A patent/CN108341072B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE1756781C2 (de) * | 1967-07-18 | 1982-07-01 | Textron Inc., 02903 Providence, R.I. | Steuer- und Stabilisierungsanordnung für eine Steuereinrichtung eines Flugzeuges und Verfahren zur Steuerung des Flugzustandes |
CN102464108A (zh) * | 2010-11-01 | 2012-05-23 | 成都飞机工业(集团)有限责任公司 | 无人机发动机故障处理方法 |
CN104443425A (zh) * | 2013-09-20 | 2015-03-25 | 空中客车运营简化股份公司 | 用于识别飞行器中的有缺陷的设备的方法 |
CN106020222A (zh) * | 2016-06-24 | 2016-10-12 | 天津理工大学 | 一种三自由度直升机姿态的自抗扰控制方法 |
CN107074351A (zh) * | 2016-09-30 | 2017-08-18 | 深圳市大疆创新科技有限公司 | 无人机的控制方法、装置及无人飞行器 |
CN106451436A (zh) * | 2016-11-04 | 2017-02-22 | 广东电网有限责任公司电力科学研究院 | 一种综合量化评估发电机组动态特性的方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN108341072A (zh) | 2018-07-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108341072B (zh) | 无人机动力系统故障检测的方法、装置及无人机 | |
US11640178B2 (en) | Unmanned aircraft, device for controlling unmanned aircraft, method for controlling unmanned aircraft, and device for detecting failure of unmanned aircraft | |
US9845148B2 (en) | Aircraft landing gear longitudinal force control | |
US20160114903A1 (en) | Flight envelope protection system for unmanned aerial vehicles | |
CN113568419B (zh) | 一种变载四旋翼无人机容错控制方法 | |
CN111880410B (zh) | 一种针对电机故障的四旋翼无人机容错控制方法 | |
JPH11507454A (ja) | 解析上の冗長性を利用する故障許容自動制御システム | |
CN114578691A (zh) | 考虑舵面故障的飞翼无人机主动抗扰容错姿态控制方法 | |
CN104765312A (zh) | 飞行器可重构控制系统实现方法 | |
CN110531778A (zh) | 一种多旋翼无人机自驾仪桨叶损伤的估计与自愈控制方法 | |
CN115629547B (zh) | 一种面向舵面故障的飞机机载容错控制方法及系统 | |
CN104699105A (zh) | 一种六旋翼飞行器的容错控制方法 | |
Freeman | Reliability assessment for low-cost unmanned aerial vehicles | |
CN112327896A (zh) | 旋翼容错控制方法、装置、计算机存储介质及计算机设备 | |
CN113467244B (zh) | 基于控制矩阵重分配的多旋翼无人机容错控制方法及装置 | |
Saied et al. | Passive fault-tolerant control of an octorotor using super-twisting algorithm: Theory and experiments | |
US11952108B2 (en) | Redundancy systems for small fly-by-wire vehicles | |
CN114740897A (zh) | 飞行控制方法、飞行控制系统及飞行器 | |
Eller et al. | Test and evaluation of a modified f-16 analog flight control computer | |
CN112373677B (zh) | 一种六旋翼无人机动力缺失保护系统、保护方法 | |
CN116736692A (zh) | 一种具有延迟状态约束的四旋翼无人机滑模容错控制方法 | |
Sørensen et al. | UAV fault-tolerant control by combined L 1 adaptive backstepping and fault-dependent control allocation | |
Yang et al. | Control system design for tiltable quad-rotor with propeller failure | |
CN112882388B (zh) | 一种执行器受损下的四旋翼无人机故障检测与诊断方法 | |
CN116027719B (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 |