CN105912011A - 一种四旋翼飞行器姿态的线性自抗扰控制方法 - Google Patents
一种四旋翼飞行器姿态的线性自抗扰控制方法 Download PDFInfo
- Publication number
- CN105912011A CN105912011A CN201610485241.9A CN201610485241A CN105912011A CN 105912011 A CN105912011 A CN 105912011A CN 201610485241 A CN201610485241 A CN 201610485241A CN 105912011 A CN105912011 A CN 105912011A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- theta
- disturbance
- gamma
- pitch
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 230000008878 coupling Effects 0.000 claims abstract description 11
- 238000010168 coupling process Methods 0.000 claims abstract description 11
- 238000005859 coupling reaction Methods 0.000 claims abstract description 11
- 238000013178 mathematical model Methods 0.000 claims abstract description 7
- 238000013461 design Methods 0.000 claims description 29
- 230000000694 effects Effects 0.000 claims description 14
- 230000033001 locomotion Effects 0.000 claims description 7
- 238000005096 rolling process Methods 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 230000009471 action Effects 0.000 claims description 5
- 230000001568 sexual effect Effects 0.000 claims description 5
- 238000012546 transfer Methods 0.000 claims description 3
- 230000001629 suppression Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 6
- 230000009187 flying Effects 0.000 description 6
- 238000011160 research Methods 0.000 description 4
- 230000004044 response Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000033228 biological regulation Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000036039 immunity Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 101710163391 ADP-ribosyl cyclase/cyclic ADP-ribose hydrolase Proteins 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000003028 elevating effect Effects 0.000 description 1
- 238000009415 formwork Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000005764 inhibitory process Effects 0.000 description 1
- 238000011835 investigation 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
-
- 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)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种四旋翼飞行器姿态的线性自抗扰控制方法,属于无人飞行器自动控制领域。针对机体刚性且严格对称的四旋翼飞行器建立数学模型,利用线性自抗扰控制器结构简单、参数调节简便结合模型已知动态设计了线性扩张状态观测器(LESO),把各通道间的动态耦合部分视为***内部不确定干扰,将其与外界干扰作为作用于***的未知综合扰动。该观测器只对当前***的未知扰动进行快速估计,降低了观测器的负担,从而提高了对扰动的估计能力。利用LESO对扰动的估计值在俯仰通道的控制输入中引入相应补偿,既可实现对扰动的抑制,又可实现姿态控制。在此基础上,设计了线性状态反馈控制器对扰动进行在线补偿,实现了稳定的姿态控制。
Description
技术领域
本发明涉及飞行器控制技术领域,特别是涉及一种四旋翼飞行器姿态的线性自抗扰控制方法。
背景技术
四旋翼飞行器的姿态控制研究和应用受到了广泛重视。相比固定翼飞行器,四旋翼飞行器能够完成空中定点悬停、低速飞行和室内飞行等任务,具有显著的民用和军用价值。针对其非线性、强耦合、多变量等特性,且在实际四旋翼飞行***中会受到多种物理效应的作用以及外部环境的干扰,已开展的研究有反步法控制、滑模控制、鲁棒控制等,研究虽都取得了一定进展,但如何设计对模型依赖程度低、闭环***鲁棒性强的控制器对于实现四旋翼飞行器的高性能控制具有重要的理论和实际意义。
韩京清教授提出的自抗扰控制(ARDC),可以有效的解决具有复杂结构的不确定***的控制问题。目前,已经有研究人员将该控制方法应用于四旋翼飞行器***,达到快速机动和高稳定度的控制要求。针对ADRC参数过多,难以给定参数整定方法等问题,高志强教授提出线性自抗扰控制器(LADRC)。LADRC只有两个调节参数,结构简单,且物理意义明确,使得它更适合应用于实际***。
本发明提出了一种四旋翼飞行器自抗扰姿态控制的方法,利用模型已知动态设计了线性扩张状态观测器(LESO),把各通道间的动态耦合部分视为***内部不确定干扰,将其与外界干扰作为作用于***的未知综合扰动。该观测器只对当前***的未知扰动进行快速估计,降低了观测器的负担,从而提高了对扰动的估计能力。在此基础上,设计线性状态反馈控制器对扰动进行在线补偿,实现了稳定的姿态控制。
发明内容
本发明要解决的技术问题是:使用一种提高四旋翼无人机的飞行品质的四旋翼飞行器姿态的线性自抗扰控制方法。
本发明为解决公知技术中存在的技术问题所采取的技术方案是:
一种四旋翼飞行器姿态的线性自抗扰控制方法,其特征在于:包括如下步骤:
步骤101:建立四旋翼***的动力学模型:具体为:
针对机体刚性且对称的四旋翼飞行器建立数学模型,根据动量矩定理,飞行器绕质心运动的动力学方程表示为:
τf-τd-τg=Jw+w×Jw
其中:J=dig(Jx,Jy,Jz)为机体坐标系下的转动惯量矩阵,Jx、Jy、Jz依次为机体绕滚转轴、俯仰轴、偏航轴的转动惯量;w=[wx wy wz]T∈R3为机体坐标系下绕上述机体绕滚转轴、俯仰轴、偏航轴三个轴的角速度;用Φ=[γ θ ψ]T表示欧拉角,γθψ依次为滚转角、俯仰角、偏航角;则在小角度姿态下,
机体转动力矩来源于:机体受到的升力力矩,空气阻力扭矩,陀螺效应下的扭矩;
τf为机体受到的升力力矩,表示为:
其中:Kf为执行器驱动旋翼转动产生转矩时,电机电压与旋翼产生升力之间的系数,Kt,n为顺时针力矩系数,Kt,c为逆时针力矩系数,并且Kt,n=-Kt,c,l为俯仰轴与旋翼中心的距离,Fi、Mi(i=f,b,l,r)分别为前旋翼,后旋翼,左旋翼,右旋翼产生的升力和力矩,Vi(i=f,b,l,r)为四个电机电压;
τd为空气阻力扭矩,表示为:τd=Kafw
其中:Kaf为空气阻力系数,且Kaf=dig(Kafx,Kafy,Kafz)
τg为陀螺效应下的力矩,表达式为:
其中:Jr为旋翼转子的转动惯量,qi(i=f,b,l,r)是前旋翼,后旋翼,左旋翼,右旋翼四个旋翼的角速度,且W=[0 0 ql+qr-qb-qf]T;
四旋翼飞行器姿态***的动态模型为:
步骤102:建立四旋翼姿态的数学模型如下:
当四旋翼飞行器大角度动作时,***表现为强耦合非线性特性;引入控制量U=[U1 U2 U3]T;此时,将整个***分为滚转通道、俯仰通道、偏航通道,B为多变量变换矩阵:
同时,将三个通道之间的动态耦合部分视为***内部不确定扰动,则
其中εi(i=1,2,3)为***内部不确定扰动,
四旋翼飞行器在实际飞行时,将***内部不确定扰动和外界扰动作为作用于***的未知综合扰动,则姿态***的模型为:
其中fi=εi+di(i=1,2,3)为作用于***的未知综合扰动,di为作用于三个通道的外界扰动;
步骤103:设计自抗扰控制器;
对***的三个通道分别进行姿态控制;
LESO直接利用输入输出信息对***的状态以及“综合扰动”进行实时估计;设计线性状态反馈控制器在线补偿综合扰动,实现姿态控制;
步骤1031:俯仰通道自抗扰姿态控制器的设计;
当x3=f2为俯仰通道的扩张状态变量时,f2可导,则俯仰通道的模型表达为:
其中:U2为俯仰通道控制输入,-Kafyx2/Jy为***已知动态,x1,x2,x3依次为俯仰角,俯仰角速度,俯仰通道综合扰动;
基于已知俯仰角速度信息设计如下LESO对***的状态和扰动进行观测:
其中:a=Kafy/Jy,b0=lKf/Jy,zi(i=1,2,3)分别为xi(i=1,2,3)的观测值,βi(i=1,2,3)为观测器增益,将观测器极点都配置到-wo,且β1=3wo,β2=3wo 2,β3=wo 3,wo为观测器带宽;
利用LESO对扰动的估计值在俯仰通道的控制输入中引入相应补偿;设计的线性状态反馈控制器如下:
其中:θd为偏航通道给定值,kp,kd为控制器增益,且kp=wc 2,kd=2wc,wc为控制器带宽,u2为反馈控制量;
重复步骤1031,实现滚转通道和偏航通道的自抗扰姿态控制;
步骤104:闭环稳定性分析;具体为
步骤1041:俯仰通道的闭环稳定性分析
基于频域理论,建立俯仰通道的闭环控制回路,对式和式进行拉氏变换,则
通过LESO对俯仰通道扰动项估计,则
其中:为f2(s)与z3(s)之间的估计误差;
将俯仰通道控制对象记为:
得到俯仰角输出θ(s)与俯仰角给定值θd(s)和扰动的估计误差之间的关系式:
其中
c1=3wo+2a+2wc
c2=(2wc+a)(3wo+a)+3wo 2+3awo+wc 2
c3=(3wo 2+3awo)(2wc+a)+wc 2(3wo+a)
c4=wc 2(3wo 2+3awo)
以θd(s)为输入,θ(s)为输出,忽略对扰动的估计误差,则俯仰通道闭环传递函数为:
根据Routh判据,闭环***稳定的充要条件是:
由于a>0,wc>0,则整个俯仰通道闭环***稳定;
重复步骤1041,对滚转通道和偏航通道的闭环稳定性进行分析。
本发明具有的优点和积极效果是:
本发明相比于传统的PID控制方法,具有更好的跟踪性能,并且对随机的干扰噪声具有很好地抗干扰性。传统非线性ADRC设计的姿态控制器参数过多,参数整定方法较为困难,而本发明所设计的各通道线性自抗扰控制器(LADRC)只有两个调节参数,结构简单,且物理意义明确,使得它更适合应用于实际***。本发明设计的线性自抗扰姿态控制器应用于四旋翼飞行器***,可以达到快速机动和高稳定度的控制要求,具有很好的鲁棒性能和抗扰性能。
附图说明
图1为现有技术的四旋翼的结构示意图;
图2为本发明***姿态控制结构示意图;
图3为本发明的自抗扰控制器的结构示意图;
图4为本发明的***半实物实验原理图;
图5为优选实施例1的俯仰角跟踪效果对比图;
图6为优选实施例1的滚转角跟踪效果对比图;
图7为优选实施例1的偏航角跟踪效果对比图;
图8为优选实施例2的俯仰角输出响应效果对比图;
图9为优选实施例2的滚转角输出响应对比图;
图10为优选实施例2的偏航角输出响应对比图。。
具体实施方式
为能进一步了解本发明的发明内容、特点及功效,兹例举以下实施例,并配合附图详细说明如下:
请参阅图1至图10,一种四旋翼飞行器姿态的线性自抗扰控制方法,包括如下步骤:
步骤1:建立四旋翼***的动力学模型:
针对机体刚性且严格对称的四旋翼飞行器建立数学模型,根据动量矩定理,飞行器绕质心运动的动力学方程可表示为:
τf-τd-τg=Jw+w×Jw
其中:J=dig(Jx,Jy,Jz)为机体坐标系下的转动惯量矩阵,Jx、Jy、Jz分别为机体绕滚转轴、俯仰轴、偏航轴的转动惯量。为机体坐标系下绕3个轴的角速度。用Φ=[γ θ ψ]T表示欧拉角,分别为滚转角、俯仰角、偏航角。则在小角度姿态下,
考虑能够反应四旋翼飞行器本质特性的模型,机体转动力矩主要来源于:机体受到的升力力矩,空气阻力扭矩,陀螺效应下的扭矩。
τf为机体受到的升力力矩,可以表示为:
其中:Kf为执行器驱动旋翼转动产生转矩时,电机电压与旋翼产生升力之间的系数,Kt,n为顺时针力矩系数,Kt,c为逆时针力矩系数,并且Kt,n=-Kt,c,l为俯仰轴与旋翼中心的距离,Fi、Mi(i=f,b,l,r)分别为前,后,左,右旋翼产生的升力、力矩,Vi(i=f,b,l,r)为四个电机电压。
τd为空气阻力扭矩,可以表示为:τd=Kafw
其中:Kaf为空气阻力系数,且Kaf=dig(Kafx,Kafy,Kafz)
τg为陀螺效应下的力矩,其表达式为:
其中:Jr为旋翼转子的转动惯量,qi(i=f,b,l,r)是前,后,左,右四个旋翼的角速度,且W=[0 0 ql+qr-qb-qf]T
综上所述,四旋翼飞行器姿态***的动态模型为:
步骤2:建立四旋翼姿态的数学模型如下:
由此可见,当四旋翼飞行器大角度动作时,***表现为强耦合非线性特性。引入控制量U=[U1 U2 U3]T,其可由四个电机的电压表示。此时,将整个***分为滚转通道、俯仰通道、偏航通道,B为多变量变换矩阵:
同时,将3个通道之间的动态耦合部分视为***内部不确定扰动,则
其中εi(i=1,2,3)为***内部不确定扰动,
四旋翼飞行器在实际飞行时,需要考虑各种外界环境扰动力矩影响。因此,将***内部不确定扰动和外界扰动作为作用于***的未知综合扰动,则姿态***的模型改写为:
其中fi=εi+di(i=1,2,3)为作用于***的未知综合扰动,di为作用于3个通道的外界扰动;
步骤3:设计自抗扰控制器
四旋翼飞行器的姿态控制是整个飞行控制的关键和基础,对***的3个通道分别进行姿态控制,其结果将提高飞行品质。
LESO可直接利用输入输出信息对***的状态以及“综合扰动”进行精确的实时估计,降低因使用高精度陀螺仪提高的设计成本。进而设计线性状态反馈控制器在线补偿综合扰动,实现姿态控制。由于补偿的存在,***能够获得对扰动的抑制能力,从而提高了***的鲁棒性。
步骤3.1:俯仰通道自抗扰姿态控制器的设计
令x3=f2为俯仰通道的扩张状态变量,f2可导,则俯仰通道的模型可重新表达为:
其中:U2为俯仰通道控制输入,-Kafyx2/Jy为***已知动态,x1,x2,x3分别为俯仰角,俯仰角速度,俯仰通道综合扰动。
基于已知俯仰角速度信息设计如下LESO对***的状态和扰动进行观测:
其中:a=Kafy/Jy,b0=lKf/Jy,zi(i=1,2,3)分别为xi(i=1,2,3)的观测值,βi(i=1,2,3)为观测器增益,将观测器极点都配置到-wo,且β1=3wo,β2=3wo 2,β3=wo 3,wo为观测器带宽。
在此基础上,利用LESO对扰动的估计值在俯仰通道的控制输入中引入相应补偿,既可实现对扰动的抑制,又可实现姿态控制。设计的线性状态反馈控制器如下:
其中:θd为偏航通道给定值,kp,kd为控制器增益,且kp=wc 2,kd=2wc,wc为控制器带宽,u2为反馈控制量。
同样的方法,可以实现步骤3.2滚转通道和步骤3.3偏航通道的自抗扰姿态控制。
步骤4:闭环稳定性分析
步骤4.1:俯仰通道的闭环稳定性分析
基于频域理论,建立俯仰通道的闭环控制回路,对式和式进行拉氏变换,则
通过LESO对俯仰通道扰动项估计,则
其中:为f2(s)与z3(s)之间的估计误差。
可将俯仰通道控制对象记为
得到俯仰角输出θ(s)与俯仰角给定值θd(s)和扰动的估计误差之间的关系式:
其中
c1=3wo+2a+2wc
c2=(2wc+a)(3wo+a)+3wo 2+3awo+wc 2
c3=(3wo 2+3awo)(2wc+a)+wc 2(3wo+a)
c4=wc 2(3wo 2+3awo)
以θd(s)为输入,θ(s)为输出,忽略对扰动的估计误差,则俯仰通道闭环传递函数为:
根据Routh判据,可以证明,闭环***稳定的充要条件是:
由于a>0,wc>0,则整个俯仰通道闭环***稳定。类似地,可以对步骤4.2滚转通道,步骤4.3偏航通道的闭环稳定性进行分析。
将自抗扰控制技术应用到四旋翼飞行控制中,首先考虑四旋翼***的基本结构和动力学特性。如图1所示,四旋翼飞行器的机体固定联接在一个刚性十字交叉结构上,并由四个相互独立的电机驱动旋翼转动提供飞行动力,通过改变电机转动速度可以控制旋翼的转速,最终实现飞行器的飞行姿态和位置控。由于四旋翼飞行器有四个驱动即四个输入量,但是有六个自由度的输出量,因此四旋翼飞行器是一个典型欠驱动强耦合***。位于同一对角线上的旋翼同向旋转,而相邻旋翼反向旋转。以前旋翼作为机体的机头,后旋翼作为机体的机尾。将前后旋翼作为一组正桨逆时针旋转,左右旋翼作为一组负桨顺时针旋转,这样设计可以消除机体自身的反扭力矩。在这种旋转模式下,四旋翼飞行器可实现的主要运动状态有:垂直运动、俯仰运动、滚转运动、偏航运动等。
本发明的姿态控制结构示意图如图2所示,对***的3个通道分别进行姿态控制,其结果将提高飞行品质。具体步骤如步骤3.1至3.3所述,整个***闭环稳定性分析如步骤4.1至4.3所述。
本发明的自抗扰控制器的结构示意图如图3所示,LESO可直接利用输入输出信息对***的状态以及“综合扰动”进行精确的实时估计,降低因使用高精度陀螺仪提高的设计成本。进而设计线性状态反馈控制器在线补偿综合扰动,实现姿态控制。由于补偿的存在,***能够获得对扰动的抑制能力,从而提高了***的鲁棒性。
不论是ESO或LESO观测的总扰动中都包含***已知动态部分,这样将增加ESO的观测负担,提高设计成本。因此对LESO进行重构,设计改进的LARDC,其中LESO只对未知的扰动及不确定部分进行观测。
通过俯仰通道,说明改进的LADRC设计:
将俯仰通道动态耦合部分以及外界扰动d的共同作用作为俯仰通道的扩张状态变量x3,且f2可导,则俯仰通道的模型可重新表达为:
其中:U2为俯仰通道控制输入,-Kafyx2/Jy为***已知动态,x1,x2,x3分别为俯仰角,俯仰角速度,俯仰通道综合扰动。
基于已知俯仰角速度信息设计如下LESO对***状态和扰动进行观测:
其中:a=Kafy/Jy,b0=lKf/Jy,zi(i=1,2,3)分别为xi(i=1,2,3)的观测值,βi(i=1,2,3)为观测器增益,将观测器极点都配置到-wo,且β1=3wo,β2=3wo 2,β3=wo 3,wo为观测器带宽。
在此基础上,利用重构LESO对扰动的估计值在俯仰通道的控制输入中引入相应补偿,既可实现对扰动的抑制,又可实现姿态控制,设计的线性状态反馈控制器如下:
其中:θd为俯仰通道给定值,kp,kd为控制器增益,且kp=wc 2,kd=2wc,wc为控制器带宽,u2为反馈控制量。
同理,可以实现滚转通道和偏航通道基于改进LADRC的姿态控制。
图4为实施例1、2的***信息传输结构。
实施例1:
对***进行稳定跟踪控制,选取四旋翼飞行器的初始姿态角为[γ0 θ0 ψ0]T=[0° 0° 0°]T,将姿态角的理想值都设置为幅值为3°,频率为0.05Hz的方波信号,实验时间为40s。姿态控制器参数见表1。
表1 控制器参数
最终***的姿态跟踪结果及线性扩张状态观测器对姿态角的观测值如图5至图7所示。定义如下几项性能指标,姿态角首次跟踪上理想值的时间,用ts表示;机体进入稳态以后,***姿态角实际跟踪值与理想值之间误差的均方根,用σ1表示;线性扩张状态观测器对***姿态角的观测值与姿态角实际跟踪值之间误差的均方根,用σ2表示,姿态角的最大超调量用Mp表示,则3通道各项性能指标见表2.
表2 跟踪实验的性能指标
图5至图7和表2表明,俯仰角、滚转角和偏航角均能快速、准确跟踪给定姿态信号,线性扩张状态观测器能够有效的对姿态角进行观测。在姿态跟踪过程中,***能够同时兼顾稳态性能和动态性能。
实施例2:
对***进行抗扰性试验。选取四旋翼飞行器的初始姿态角[γ0 θ0 ψ0]T=[-3° -3° -3°]T,当***运行到14s时,在稳定的俯仰通道中加入外界扰动力矩,检验自抗扰姿态控制器对扰动力矩的抑制效果,***的输出响应如图8至图10所示。扰动消失后,***的调整时间为Ts,此时,***3个通道的各项性能指标见表3。
表3 扰动作用下的性能指标
由图8至图10和表3表明,俯仰通道在扰动作用时出现了较大超调,但是在干扰消失后仍可快速稳定地跟踪理想信号,且偏航通道和滚转通道几乎未受扰动影响。因此,所设计的自抗扰姿态控制器能够有效抑制和消除通道间的耦合以及外界扰动带来的影响,具有一定的鲁棒性。
本发明对四旋翼飞行器的姿态控制问题进行研究,利用四旋翼飞行器姿态***的动态模型信息,并考虑模型的内部不确定性和外界扰动等因素,设计线性扩张状态观测器。在此基础上,通过线性状态反馈实现姿态控制和扰动的动态补偿。利用频域理论,分析了闭环***的稳定性。实施例结果表明,本发明所设计的自抗扰姿态控制器能够有效实现四旋翼飞行器的鲁棒跟踪控制,且***具有良好的动态性能和稳态性能。
以上对本发明的实施例进行了详细说明,但所述内容仅为本发明的较佳实施例,不能被认为用于限定本发明的实施范围。凡依本发明申请范围所作的均等变化与改进等,均应仍归属于本发明的专利涵盖范围之内。
Claims (1)
1.一种四旋翼飞行器姿态的线性自抗扰控制方法;其特征在于:包括如下步骤:
步骤101:建立四旋翼***的动力学模型:具体为:
针对机体刚性且对称的四旋翼飞行器建立数学模型,根据动量矩定理,飞行器绕质心运动的动力学方程表示为:
τf-τd-τg=Jw+w×Jw
其中:J=dig(Jx,Jy,Jz)为机体坐标系下的转动惯量矩阵,Jx、Jy、Jz依次为机体绕滚转轴、俯仰轴、偏航轴的转动惯量;w=[wx wy wz]T∈R3为机体坐标系下绕上述机体绕滚转轴、俯仰轴、偏航轴三个轴的角速度;用Φ=[γ θ ψ]T表示欧拉角,γ θ ψ依次为滚转角、俯仰角、偏航角;则在小角度姿态下,
机体转动力矩来源于:机体受到的升力力矩,空气阻力扭矩,陀螺效应下的扭矩;
τf为机体受到的升力力矩,表示为:
其中:Kf为执行器驱动旋翼转动产生转矩时,电机电压与旋翼产生升力之间的系数,Kt,n为顺时针力矩系数,Kt,c为逆时针力矩系数,并且Kt,n=-Kt,c,l为俯仰轴与旋翼中心的距离,Fi、Mi(i=f,b,l,r)分别为前旋翼,后旋翼,左旋翼,右旋翼产生的升力和力矩,Vi(i=f,b,l,r)为四个电机电压;
τd为空气阻力扭矩,表示为:τd=Kafw
其中:Kaf为空气阻力系数,且Kaf=dig(Kafx,Kafy,Kafz)
τg为陀螺效应下的力矩,表达式为:
其中:Jr为旋翼转子的转动惯量,qi(i=f,b,l,r)是前旋翼,后旋翼,左旋翼,右旋翼四个旋翼的角速度,且W=[0 0 ql+qr -qb -qf]T;
四旋翼飞行器姿态***的动态模型为:
步骤102:建立四旋翼姿态的数学模型如下:
当四旋翼飞行器大角度动作时,***表现为强耦合非线性特性;引入控制量U=[U1 U2 U3]T;此时,将整个***分为滚转通道、俯仰通道、偏航通道,B为多变量变换矩阵:
同时,将三个通道之间的动态耦合部分视为***内部不确定扰动,则
其中εi(i=1,2,3)为***内部不确定扰动,
四旋翼飞行器在实际飞行时,将***内部不确定扰动和外界扰动作为作用于***的未知综合扰动,则姿态***的模型为:
其中fi=εi+di(i=1,2,3)为作用于***的未知综合扰动,di为作用于三个通道的外界扰动;
步骤103:设计自抗扰控制器;
对***的三个通道分别进行姿态控制;
LESO直接利用输入输出信息对***的状态以及“综合扰动”进行实时估计;设计线性状态反馈控制器在线补偿综合扰动,实现姿态控制;
步骤1031:俯仰通道自抗扰姿态控制器的设计;
当x3=f2为俯仰通道的扩张状态变量时,f2可导,则俯仰通道的模型表达为:
其中:U2为俯仰通道控制输入,-Kafyx2/Jy为***已知动态,x1,x2,x3依次为俯仰角,俯仰角速度,俯仰通道综合扰动;
基于已知俯仰角速度信息设计如下LESO对***的状态和扰动进行观测:
其中:a=Kafy/Jy,b0=lKf/Jy,zi(i=1,2,3)分别为xi(i=1,2,3)的观测值,βi(i=1,2,3)为观测器增益,将观测器极点都配置到-wo,且β1=3wo,β2=3wo 2,β3=wo 3,wo为观测器带宽;
利用LESO对扰动的估计值在俯仰通道的控制输入中引入相应补偿;设计的线性状态反馈控制器如下:
其中:θd为偏航通道给定值,kp,kd为控制器增益,且kp=wc 2,kd=2wc,wc为控制器带宽,u2为反馈控制量;
重复步骤1031,实现滚转通道和偏航通道的自抗扰姿态控制;
步骤104:闭环稳定性分析;具体为
步骤1041:俯仰通道的闭环稳定性分析
基于频域理论,建立俯仰通道的闭环控制回路,对式和式进行拉氏变换,则
通过LESO对俯仰通道扰动项估计,则
其中:为f2(s)与z3(s)之间的估计误差;
将俯仰通道控制对象记为:
得到俯仰角输出θ(s)与俯仰角给定值θd(s)和扰动的估计误差之间的关系式:
其中
c1=3wo+2a+2wc
c2=(2wc+a)(3wo+a)+3wo 2+3awo+wc 2
c3=(3wo 2+3awo)(2wc+a)+wc 2(3wo+a)
c4=wc 2(3wo 2+3awo)
以θd(s)为输入,θ(s)为输出,忽略对扰动的估计误差,则俯仰通道闭环传递函数为:
根据Routh判据,闭环***稳定的充要条件是:
由于a>0,wc>0,则整个俯仰通道闭环***稳定;
重复步骤1041,对滚转通道和偏航通道的闭环稳定性进行分析。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610485241.9A CN105912011A (zh) | 2016-06-24 | 2016-06-24 | 一种四旋翼飞行器姿态的线性自抗扰控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610485241.9A CN105912011A (zh) | 2016-06-24 | 2016-06-24 | 一种四旋翼飞行器姿态的线性自抗扰控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105912011A true CN105912011A (zh) | 2016-08-31 |
Family
ID=56759672
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610485241.9A Pending CN105912011A (zh) | 2016-06-24 | 2016-06-24 | 一种四旋翼飞行器姿态的线性自抗扰控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105912011A (zh) |
Cited By (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106444812A (zh) * | 2016-10-26 | 2017-02-22 | 华南智能机器人创新研究院 | 一种基于四旋翼无人机的姿态控制的方法及其*** |
CN106527462A (zh) * | 2016-12-02 | 2017-03-22 | 广西师范大学 | 无人机控制装置 |
CN106990790A (zh) * | 2017-06-06 | 2017-07-28 | 成都纵横自动化技术有限公司 | 一种抗饱和多旋翼飞行器控制方法 |
CN107562068A (zh) * | 2017-09-28 | 2018-01-09 | 天津理工大学 | 一种四旋翼飞行器姿态的动态面输出调节控制方法 |
CN107844123A (zh) * | 2017-10-11 | 2018-03-27 | 中国空气动力研究与发展中心计算空气动力研究所 | 一种非线性飞行器航迹控制方法 |
CN107943070A (zh) * | 2017-11-01 | 2018-04-20 | 贾杰 | 一种无人直升机自抗扰飞行速度和姿态控制方法 |
CN108121354A (zh) * | 2017-12-19 | 2018-06-05 | 天津理工大学 | 基于指令滤波反步法的四旋翼无人机稳定跟踪控制方法 |
CN108196563A (zh) * | 2018-02-09 | 2018-06-22 | 深圳禾苗通信科技有限公司 | 一种多旋翼无人机自抗扰补偿控制方法及*** |
CN108536879A (zh) * | 2017-03-03 | 2018-09-14 | 中国科学院沈阳自动化研究所 | 基于模型参考自适应的多旋翼无人机参数辨识方法 |
CN108622403A (zh) * | 2017-03-20 | 2018-10-09 | 贝尔直升机德事隆公司 | 用于旋翼飞行器航向控制的***和方法 |
CN108693372A (zh) * | 2018-04-13 | 2018-10-23 | 南京航空航天大学 | 一种四旋翼飞行器的航向轴角速度估计方法 |
CN108759814A (zh) * | 2018-04-13 | 2018-11-06 | 南京航空航天大学 | 一种四旋翼飞行器横滚轴角速度和俯仰轴角速度估计方法 |
CN109062052A (zh) * | 2018-08-31 | 2018-12-21 | 湖北工业大学 | 基于扩张状态观测器的四旋翼无人机积分滑模控制方法 |
CN109062242A (zh) * | 2018-10-25 | 2018-12-21 | 国网四川省电力公司电力科学研究院 | 一种新的旋翼无人机控制方法 |
CN109189084A (zh) * | 2017-06-30 | 2019-01-11 | 沈阳新松机器人自动化股份有限公司 | 一种四旋翼机器人软件平台设计方法及*** |
CN109213192A (zh) * | 2018-08-16 | 2019-01-15 | 上海航天控制技术研究所 | 一种基于自抗扰控制的干扰抑制方法 |
CN109471449A (zh) * | 2018-12-28 | 2019-03-15 | 中国兵器工业计算机应用技术研究所 | 一种无人机控制***及控制方法 |
CN109508025A (zh) * | 2018-11-23 | 2019-03-22 | 中国科学院数学与***科学研究院 | 一种弹性飞行器的自抗扰姿态控制方法 |
CN109683471A (zh) * | 2018-08-28 | 2019-04-26 | 杭州电子科技大学 | 自抗扰控制方法、装置和*** |
CN109976150A (zh) * | 2018-11-28 | 2019-07-05 | 中南大学 | 一类欠驱动多输入多输出***集中式自抗扰控制方法 |
CN110703788A (zh) * | 2019-10-16 | 2020-01-17 | 北京航空航天大学 | 一种微型扑翼飞行器的增稳控制方法及其实现 |
CN110751270A (zh) * | 2019-10-23 | 2020-02-04 | 广东工业大学 | 一种无人机电线故障检测方法、***及设备 |
CN111413996A (zh) * | 2020-04-09 | 2020-07-14 | 中北大学 | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 |
CN112346470A (zh) * | 2020-10-29 | 2021-02-09 | 中国地质大学(武汉) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 |
CN112623259A (zh) * | 2021-03-08 | 2021-04-09 | 北京航空航天大学 | 针对高超声速飞行器数据丢包的自抗扰控制器设计方法 |
CN112859900A (zh) * | 2021-01-21 | 2021-05-28 | 江苏科技大学 | 无人机喷涂稳定性自适应控制方法及*** |
CN112965510A (zh) * | 2021-02-08 | 2021-06-15 | 中国科学院数学与***科学研究院 | 飞行器高速机动的全通道自抗扰控制方法 |
CN113342025A (zh) * | 2021-06-25 | 2021-09-03 | 南京航空航天大学 | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 |
CN115202213A (zh) * | 2022-08-02 | 2022-10-18 | 北京理工大学 | 一种基于自抗扰控制的四旋翼飞行器控制方法 |
US20230266725A1 (en) * | 2022-02-22 | 2023-08-24 | Rama K. Yedavalli | Robust control of uncertain dynamic systems |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN104865968A (zh) * | 2015-04-22 | 2015-08-26 | 浙江工业大学 | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 |
-
2016
- 2016-06-24 CN CN201610485241.9A patent/CN105912011A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102830622A (zh) * | 2012-09-05 | 2012-12-19 | 北京理工大学 | 一种四旋翼飞行器自抗扰自动飞行控制方法 |
CN104865968A (zh) * | 2015-04-22 | 2015-08-26 | 浙江工业大学 | 一种采用串级自抗扰控制技术的四旋翼飞行器悬停控制方法 |
Non-Patent Citations (4)
Title |
---|
YIDAO JI,ETC: "Attitude Control of A Quadrotor Unmanned Aerial Vehicle Based on Linear Extended State Observer", 《27TH CHINESE CONTROL AND DECISION CONFERENCE》 * |
刘一莎等: "四旋翼飞行器的自抗扰飞行控制方法", 《控制理论与应用》 * |
刘敏等: "四旋翼飞行器自抗扰姿态控制", 《计算机仿真》 * |
赵小川: "《北京航空航天大学出版社》", 31 January 2013 * |
Cited By (52)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106444812A (zh) * | 2016-10-26 | 2017-02-22 | 华南智能机器人创新研究院 | 一种基于四旋翼无人机的姿态控制的方法及其*** |
CN106527462A (zh) * | 2016-12-02 | 2017-03-22 | 广西师范大学 | 无人机控制装置 |
CN108536879A (zh) * | 2017-03-03 | 2018-09-14 | 中国科学院沈阳自动化研究所 | 基于模型参考自适应的多旋翼无人机参数辨识方法 |
CN108536879B (zh) * | 2017-03-03 | 2021-09-07 | 中国科学院沈阳自动化研究所 | 基于模型参考自适应的多旋翼无人机参数辨识方法 |
CN108622403B (zh) * | 2017-03-20 | 2022-02-08 | 贝尔直升机德事隆公司 | 用于旋翼飞行器航向控制的***和方法 |
CN108622403A (zh) * | 2017-03-20 | 2018-10-09 | 贝尔直升机德事隆公司 | 用于旋翼飞行器航向控制的***和方法 |
CN106990790A (zh) * | 2017-06-06 | 2017-07-28 | 成都纵横自动化技术有限公司 | 一种抗饱和多旋翼飞行器控制方法 |
CN106990790B (zh) * | 2017-06-06 | 2020-02-07 | 成都纵横自动化技术股份有限公司 | 一种抗饱和多旋翼飞行器控制方法 |
CN109189084A (zh) * | 2017-06-30 | 2019-01-11 | 沈阳新松机器人自动化股份有限公司 | 一种四旋翼机器人软件平台设计方法及*** |
CN107562068B (zh) * | 2017-09-28 | 2020-07-10 | 天津理工大学 | 一种四旋翼飞行器姿态的动态面输出调节控制方法 |
CN107562068A (zh) * | 2017-09-28 | 2018-01-09 | 天津理工大学 | 一种四旋翼飞行器姿态的动态面输出调节控制方法 |
CN107844123B (zh) * | 2017-10-11 | 2021-03-02 | 中国空气动力研究与发展中心计算空气动力研究所 | 一种非线性飞行器航迹控制方法 |
CN107844123A (zh) * | 2017-10-11 | 2018-03-27 | 中国空气动力研究与发展中心计算空气动力研究所 | 一种非线性飞行器航迹控制方法 |
CN107943070A (zh) * | 2017-11-01 | 2018-04-20 | 贾杰 | 一种无人直升机自抗扰飞行速度和姿态控制方法 |
CN107943070B (zh) * | 2017-11-01 | 2020-07-28 | 杭州睿杰智能空中机器人科技有限公司 | 一种无人直升机自抗扰飞行速度和姿态控制方法 |
CN108121354A (zh) * | 2017-12-19 | 2018-06-05 | 天津理工大学 | 基于指令滤波反步法的四旋翼无人机稳定跟踪控制方法 |
CN108196563A (zh) * | 2018-02-09 | 2018-06-22 | 深圳禾苗通信科技有限公司 | 一种多旋翼无人机自抗扰补偿控制方法及*** |
CN108196563B (zh) * | 2018-02-09 | 2021-02-09 | 深圳禾苗通信科技有限公司 | 一种多旋翼无人机自抗扰补偿控制方法及*** |
CN108759814A (zh) * | 2018-04-13 | 2018-11-06 | 南京航空航天大学 | 一种四旋翼飞行器横滚轴角速度和俯仰轴角速度估计方法 |
CN108693372A (zh) * | 2018-04-13 | 2018-10-23 | 南京航空航天大学 | 一种四旋翼飞行器的航向轴角速度估计方法 |
CN108693372B (zh) * | 2018-04-13 | 2020-07-07 | 南京航空航天大学 | 一种四旋翼飞行器的航向轴角速度估计方法 |
CN108759814B (zh) * | 2018-04-13 | 2020-07-07 | 南京航空航天大学 | 一种四旋翼飞行器横滚轴角速度和俯仰轴角速度估计方法 |
CN109213192A (zh) * | 2018-08-16 | 2019-01-15 | 上海航天控制技术研究所 | 一种基于自抗扰控制的干扰抑制方法 |
CN109683471B (zh) * | 2018-08-28 | 2021-12-10 | 杭州电子科技大学 | 自抗扰控制方法、装置和*** |
CN109683471A (zh) * | 2018-08-28 | 2019-04-26 | 杭州电子科技大学 | 自抗扰控制方法、装置和*** |
CN109062052A (zh) * | 2018-08-31 | 2018-12-21 | 湖北工业大学 | 基于扩张状态观测器的四旋翼无人机积分滑模控制方法 |
CN109062052B (zh) * | 2018-08-31 | 2021-05-18 | 湖北工业大学 | 基于扩张状态观测器的四旋翼无人机积分滑模控制方法 |
CN109062242B (zh) * | 2018-10-25 | 2021-03-16 | 国网四川省电力公司电力科学研究院 | 一种新的旋翼无人机控制方法 |
CN109062242A (zh) * | 2018-10-25 | 2018-12-21 | 国网四川省电力公司电力科学研究院 | 一种新的旋翼无人机控制方法 |
CN109508025A (zh) * | 2018-11-23 | 2019-03-22 | 中国科学院数学与***科学研究院 | 一种弹性飞行器的自抗扰姿态控制方法 |
CN109976150B (zh) * | 2018-11-28 | 2020-12-18 | 中南大学 | 一类欠驱动多输入多输出***的集中式自抗扰控制方法 |
CN109976150A (zh) * | 2018-11-28 | 2019-07-05 | 中南大学 | 一类欠驱动多输入多输出***集中式自抗扰控制方法 |
CN109471449B (zh) * | 2018-12-28 | 2022-04-15 | 中国兵器工业计算机应用技术研究所 | 一种无人机控制***及控制方法 |
CN109471449A (zh) * | 2018-12-28 | 2019-03-15 | 中国兵器工业计算机应用技术研究所 | 一种无人机控制***及控制方法 |
CN110703788A (zh) * | 2019-10-16 | 2020-01-17 | 北京航空航天大学 | 一种微型扑翼飞行器的增稳控制方法及其实现 |
CN110751270A (zh) * | 2019-10-23 | 2020-02-04 | 广东工业大学 | 一种无人机电线故障检测方法、***及设备 |
CN111413996A (zh) * | 2020-04-09 | 2020-07-14 | 中北大学 | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 |
CN111413996B (zh) * | 2020-04-09 | 2023-03-21 | 中北大学 | 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法 |
CN112346470A (zh) * | 2020-10-29 | 2021-02-09 | 中国地质大学(武汉) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 |
CN112859900B (zh) * | 2021-01-21 | 2022-11-08 | 江苏科技大学 | 无人机喷涂稳定性自适应控制方法及*** |
CN112859900A (zh) * | 2021-01-21 | 2021-05-28 | 江苏科技大学 | 无人机喷涂稳定性自适应控制方法及*** |
CN112965510A (zh) * | 2021-02-08 | 2021-06-15 | 中国科学院数学与***科学研究院 | 飞行器高速机动的全通道自抗扰控制方法 |
CN112965510B (zh) * | 2021-02-08 | 2022-02-18 | 中国科学院数学与***科学研究院 | 飞行器高速机动的全通道自抗扰控制方法 |
CN112623259B (zh) * | 2021-03-08 | 2021-05-14 | 北京航空航天大学 | 针对高超声速飞行器数据丢包的自抗扰控制器设计方法 |
CN112623259A (zh) * | 2021-03-08 | 2021-04-09 | 北京航空航天大学 | 针对高超声速飞行器数据丢包的自抗扰控制器设计方法 |
CN113342025A (zh) * | 2021-06-25 | 2021-09-03 | 南京航空航天大学 | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 |
CN113342025B (zh) * | 2021-06-25 | 2023-12-01 | 南京航空航天大学 | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 |
US20230266725A1 (en) * | 2022-02-22 | 2023-08-24 | Rama K. Yedavalli | Robust control of uncertain dynamic systems |
US11815862B2 (en) * | 2022-02-22 | 2023-11-14 | Robust Engineering Systems, Llc | Robust control of uncertain dynamic systems |
CN115202213A (zh) * | 2022-08-02 | 2022-10-18 | 北京理工大学 | 一种基于自抗扰控制的四旋翼飞行器控制方法 |
CN115202213B (zh) * | 2022-08-02 | 2023-05-12 | 北京理工大学 | 一种基于自抗扰控制的四旋翼飞行器控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105912011A (zh) | 一种四旋翼飞行器姿态的线性自抗扰控制方法 | |
CN104898429B (zh) | 一种基于自抗扰控制的三旋翼姿态控制方法 | |
CN106647783A (zh) | 倾转式三旋翼无人机姿态与高度自适应鲁棒控制方法 | |
Peng et al. | Modeling and robust backstepping sliding mode control with adaptive RBFNN for a novel coaxial eight-rotor UAV | |
CN112346470A (zh) | 一种基于改进自抗扰控制的四旋翼姿态控制方法 | |
CN104950901B (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
CN107688295A (zh) | 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法 | |
CN109614633A (zh) | 一种复合式旋翼飞行器非线性建模方法及配平方法 | |
CN104571120A (zh) | 四旋翼无人机的姿态非线性自适应控制方法 | |
CN104210655A (zh) | 一种双旋翼无人机 | |
CN103365296A (zh) | 一种四旋翼无人飞行器非线性输出反馈飞行控制方法 | |
CN111694278A (zh) | 一种四旋翼无人机的鲁棒跟踪控制方法及*** | |
CN113359459B (zh) | 旋翼飞行器滑模变结构的姿态控制方法 | |
CN110850887A (zh) | 一种四旋翼无人机复合动态逆抗干扰姿态控制方法 | |
CN104898686A (zh) | 一种基于反作用轮摩擦特性的抗干扰姿态控制方法 | |
CN106885918A (zh) | 一种面向多旋翼飞行器的多信息融合实时风速估计方法 | |
CN110377044A (zh) | 一种无人直升机的有限时间高度和姿态跟踪控制方法 | |
Zhang et al. | Quadrotor aircraft control without velocity measurements | |
CN115016268A (zh) | 一种基于滑模理论的可倾转四旋翼无人机容错控制方法 | |
CN111338369A (zh) | 一种基于非线性逆补偿的多旋翼飞行控制方法 | |
CN108536879A (zh) | 基于模型参考自适应的多旋翼无人机参数辨识方法 | |
Guo et al. | PID parameter tuning algorithm of rotor UAV Based on Improved Particle Swarm Optimization | |
Yang et al. | Dynamic characteristics analysis and robust transition control of tail-sitter VTOL UAVs | |
Seah et al. | Bilinear modelling and attitude control of a quadrotor | |
Hussein et al. | Modeling and control of quadrotor systems |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160831 |
|
RJ01 | Rejection of invention patent application after publication |