CN113009932A - 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法 - Google Patents
一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法 Download PDFInfo
- Publication number
- CN113009932A CN113009932A CN202110263210.XA CN202110263210A CN113009932A CN 113009932 A CN113009932 A CN 113009932A CN 202110263210 A CN202110263210 A CN 202110263210A CN 113009932 A CN113009932 A CN 113009932A
- Authority
- CN
- China
- Prior art keywords
- disturbance
- aerial vehicle
- unmanned aerial
- control
- quad
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000013178 mathematical model Methods 0.000 claims description 10
- 230000005484 gravity Effects 0.000 claims description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 abstract description 3
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
Images
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
-
- 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)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法,首先建立四旋翼无人机的动力学模型,针对失配扰动设计扰动观测器,在一定时间内估计处扰动出现的时间和数值大小;针对执行器故障设计故障观测器,估计出执行器故障引起的不确定项大小,基于非奇异终端滑模控制方法设计控制律,并在控制律中加入扰动和不确定项的估计值,在遇到扰动和发生故障时可以及时的补偿从而实现稳定的飞行,相比于现有控制方案能够提高四旋翼无人机的飞行控制性能,更适用于实际飞行过程。
Description
技术领域
本发明涉及四旋翼无人机控制方法,尤其涉及一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法。
背景技术
由于四旋翼无人机具有垂直起降,悬停能力和高速机动性等优势,在商业,军事,民用和工业领域都有广泛的应用,但由于无人机的控制存在耦合度高,非线性,不稳定和参数不确定性,在实际飞行中往往难以达到预期的控制目标。为了提升无人机控制的渐进性能已经提出了多种控制方案,包括滑模控制、反推、自适应和模糊控制方案。为了满足四旋翼飞行器的任务要求,高精度姿态控制必不可少,然而无人机飞行过程中会遇到不确定的外界因素干扰,导致跟踪不准确,从而不能实现对无人机的高精度姿态控制甚至影响正常飞行,如侧风扰动就是影响无人机姿态控制的外界因素之一,由于四旋翼无人机是四转子欠驱动和非线性耦合***,当无人机遭受扰动的影响时,传统的控制方案难以实现要求的控制性能,因此,消除由外部干扰和模型不确定性引起的不利影响,发展防干扰方法已成为控制理论和应用领域的首要问题。基于扰动观测器的控制(DOBC)方案受到越来越多的关注,并已广泛应用于各种***中,以消除外部扰动和模型不确定性。
DOBC方法通常会构造用于估计未知干扰的观测器和具有常规反馈控制器的前馈干扰补偿器,具有鲁棒性强,结构简单,可根据对控制性能的要求设计不同的控制规律,易于在线整定和工程实现等优点。在***状态空间模型中,扰动可分为匹配扰动和失配扰动(扰动和约束输入通过不同的通道进入***)。现有的DOBC方法通常将针对不同扰动的扰动观测器与非线性控制方案集成对无人机进行姿态控制,能够取得较好的控制效果,但这样的方法仅限于解决含有不确定性的***,并且仅取决于匹配条件,这些干扰通过与控制输入相同的通道作用于***,但在无人机的实际飞行中,失配扰动的存在更为普遍,严重影响***的稳定性,因此应用现有的DOBC方法对无人机进行飞行控制容易因为***受失配扰动影响而造成执行器故障。
发明内容
发明目的:本发明的目的是提供一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法以降低实际飞行中频繁遇到的失配扰动对控制精度的影响。
技术方案:本发明的基于扰动观测器控制的四旋翼无人机抗干扰控制方法包括以下步骤:
(1)建立六自由度的四旋翼无人机动力学等效模型;
(2)针对任一自由度建立包含不匹配扰动和执行器故障的二阶数学模型;
(3)针对二阶数学模型中的不匹配扰动设计对应的扰动观测器,在有限时间内估计出扰动出现的时间和数值大小;
(4)将由于执行器故障引起的不确定项视为特殊扰动,建立观测器估计不确定项的大小;
(5)基于非奇异终端滑模控制方法设计控制律以保证四旋翼无人机的飞行性能;
(6)在无人机的控制律中加入步骤(3)和(4)所得的扰动估计值,在飞行过程中针对不匹配扰动和执行器故障进行补偿,保证飞行的稳定。
步骤(1)中动力学等效模型如下:
其中,x,y,z代表四旋翼无人机相对于惯性系的位置坐标;φ,θ,ψ代表四旋翼无人机的欧拉角,即侧倾角,俯仰角和偏航角;u1,u2,u3,u4分别代表推力,侧倾力矩,俯仰力矩和偏航力矩;Ix,Iy,Iz,m分别代表围绕四旋翼的x轴,y轴,z轴惯性常数和四旋翼无人机的质量;l是从每个转子的中心到四旋翼的重心的距离,Jr是螺旋桨的惯性,c是力对力矩的比例因子。
步骤(2)中对高度z建立的二阶数学模型为:
步骤(3)中,扰动观测器形式如下:
vz0=-λ0L1/(r+1)|τz0-x1|r/(r+1)sgn(τz0-x1)+τz1
vz1=-λ1L1/(r)|τz1-vz0|(r-1)/rsgn(τz1-vz0)+τz2
vz(r-1)=-λr-1L1/2|τz(r-1)-vz(r-2)|1/2sgn(τz(r-1)-vz(r-2))+τzr
vzr=-λrLsgn(τzr-vz(r-1))
步骤(4)包括:
其中κ1,κ2为观测器变量,e2=κ2-f,l1,l2为满足以下条件的观测器增益系数:
基于上述滑模面,设计对应的控制律,其表达式如下:
其中sgn为符号函数,其取值如下所示:
有益效果:与现有技术相比,本发明具有如下显著优点:能够在遇到扰动和发生故障时进行及时的补偿,使无人机受到失配干扰和执行器故障时能在较短时间内恢复正常飞行状态,有效减小抖振现象,保持飞行的稳定,提高四旋翼无人机的飞行控制性能。
附图说明
图1为本发明的流程图;
图2为不匹配扰动的真实值和观测器估计值;
图3为执行器故障因子估计图;
图4为有无发生故障飞行轨迹对比曲线;
图5为本发明控制四旋翼无人机飞行轨迹结果图;
图6为本发明与普通非奇异终端滑模控制方法结果对比图;
具体实施方式
下面结合附图对本发明的技术方案作进一步说明。
如图1所示,本发明基于扰动观测器的四旋翼无人机抗干扰控制方法包括如下步骤:
(1)建立六自由度的四旋翼无人机动力学等效模型;
(2)针对任一自由度建立包含不匹配扰动和执行器故障的二阶数学模型;
(3)针对二阶数学模型中的不匹配扰动设计对应的扰动观测器,在有限时间内估计出扰动出现的时间和数值大小;
(4)将由于执行器故障引起的不确定项视为特殊扰动,建立观测器估计不确定项的大小;
(5)基于非奇异终端滑模控制方法设计控制律以保证四旋翼无人机的飞行性能;
(6)在无人机的控制律中加入步骤(3)和(4)所得的扰动估计值,在飞行过程中针对不匹配扰动和执行器故障进行补偿,保证飞行的稳定。
其中,步骤(1)的动力学等效模型表达式如下:
其中,x,y,z代表四旋翼无人机相对于惯性系的位置坐标;φ,θ,ψ代表四旋翼无人机的欧拉角,即侧倾角,俯仰角和偏航角;u1,u2,u3,u4分别代表推力,侧倾力矩,俯仰力矩和偏航力矩;Ix,Iy,Iz,m分别代表围绕四旋翼的x轴,y轴,z轴惯性常数和四旋翼无人机的质量;l是从每个转子的中心到四旋翼的重心的距离,Jr是螺旋桨的惯性,c是力对力矩的比例因子。
步骤(2)中,以高度z为例,对其建立二阶数学模型,表达式如下:
步骤(3)中扰动观测器形式如下:
vz0=-λ0L1/(r+1)|τz0-x1|r/(r+1)sgn(τz0-x1)+τz1
vz1=-λ1L1/(r)|τz1-vz0|(r-1)/rsgn(τz1-vz0)+τz2
vz(r-1)=-λr-1L1/2|τz(r-1)-vz(r-2)|1/2sgn(τz(r-1)-vz(r-2))+τzr
vzr=-λrLsgn(τzr-vz(r-1))
步骤(4)包括:
其中κ1,κ2为观测器变量,e2=κ2-f,l1,l2为满足以下条件的观测器增益系数:
当估计出由于执行器故障引起的不确定项时,可以求解出故障因子,如图3所示。
步骤(5)包括如下步骤:
基于上述滑模面,设计对应的控制律,其表达式如下:
其中sgn为符号函数,其取值如下所示:
图4为z自由度上无人机的理想轨迹、受故障影响后的轨迹以及使用本发明进行控制后的飞行轨迹,图5为无人机理想轨迹和实际轨迹的对比图,可见通过在控制律中加入先前设计的扰动估计值,在遇到扰动和发生故障时可以及时的补偿从而实现稳定的飞行;如图6所示,跟现有控制方法相比,本发明可以更好地减少扰动和执行器故障的影响程度,也可以有效减小抖振现象。
Claims (6)
1.一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法,其特征在于,包括以下步骤:
(1)建立六自由度的四旋翼无人机动力学等效模型;
(2)针对任一自由度建立包含不匹配扰动和执行器故障的二阶数学模型;
(3)针对二阶数学模型中的不匹配扰动设计对应的扰动观测器,在有限时间内估计出扰动出现的时间和数值大小;
(4)将由于执行器故障引起的不确定项视为特殊扰动,建立观测器估计不确定项的大小;
(5)基于非奇异终端滑模控制方法设计控制律以保证四旋翼无人机的飞行性能;
(6)在无人机的控制律中加入步骤(3)和(4)所得的扰动估计值,在飞行过程中针对不匹配扰动和执行器故障进行补偿,保证飞行的稳定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110263210.XA CN113009932B (zh) | 2021-03-11 | 2021-03-11 | 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110263210.XA CN113009932B (zh) | 2021-03-11 | 2021-03-11 | 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113009932A true CN113009932A (zh) | 2021-06-22 |
CN113009932B CN113009932B (zh) | 2022-11-08 |
Family
ID=76404751
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110263210.XA Active CN113009932B (zh) | 2021-03-11 | 2021-03-11 | 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113009932B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116483210A (zh) * | 2023-06-25 | 2023-07-25 | 安徽大学 | 一种基于深度学习和滑模控制的脑控无人机方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107479370A (zh) * | 2017-07-03 | 2017-12-15 | 浙江工业大学 | 一种基于非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 |
CN108445760A (zh) * | 2018-03-14 | 2018-08-24 | 中南大学 | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 |
CN109188913A (zh) * | 2018-10-18 | 2019-01-11 | 南京邮电大学 | 一种无人机姿态的鲁棒控制方法和实现该方法的鲁棒控制器 |
CN109343369A (zh) * | 2018-11-19 | 2019-02-15 | 南京邮电大学 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
CN111722634A (zh) * | 2020-05-28 | 2020-09-29 | 南京邮电大学 | 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 |
-
2021
- 2021-03-11 CN CN202110263210.XA patent/CN113009932B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107479370A (zh) * | 2017-07-03 | 2017-12-15 | 浙江工业大学 | 一种基于非奇异终端滑模的四旋翼无人机有限时间自适应控制方法 |
CN108445760A (zh) * | 2018-03-14 | 2018-08-24 | 中南大学 | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 |
CN109188913A (zh) * | 2018-10-18 | 2019-01-11 | 南京邮电大学 | 一种无人机姿态的鲁棒控制方法和实现该方法的鲁棒控制器 |
CN109343369A (zh) * | 2018-11-19 | 2019-02-15 | 南京邮电大学 | 一种基于非线性观测器的四旋翼容错控制器设计方法 |
CN111722634A (zh) * | 2020-05-28 | 2020-09-29 | 南京邮电大学 | 一种基于非线性扰动观测器的四旋翼飞行器滑模控制方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116483210A (zh) * | 2023-06-25 | 2023-07-25 | 安徽大学 | 一种基于深度学习和滑模控制的脑控无人机方法及*** |
CN116483210B (zh) * | 2023-06-25 | 2023-09-08 | 安徽大学 | 一种基于深度学习和滑模控制的脑控无人机方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN113009932B (zh) | 2022-11-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110531777B (zh) | 基于自抗扰控制技术的四旋翼飞行器姿态控制方法和*** | |
CN103558857B (zh) | 一种btt飞行器的分布式复合抗干扰姿态控制方法 | |
CN104865968B (zh) | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 | |
CN113342025B (zh) | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 | |
Fu et al. | Finite-time trajectory tracking control for a 12-rotor unmanned aerial vehicle with input saturation | |
Guo et al. | Performance-involved coupling effect-triggered scheme for robust attitude control of HRV | |
Jiang et al. | Novel integral sliding mode control for small-scale unmanned helicopters | |
CN107817818B (zh) | 一种模型不确定飞艇航迹跟踪有限时间控制方法 | |
CN113009932B (zh) | 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法 | |
Li et al. | Angular acceleration estimation-based incremental nonlinear dynamic inversion for robust flight control | |
CN114942649B (zh) | 一种基于反步法的飞机俯仰姿态与航迹角解耦控制方法 | |
CN115202213A (zh) | 一种基于自抗扰控制的四旋翼飞行器控制方法 | |
Gunes et al. | Output feedback sliding mode control of a fixed-wing UAV under rudder loss | |
CN115327916B (zh) | 一种高机动飞机气动参数摄动的自适应补偿控制方法 | |
CN114879728B (zh) | 一种基于自抗扰控制的飞行器鲁棒编队控制方法 | |
CN116430828A (zh) | 一种基于观测器的四旋翼故障容灾降级控制方法 | |
CN116203840A (zh) | 可重复使用运载器自适应增益调度控制方法 | |
CN112947058B (zh) | 一种针对飞机三轴角速率控制的自抗扰型pid调参方法 | |
CN113110543B (zh) | 一种非线性非最小相位飞行器的鲁棒飞行控制方法 | |
Krasnova et al. | Design of invariant control system for longitudinal motion of flight vehicle | |
CN109101034B (zh) | 一种垂直/短距起降飞机飞行控制方法 | |
CN110673616A (zh) | 基于自适应滑模的固定翼无人机有限时间容错控制方法 | |
ZHANG et al. | Aircraft post-stall maneuver control using attitude feedback linearization | |
Wu et al. | Finite-time velocity-free trajectory tracking control for a stratospheric airship with preassigned accuracy | |
CN116483103B (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: 210003, 66 new model street, Gulou District, Jiangsu, Nanjing Applicant after: NANJING University OF POSTS AND TELECOMMUNICATIONS Address before: No. 186, software Avenue, Yuhuatai District, Nanjing, Jiangsu Province, 210012 Applicant before: NANJING University OF POSTS AND TELECOMMUNICATIONS |
|
GR01 | Patent grant | ||
GR01 | Patent grant |