CN111459175B - 一种基于l1自适应控制器的尾座式无人机轨迹跟踪容错控制方法 - Google Patents

一种基于l1自适应控制器的尾座式无人机轨迹跟踪容错控制方法 Download PDF

Info

Publication number
CN111459175B
CN111459175B CN201911308610.7A CN201911308610A CN111459175B CN 111459175 B CN111459175 B CN 111459175B CN 201911308610 A CN201911308610 A CN 201911308610A CN 111459175 B CN111459175 B CN 111459175B
Authority
CN
China
Prior art keywords
adaptive controller
aerial vehicle
unmanned aerial
type unmanned
controller
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
Application number
CN201911308610.7A
Other languages
English (en)
Other versions
CN111459175A (zh
Inventor
李昭莹
石帅
薛松柏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Sichuan AOSSCI Technology Co Ltd
Original Assignee
Beihang University
Sichuan AOSSCI Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beihang University, Sichuan AOSSCI Technology Co Ltd filed Critical Beihang University
Priority to CN201911308610.7A priority Critical patent/CN111459175B/zh
Publication of CN111459175A publication Critical patent/CN111459175A/zh
Application granted granted Critical
Publication of CN111459175B publication Critical patent/CN111459175B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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

Abstract

本发明提出了一种基于
Figure DDA0002323878970000013
自适应控制器的尾座式无人机轨迹跟踪容错控制方法。首先，针对尾座式无人机的非线性动力学和运动学模型设计
Figure DDA0002323878970000012
自适应控制器，其中包括位置
Figure DDA0002323878970000014
自适应控制器和角度
Figure DDA0002323878970000011
自适应控制器两部分，以实现期望的轨迹跟踪性能；然后，为了确保飞行的可靠性，在尾座式无人机的模型中加入执行机构损伤故障，进行容错控制，实现故障状态下的轨迹跟踪。相比于其他的控制方法，本发明不仅可以用一套参数进行控制，操作方便，还能有效减少外部干扰和不确定性对于结果的影响，提高了尾座式无人机的稳定性，从而达成所期望的轨迹跟踪性能。

Description

一种基于L1自适应控制器的尾座式无人机轨迹跟踪容错控制 方法
技术领域
本发明属于无人机控制技术领域，具体提出了一种基于
Figure BDA0002323878950000012
自适应控制器的尾座式无人机轨迹跟踪容错控制方法。
背景技术
与有人驾驶飞机相比，无人机具有体积小、成本低等优点，最重要的是它对作战环境要求低，战场生存能力强，可以减少人员伤亡。初期，无人机可分为旋翼无人机和固定翼无人机。尾座式无人机作为一种新型的无人机，起源于二战期间的德国，战争破坏了机场跑道，飞机起飞场地受到很大限制，尾座式无人机可垂直起飞和降落的特点满足了发射场地的减少的限制条件。尾座式无人机是旋翼无人机和固定翼无人机的结合，同时也具备旋翼机和固定翼飞机的优点，它不仅可以像旋翼机那样实现垂直起降，还可以像固定翼飞机那样负担大重载。由于其独特的特点，它在生产和生活中越来越受欢迎，在各个领域都有广泛应用。
尾座式无人机的轨迹跟踪的难点在于尾座式无人机飞行的过渡段，经过这个阶段尾座式无人机可以实现平飞状态和垂直状态的转换。在这一过程中，尾座式无人机的攻角急剧变化，使空气动力的变化十分剧烈，这就使此过程中的不确定性大大增加。不仅如此，在轨迹跟踪的过程中，还要对尾座式无人机执行机构损伤的故障情况进行容错控制。容错控制是一种重要的控制方法，决定着飞行器的可靠性和安全性。
为了保证尾座式无人机在执行机构损伤的情况下能按照规定的轨迹飞行，本发明提出了一种基于
Figure BDA0002323878950000013
自适应控制器的尾座式无人机轨迹跟踪容错控制方法，其中包括了位置
Figure BDA0002323878950000014
自适应控制器和角度
Figure BDA0002323878950000015
自适应控制器。
Figure BDA0002323878950000016
自适应控制器是由Hovakimyan等人与2012年提出的，是一种快速的，鲁棒性很强的自适应控制，通过在控制律设计中加入低通滤波器，保证了控制律设计与自适应律设计的分离。自适应控制器适用对象是具有不确定性的系统，其中的自适应量可以用于补偿一些未知随机因素和环境不确定干扰带来的误差，从而实现在损伤状态下的轨迹跟踪。通过与H∞控制器的效果对比，突出
Figure BDA0002323878950000017
自适应控制器的优越性。
发明内容
本发明旨在克服现有控制方法的不足，针对尾座式无人机，提出一种基于
Figure BDA0002323878950000018
自适应控制器的尾座式无人机轨迹跟踪容错控制方法，使尾座式无人机在执行机构损伤故障下可以快速，准确地实现包含过渡段的轨迹跟踪。
本发明采用的技术方案为:一种基于
Figure BDA0002323878950000021
自适应控制器的尾座式无人机轨迹跟踪容错控制方法，包括如下步骤：
步骤一：给定期望的俯仰轨迹trajx和trajz。
步骤二：建立尾座式无人机的非线性动力学和运动学模型。
步骤三：设计
Figure BDA0002323878950000022
自适应控制器，包括位置
Figure BDA0002323878950000023
自适应控制器和角度
Figure BDA0002323878950000024
自适应控制器。
步骤四：将
Figure BDA0002323878950000025
自适应控制器应用于尾座式无人机，进行轨迹跟踪仿真，并与H∞控制器进行对比。
其中，在步骤二中所描述的尾座式非线性无人机动力学和运动学模型的建立方法如下:
以如图1所示的六自由度尾座式无人机为例，认为此六自由度尾座式无人机为刚体其受力特性如图2所示，动力学和运动学模型可以描述如下：
Figure BDA0002323878950000026
Figure BDA0002323878950000027
Figure BDA0002323878950000028
Figure BDA0002323878950000029
Figure BDA00023238789500000210
Figure BDA00023238789500000211
其中vbx,vby,vbz是飞行器本体坐标系下的速度，ωbx,ωby,ωbz是飞行器本体坐标系下的角速度，
Figure BDA00023238789500000212
θ,ψ分别表示滚转、俯仰、偏航三个姿态角，ci(i＝1～9)是与转动惯量有关的定常数，m为飞行器的质量，g是重力常数， F＝[Fx Fy Fz]T＝Fa+Fm与τ＝[τx τy τz]T＝τa+τm表示飞行器所受到的力和力矩，其中Fa,Fm,τa,τm分别表示气动力，电机产生力以及气动力矩，电机产生那个力矩。
气动力和气动力矩的计算可以写成如下方程形式：
Figure BDA00023238789500000213
其中ρa表示参考大气密度，c表示机翼弦长，S表示飞机气动面积，υb＝[υbx,υby,υbz]T是机体坐标系中的实时速度，Ci(i＝X,Y,Z,L,M,N)表示空气动力系数，且Ci受到攻角
Figure BDA0002323878950000031
侧滑角
Figure BDA0002323878950000032
和四个叶片偏转
Figure BDA0002323878950000033
的影响，具体表示如下：
Figure BDA0002323878950000034
电机产生沿机体轴推力和力矩可以表示如下：
Figure BDA0002323878950000035
其中b和d是常系数，T是电机推力，τm＝[τmx τmy τmz]T，li(i＝1,2,3,4)表示各电机到飞行器质心的距离，wi(i＝1,2,3,4)表示第i个电机转子的转速。
考虑到不确定性和外部干扰，便于容错控制器设计，可以将电机产生的推力和力矩写成如下形式：
Figure BDA0002323878950000036
其中，u01＝d((δ1-n1)w1 2+(δ2-n1)w2 2+(δ3-n1)w3 2+(δ4-n1)w4 2)，
u02＝b((δ1-n2)w1 2-(δ2-n2)w2 2-(δ3-n2)w3 2+(δ4-n2)w4 2)，
u03＝b((δ1-n3)l1w1 2+(δ2-n3)l1w2 2-(δ3-n3)l2w3 2-(δ4-n3)l2w4 2)，
u04＝b((δ1-n4)l3w1 2-(δ2-n4)l4w2 2+(δ3-n4)l3w3 2-(δ4-n4)l4w4 2).
ni(i＝1,2,3,4)为损失系数。
其中，在步骤三中所述的设计
Figure BDA0002323878950000041
自适应控制器，其计算方法如下:
图3是
Figure BDA0002323878950000042
自适应控制器内部结构框图，图4是控制系统框图，根据图中流程设计控制器，总
Figure BDA0002323878950000043
自适应控制器包含两个子控制器：位置
Figure BDA0002323878950000044
自适应控制器和角度
Figure BDA0002323878950000045
自适应控制器。位置和角度控制器所对应的控制输入分别为在本体系下的三轴力和力矩：
u1＝F,u2＝τ
1)设计位置
Figure BDA0002323878950000046
自适应控制器
位置误差模型为：
Figure BDA0002323878950000047
其控制输入定义为：
Figure BDA0002323878950000048
其中理想控制输入ui1表示为
Figure BDA0002323878950000049
Kp1和Kp2为正增益矩阵，
Figure BDA00023238789500000415
是需要进行设计的控制律，Seb是惯性系到本体系的转换矩阵，位置误差可写成：
Figure BDA00023238789500000410
其中
Figure BDA00023238789500000411
Ii表示i维单位阵，Oi表示i 维零阵，状态量
Figure BDA00023238789500000412
满足：
Figure BDA00023238789500000413
状态方程写成矩阵形式：
Figure BDA00023238789500000414
其中
Figure BDA0002323878950000051
状态观测器：
Figure BDA0002323878950000052
其中
Figure BDA0002323878950000053
其中
Figure BDA0002323878950000054
K1为增益矩阵，P1是李雅普诺夫方程A1 TP1+P1A1＝-Q1的解， Q1＞0已知。
控制律可写为
Figure BDA00023238789500000514
其中D1(s)是低通滤波器，χ1(s)是
Figure BDA0002323878950000055
的laplace变换。
2)设计角度
Figure BDA0002323878950000056
自适应控制器
角度误差模型为：
Figure BDA0002323878950000057
其控制输入定义为：
Figure BDA0002323878950000058
其中N＝diag{n2,n3,n4}， U＝[u02,u03,u04]T，理想控制输入ui2表示为
Figure BDA0002323878950000059
Ka1和Ka2为正增益矩阵，
Figure BDA00023238789500000515
是需要进行设计的控制律，角度误差可写成：
Figure BDA00023238789500000510
其中u′i2是ui2对角化后的方阵，ζ′1＝AJ-1(I3-N)转变成列向量可以得到ζ1，
Figure BDA00023238789500000511
由转动惯量阵J的对角线元素组成，ζ2＝AJ1 -1×J1，d2＝AJ-1(τa+U)，Ω＝diag{ωbyωbz,ωbxωbz,ωbxωby}，状态量
Figure BDA00023238789500000512
满足：
Figure BDA00023238789500000513
状态方程写成矩阵形式：
Figure BDA0002323878950000061
其中
Figure BDA0002323878950000062
状态观测器：
Figure BDA0002323878950000063
其中
Figure BDA0002323878950000064
其中
Figure BDA0002323878950000065
K2为增益矩阵，P2是李雅普诺夫方程A2 TP2+P2A2＝-Q2的解， Q2＞0已知。
控制律可写为：
Figure BDA0002323878950000068
其中D2(s)是低通滤波器，χ2(s)是
Figure BDA0002323878950000066
的laplace变换，Kg＝-(C2A2 -1B2)-1，ρr(s)为参考角度。
本发明为“一种基于
Figure BDA0002323878950000067
自适应控制器的尾座式无人机轨迹跟踪容错控制方法”，与现有的控制方法相比，其优点是：
1)本方法设计的控制器是所调参数可应用于整个轨迹跟踪过程，不必取工作点进行模式切换，在实际工程上易于实现。
2)本方法设计的控制器可以有效地改善尾座式无人机在执行机构故障的情况下轨迹跟踪的效果。
3)本方法设计的控制器可以有效降低模型非线性，耦合，环境干扰和参数不确定带来的影响，快速且鲁棒性强。
附图说明
图1为六自由度尾座式无人机结构图；
图2为尾座式无人机的受力图；
符号说明如下：
ρa-参考大气密度，单位kg/m3；
m-飞行器的质量，单位kg；
c-参考气动弦长，单位m
S-参考气动面积，单位m2
vb-参考平飞速度，单位m/s
wi-各电机的转速，单位r/min；
Δi-各舵面的偏转，单位deg；
g-重力加速度常数。
图3为
Figure BDA0002323878950000071
自适应控制器结构图；
图4为控制系统结构图
图5为参考标准轨迹图。
图6为无故障状态下H∞控制器轨迹图。
图7为无故障状态下H∞控制器角度图。
图8为无故障状态下H∞控制器轨迹误差图。
图9为损伤故障状态下
Figure BDA0002323878950000072
自适应控制器轨迹图。
图10为损伤状态下
Figure BDA0002323878950000073
自适应控制器轨迹误差图。
图11为损伤状态下
Figure BDA0002323878950000074
自适应控制器角度图。
图12为
Figure BDA0002323878950000075
自适应控制器自适应量图。
图13为
Figure BDA0002323878950000076
自适应控制器自适应量图。
具体实施方式
下面结合实施例，并配合附图对本发明中的各部分设计方法作进一步的说明
本发明为“一种基于
Figure BDA0002323878950000077
自适应控制器的尾座式无人机轨迹跟踪容错控制方法”，附图见图1—图13所示，其具体步骤如下:
步骤一：给定期望的俯仰轨迹trajx和trajz如图5所示。
Figure BDA0002323878950000081
Figure BDA0002323878950000082
其中系数如表1所示：
Figure BDA0002323878950000083
表1尾座式无人机俯仰轨迹系数表
步骤二：建立尾座式无人机的非线性动力学和运动学模型。
以如图1所示的六自由度尾座式无人机为例，主要通过四个电机产生的推力和力矩以及四片舵面产生的气动力和力矩改变尾座式无人机的运动状态。假设此尾座式无人机为刚体，其受力特性如图2所示，动力学和运动学模型可以描述如下：
Figure BDA0002323878950000084
Figure BDA0002323878950000085
Figure BDA0002323878950000086
Figure BDA0002323878950000087
Figure BDA0002323878950000088
Figure BDA0002323878950000089
其中vbx,vby,vbz是飞行器本体坐标系下的速度，ωbx,ωby,ωbz是飞行器本体坐标系下的角速度，
Figure BDA00023238789500000810
θ,ψ分别表示滚转、俯仰、偏航三个姿态角， ci(i＝1～9)是与转动惯量有关的定常数，m为飞行器的质量，g是重力常数， F＝[Fx Fy Fz]T＝Fa+Fm与τ＝[τx τy τz]T＝τa+τm表示飞行器所受到的力和力矩，其中Fa,Fm,τa,τm分别表示气动力，电机产生力以及气动力矩，电机产生那个力矩。
气动力和气动力矩的计算可以写成如下方程形式：
Figure BDA0002323878950000091
其中ρa表示参考大气密度，c表示机翼弦长，S表示飞机气动面积，υb＝[υbx,υby,υbz]T是机体坐标系中的实时速度，Ci(i＝X,Y,Z,L,M,N)表示空气动力系数插值获得，且Ci受到攻角
Figure BDA0002323878950000092
侧滑角
Figure BDA0002323878950000093
和四个叶片偏转
Figure BDA0002323878950000094
的影响，具体表示如下：
Figure BDA0002323878950000095
其中的气动参数如表2所示。
Figure BDA0002323878950000096
表2尾座式无人机气动参数
电机产生沿机体轴推力和力矩可以表示如下：
Figure BDA0002323878950000097
其中b和d是常系数，T是电机推力，τm＝[τmx τmy τmz]T，li(i＝1,2,3,4)表示各电机到飞行器质心的距离，wi(i＝1,2,3,4)表示第i个电机转子的转速。
考虑到不确定性和外部干扰，便于容错控制器设计，可以将电机产生的推力和力矩写成如下形式：
Figure BDA0002323878950000101
其中，u01＝d((δ1-n1)w1 2+(δ2-n1)w2 2+(δ3-n1)w3 2+(δ4-n1)w4 2)，
u02＝b((δ1-n2)w1 2-(δ2-n2)w2 2-(δ3-n2)w3 2+(δ4-n2)w4 2)，
u03＝b((δ1-n3)l1w1 2+(δ2-n3)l1w2 2-(δ3-n3)l2w3 2-(δ4-n3)l2w4 2)，
u04＝b((δ1-n4)l3w1 2-(δ2-n4)l4w2 2+(δ3-n4)l3w3 2-(δ4-n4)l4w4 2).
ni(i＝1,2,3,4)为损失系数。
步骤三：设计
Figure BDA0002323878950000102
自适应控制器，包含两个子控制器：位置
Figure BDA0002323878950000103
自适应控制器和角度
Figure BDA0002323878950000104
自适应控制器。
图3为
Figure BDA0002323878950000105
自适应控制器结构图，图4是控制系统框图，根据图中流程设计控制器，包含两个子控制器：位置
Figure BDA0002323878950000106
自适应控制器和角度
Figure BDA0002323878950000107
自适应控制器。位置和角度控制器所对应的控制输入分别为在本体系下的三轴力和力矩：
u1＝F,u2＝τ
1)设计位置
Figure BDA0002323878950000108
自适应控制器
位置误差模型为：
Figure BDA0002323878950000109
其控制输入定义为：
Figure BDA00023238789500001010
其中理想控制输入ui1表示为
Figure BDA00023238789500001011
Kp1和Kp2为正增益矩阵，
Figure BDA00023238789500001014
是需要进行设计的控制律，Seb是惯性系到本体系的转换矩阵，位置误差可写成：
Figure BDA00023238789500001012
其中
Figure BDA00023238789500001013
Ii表示i维单位阵，Oi表示i 维零阵，状态量
Figure BDA0002323878950000111
满足：
Figure BDA0002323878950000112
状态方程写成矩阵形式：
Figure BDA0002323878950000113
其中
Figure BDA0002323878950000114
状态观测器：
Figure BDA0002323878950000115
其中
Figure BDA0002323878950000116
其中
Figure BDA0002323878950000117
K1为增益矩阵，P1是李雅普诺夫方程A1 TP1+P1A1＝-Q1的解， Q1＞0已知。
控制律可写为
Figure BDA00023238789500001113
其中D1(s)是低通滤波器，χ1(s)是
Figure BDA0002323878950000118
的laplace变换。
2)设计角度
Figure BDA0002323878950000119
自适应控制器
角度误差模型为：
Figure BDA00023238789500001110
其控制输入定义为：
Figure BDA00023238789500001111
其中N＝diag{n2,n3,n4}， U＝[u02,u03,u04]T，理想控制输入ui2表示为
Figure BDA00023238789500001112
Ka1和Ka2为正增益矩阵，
Figure BDA00023238789500001114
是需要进行设计的控制律，角度误差可写成：
Figure BDA0002323878950000121
其中u′i2是ui2对角化后的方阵，ζ′1＝AJ-1(I3-N)转变成列向量可以得到ζ1，
Figure BDA0002323878950000122
由转动惯量阵J的对角线元素组成，ζ2＝AJ1 -1×J1，d2＝AJ-1(τa+U)，Ω＝diag{ωbyωbz,ωbxωbz,ωbxωby}，状态量
Figure BDA0002323878950000123
满足：
Figure BDA0002323878950000124
状态方程写成矩阵形式：
Figure BDA0002323878950000125
其中
Figure BDA0002323878950000126
状态观测器：
Figure BDA0002323878950000127
其中
Figure BDA0002323878950000128
其中
Figure BDA0002323878950000129
K2为增益矩阵，P2是李雅普诺夫方程A2 TP2+P2A2＝-Q2的解， Q2＞0已知。
控制律可写为：
Figure BDA00023238789500001212
其中D2(s)是低通滤波器，χ2(s)是
Figure BDA00023238789500001210
的laplace变换，Kg＝-(C2A2 -1B2)-1，ρr(s)为参考角度。
步骤四：将
Figure BDA00023238789500001211
自适应控制器应用于尾座式无人机，进行轨迹跟踪仿真，并与H∞控制器进行对比。
根据步骤二得到的飞行器模型，和步骤三得到的控制器，在simulink仿真平台上进行仿真验证，并将所设计的控制器与标准H∞控制器作对比，来验证所设计控制器的性能。
尾座式无人机的物理参数如表3所示。
Figure BDA0002323878950000131
表3尾座式无人机物理参数表
选取控制器设计中的参数如下：δ1＝0.85，δ2＝0.85，δ3＝0.9，δ4＝0.9， n1＝0.9，n2＝0.85，n3＝0.9，n4＝0.9，κ1＝0.7，κ2＝0.9，κ3＝0.8，μ1＝0.3，μ2＝0.4，
Figure BDA0002323878950000132
Kp1＝diag{6,0.6,6}， Kp2＝diag{0.05,0.05,0.05}，Ka1＝diag{8500,44,5600}， Ka2＝diag{9.5,120,9.5}，Q1＝Q2＝10-3I6，K1＝100，K2＝10000， d1＝[0.01,0.01cos(0.1t),0.1cos(0.1t)]Tm/s2， d2＝[0.01cos(0.1t),0.01cos(0.1t),0.01e-20t]TNm。仿真步长为0.01s。
实施例1：在无执行机构损伤故障下，H∞控制器跟踪效果。
图6和图7为无执行机构损伤故障下，H∞控制器控制下的轨迹和角度图，图8为实际轨迹与标准轨迹误差图。可以看出，在没有故障的状态下，使用H∞控制器是可以完成轨迹跟踪的。
实施例2：在考虑执行机构损伤故障下，所提出的
Figure BDA0002323878950000133
自适应控制器与H∞控制器跟踪效果比较。
图9是使用传统的标准H∞控制器和
Figure BDA0002323878950000134
自适应控制器在故障情况下的轨迹跟踪对比图，图10和图11是
Figure BDA0002323878950000135
自适应控制器在故障状态下的轨迹误差图和角度图，图12和图13为控制器自适应量。可以看出，
Figure BDA0002323878950000136
自适应控制器在故障时的轨迹跟踪性能优于H∞控制器，H∞控制器在故障时效果明显下降，本发明所提
Figure BDA0002323878950000137
自适应控制器可以实现期望目标。

Claims (3)

1.一种基于
Figure FDA0003102783460000011
自适应控制器的尾座式无人机轨迹跟踪容错控制方法，包括以下步骤：
步骤一：给定期望的俯仰轨迹trajx和trajz；
步骤二：建立尾座式无人机的非线性动力学和运动学模型；
步骤三：设计
Figure FDA0003102783460000012
自适应控制器，包括位置
Figure FDA0003102783460000013
自适应控制器和角度
Figure FDA0003102783460000014
自适应控制器；
步骤四：将
Figure FDA0003102783460000015
自适应控制器应用于尾座式无人机，进行轨迹跟踪仿真，并与H∞控制器进行对比；
尾座式无人机的非线性模型为：
Figure FDA0003102783460000016
Figure FDA0003102783460000017
Figure FDA0003102783460000018
Figure FDA0003102783460000019
Figure FDA00031027834600000110
Figure FDA00031027834600000111
其中vbx,vby,vbz是飞行器本体坐标系下的速度，ωbx,ωby,ωbz是飞行器本体坐标系下的角速度，
Figure FDA00031027834600000112
θ,ψ分别表示滚转、俯仰、偏航三个姿态角，ci(i＝1～9)是与转动惯量有关的定常数，m为飞行器的质量，g是重力常数，F＝[Fx Fy Fz]T＝Fa+Fm与τ＝[τx τy τz]T＝τa+τm表示飞行器所受到的力和力矩，其中Fa,Fm,τa,τm分别表示气动力，电机产生力以及气动力矩，电机产生力矩，气动力和气动力矩的计算可以写成如下方程形式：
Figure FDA00031027834600000113
其中ρa表示参考大气密度，c表示机翼弦长，S表示飞机气动面积，υb＝[υbx,υby,υbz]T是机体坐标系中的实时速度，Ci(i＝X,Y,Z,L,M,N)表示空气动力系数插值获得，且Ci受到攻角
Figure FDA00031027834600000114
侧滑角
Figure FDA00031027834600000115
和四个叶片偏转的影响，具体表示如下：
Figure FDA0003102783460000021
电机产生沿机体轴推力和力矩可以表示如下：
Figure FDA0003102783460000022
其中b和d是常系数，T是电机推力，τm＝[τmx τmy τmz]T，li(i＝1,2,3,4)表示各电机到飞行器质心的距离，wi(i＝1,2,3,4)表示第i个电机转子的转速，考虑到不确定性和外部干扰，便于容错控制器设计，可以将电机产生的推力和力矩写成如下形式：
Figure FDA0003102783460000023
其中，u01＝d((δ1-n1)w1 2+(δ2-n1)w2 2+(δ3-n1)w3 2+(δ4-n1)w4 2)，
u02＝b((δ1-n2)w1 2-(δ2-n2)w2 2-(δ3-n2)w3 2+(δ4-n2)w4 2)，
u03＝b((δ1-n3)l1w1 2+(δ2-n3)l1w2 2-(δ3-n3)l2w3 2-(δ4-n3)l2w4 2)，
u04＝b((δ1-n4)l3w1 2-(δ2-n4)l4w2 2+(δ3-n4)l3w3 2-(δ4-n4)l4w4 2)，
ni(i＝1,2,3,4)为损失系数；
总
Figure FDA0003102783460000024
自适应控制器包含两个子控制器：位置
Figure FDA0003102783460000025
自适应控制器和角度
Figure FDA0003102783460000026
自适应控制器，位置和角度控制器所对应的控制输入分别为在本体系下的三轴力和力矩：
u1＝F,u2＝τ。
2.根据权利要求1所述的一种基于
Figure FDA0003102783460000031
自适应控制器的尾座式无人机轨迹跟踪容错控制方法，其特征在于：所述步骤一中设计的位置
Figure FDA0003102783460000032
自适应控制器如下：
位置误差模型为：
Figure FDA0003102783460000033
其控制输入定义为：
Figure FDA0003102783460000034
其中理想控制输入ui1表示为
Figure FDA0003102783460000035
Kp1和Kp2为正增益矩阵，
Figure FDA0003102783460000036
是需要进行设计的控制律，Seb是惯性系到本体系的转换矩阵，位置误差可写成：
Figure FDA0003102783460000037
其中
Figure FDA0003102783460000038
Ii表示i维单位阵，Oi表示i维零阵，状态量
Figure FDA0003102783460000039
如下：
Figure FDA00031027834600000310
Figure FDA00031027834600000311
状态观测器：
Figure FDA00031027834600000312
其中
Figure FDA00031027834600000313
其中
Figure FDA00031027834600000314
K1为增益矩阵，P1是方程A1 TP1+P1A1＝-Q1的解，Q1＞0已知，
控制律可写为：
Figure FDA00031027834600000315
其中D1(s)是低通滤波器，χ1(s)是
Figure FDA0003102783460000041
的laplace变换。
3.根据权利要求1所述的一种基于
Figure FDA0003102783460000042
自适应控制器的尾座式无人机轨迹跟踪容错控制方法，其特征在于：所述步骤一中设计的角度
Figure FDA0003102783460000043
自适应控制器为：
角度误差模型为：
Figure FDA0003102783460000044
其控制输入定义为：
Figure FDA0003102783460000045
其中N＝diag{n2,n3,n4}，U＝[u02,u03,u04]T，理想控制输入ui2表示为
Figure FDA0003102783460000046
Ka1和Ka2为正增益矩阵，
Figure FDA0003102783460000047
是需要进行设计的控制律，角度误差可写成：
Figure FDA0003102783460000048
其中ui′2是ui2对角化后的方阵，ζ1′＝AJ-1(I3-N)转变成列向量可以得到ζ1，
Figure FDA0003102783460000049
由转动惯量阵J的对角线元素组成，ζ2＝AJ1 -1×J1，d2＝AJ-1(τa+U)，Ω＝diag{ωbyωbz,ωbxωbz,ωbxωby}，状态量
Figure FDA00031027834600000410
如下：
Figure FDA00031027834600000411
Figure FDA00031027834600000412
状态观测器：
Figure FDA00031027834600000413
其中
Figure FDA00031027834600000414
其中
Figure FDA00031027834600000415
K2为增益矩阵，P2是方程A2 TP2+P2A2＝-Q2的解，Q2＞0已知，
控制律可写为：
Figure FDA0003102783460000051
其中D2(s)是低通滤波器，χ2(s)是
Figure FDA0003102783460000052
的laplace变换，Kg＝-(C2A2 -1B2)-1，ρr(s)为参考角度。
CN201911308610.7A 2019-12-18 2019-12-18 一种基于l1自适应控制器的尾座式无人机轨迹跟踪容错控制方法 Active CN111459175B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911308610.7A CN111459175B (zh) 2019-12-18 2019-12-18 一种基于l1自适应控制器的尾座式无人机轨迹跟踪容错控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911308610.7A CN111459175B (zh) 2019-12-18 2019-12-18 一种基于l1自适应控制器的尾座式无人机轨迹跟踪容错控制方法

Publications (2)

Publication Number Publication Date
CN111459175A CN111459175A (zh) 2020-07-28
CN111459175B true CN111459175B (zh) 2021-07-27

Family

ID=71684922

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911308610.7A Active CN111459175B (zh) 2019-12-18 2019-12-18 一种基于l1自适应控制器的尾座式无人机轨迹跟踪容错控制方法

Country Status (1)

Country Link
CN (1) CN111459175B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112068421B (zh) * 2020-07-30 2021-11-09 北京航空航天大学 一种基于l1自适应控制的弹性高超声速飞行器容错控制方法
CN111880410B (zh) * 2020-08-11 2021-12-28 北京航空航天大学 一种针对电机故障的四旋翼无人机容错控制方法
CN113618743B (zh) * 2021-08-27 2022-08-23 北京航空航天大学杭州创新研究院 一种针对多源干扰的无人机机械臂末端位姿控制方法
CN114018531B (zh) * 2021-11-09 2023-03-21 中国空气动力研究与发展中心超高速空气动力研究所 一种高超声速风洞连续变总压的试验数据处理方法
CN115129089B (zh) * 2022-08-29 2022-12-02 国网湖北省电力有限公司技术培训中心 无人机拖挂横幅飞行轨迹容错控制方法及设备

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105629734A (zh) * 2016-02-14 2016-06-01 济南大学 一种近空间飞行器的轨迹跟踪控制方法
CN108445895A (zh) * 2018-02-05 2018-08-24 天津大学 用于倾转式三旋翼无人机位置控制的鲁棒控制方法
CN109597426A (zh) * 2018-11-13 2019-04-09 上海无线电设备研究所 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法
CN109634110A (zh) * 2017-10-09 2019-04-16 北京航空航天大学 一种基于非线性干扰观测器的尾座式无人机过渡段鲁棒控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105629734A (zh) * 2016-02-14 2016-06-01 济南大学 一种近空间飞行器的轨迹跟踪控制方法
CN109634110A (zh) * 2017-10-09 2019-04-16 北京航空航天大学 一种基于非线性干扰观测器的尾座式无人机过渡段鲁棒控制方法
CN108445895A (zh) * 2018-02-05 2018-08-24 天津大学 用于倾转式三旋翼无人机位置控制的鲁棒控制方法
CN109597426A (zh) * 2018-11-13 2019-04-09 上海无线电设备研究所 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
Nonlinear robust control of hypersonic aircrafts with interactions between flight dynamics and propulsion systems;ZHAOYING LI,etc.;《ISA Transactions》;20160427;第1-11页 *
Nonlinear robust control of tail-sitter aircrafts in flight mode transitions;ZHAOYING LI,etc.;《Aerospace Science and Technology》;20180822;第348-361页 *
Robust Controller Design for a Tail-sitter UAV in Flight Mode Transitions;ZHAOYING LI,etc.;《2018 IEEE 14th International Conference on Control and Automation (ICCA)》;20180823;第763-768页 *
无人机快速鲁棒自适应轨迹跟踪控制方法研究;张永昌;《中国优秀硕士学位论文全文数据库（电子期刊）》;20180415;第C031-121页 *

Also Published As

Publication number Publication date
CN111459175A (zh) 2020-07-28

Similar Documents

Publication Publication Date Title
CN111459175B (zh) 一种基于l1自适应控制器的尾座式无人机轨迹跟踪容错控制方法
Madani et al. Backstepping control for a quadrotor helicopter
Flores et al. Quad-tilting rotor convertible mav: Modeling and real-time hover flight control
CN109856972B (zh) 一种无人直升机鲁棒容错跟踪控制方法
Madani et al. Backstepping control with exact 2-sliding mode estimation for a quadrotor unmanned aerial vehicle
CN108873929B (zh) 一种固定翼飞机自主着舰方法及系统
CN107491083B (zh) 一种基于饱和自适应滑模控制的四旋翼自主着船方法
CN104460681A (zh) 倾转旋翼无人直升机过渡段的飞行控制方法
CN108803639A (zh) 一种基于反步法的四旋翼飞行器飞行控制方法
CN111045440B (zh) 一种高超声速飞行器俯冲段快速滚转控制方法
Xu et al. Full attitude control of an efficient quadrotor tail-sitter VTOL UAV with flexible modes
CN107608368B (zh) 一种无人机在极端初始状态的快速平衡控制方法
CN113703320A (zh) 一种抗干扰和饱和特性的飞行机械臂位姿控制方法
CN115933733A (zh) 一种固定翼无人机纵向高度速度解耦非线性控制方法
CN109634110B (zh) 一种基于非线性干扰观测器的尾座式无人机过渡段鲁棒控制方法
CN107678442B (zh) 一种基于双模型下的四旋翼自主着船控制方法
CN114237270B (zh) 一种考虑输入饱和的无人直升机跟踪控制方法
CN112327629B (zh) 基于动态补偿的小型无人直升机自适应容错控制方法
Ramírez et al. Nonlinear vector-projection control for agile fixed-wing unmanned aerial vehicles
Cardoso et al. A nonlinear W∞ controller of a tilt-rotor UAV for trajectory tracking
CN116185057B (zh) 一种面向翼身融合飞翼无人机的姿态容错控制方法
Chen et al. Adaptive attitude control for a coaxial tilt-rotor UAV via immersion and invariance methodology
Zou et al. Adaptive tracking control for a model helicopter with disturbances
CN111897219A (zh) 基于在线逼近器的倾转四旋翼无人机过渡飞行模式最优鲁棒控制方法
Gai et al. Modeling and LPV flight control of the canard rotor/wing unmanned aerial vehicle

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