四旋翼无人机抗饱和及干扰的位置和姿态跟踪控制方法技术

本发明专利技术公开了一种四旋翼无人机抗饱和及干扰的位置和姿态跟踪控制方法，首先，基于牛顿

【技术实现步骤摘要】
四旋翼无人机抗饱和及干扰的位置和姿态跟踪控制方法


[0001]本专利技术涉及一种四旋翼无人机抗饱和及干扰的位置和姿态跟踪控制方法，属于四旋翼无人机的飞行控制


技术介绍

[0002]近十年以来，四旋翼无人机由于其成本低廉、高机动性、扩展性强等优点在飞行航拍、物流搬运、火灾救援、地震搜救等各行各业得到了越来越广泛的应用。然而，四旋翼无人机是典型的欠驱动、非线性系统，且在空中飞行时容易受到输入饱和问题和未知时变干扰的影响。因此，设计一种抗饱和抗干扰高性能四旋翼无人机飞行控制器是一项具有挑战性的课题。
[0003]目前已经有许多控制方法在四旋翼无人机上得到了应用，比如PID控制、模型预测控制、滑模控制等等。此外，目前的抗饱和控制主要分为辅助系统法、双曲正弦函数逼近法、基于齐次性理论的有界控制器设计法，但前两种方法只能保证控制系统有界，最后一种方法很难获得光滑的期望欧拉角。
[0004]文(Tang P,Zhang F,Ye J,et al.An integral TSMC
‑
based adaptive fault
‑
tolerant control for quadrotor with external disturbances and parametric uncertainties[J].Aerospace Science and Technology,2021,109:106415.)针对四旋翼系统的外部干扰、参数不确定性和执行器故障，提出了一种基于有限时间精确观测器和多变量积分终端滑模控制不需要故障诊断机制的有限时间容错轨迹跟踪控制方法。文(Huang D,Huang T,Qin N,et al.Finite
‑
time control for a UAV system based on finite
‑
time disturbance observer[J].Aerospace Science and Technology,2022,129:107825.)研究了受输入饱和与外界干扰影响的无人机系统的有限时间控制问题，设计了一种辅助系统来补偿输入饱和效应，开发了一种快速终端滑模控制器来实现无人机的轨迹跟踪控制/稳定。但以上结果均没有综合考虑四旋翼无人机外环和内环的抗干扰设计，且只能得到闭环系统有界的结论。

技术实现思路

[0005]考虑到四旋翼无人机系统的欠驱动、非线性以及易受未知时变干扰、输入饱和问题影响的特征，本专利技术提供一种四旋翼无人机抗饱和及干扰的位置和姿态跟踪控制方法，是一种将有限时间干扰观测器和反步控制方法相结合的复合抗饱和抗干扰位置和姿态跟踪控制方法，使四旋翼无人机系统具有渐近跟踪性能和强抗饱和抗干扰性能。
[0006]本专利技术为解决上述技术问题采用以下技术方案：
[0007]本专利技术提供一种四旋翼无人机抗饱和及干扰的位置和姿态跟踪控制方法，包括以下步骤：
[0008]步骤一：考虑输入饱和与未知时变干扰，基于牛顿
‑
欧拉方法建立四旋翼无人机外环位置和内环姿态综合模型；
[0009]所述四旋翼无人机外环位置和内环姿态综合模型为：
[0010][0011][0012][0013][0014]其中：r＝[x y z]T
表示四旋翼无人机在惯性坐标系下的位置，x、y、z分别为X、Y、Z轴位置；r
d
＝[x
d y
d z
d
]T
表示四旋翼无人机在惯性坐标系下的期望位置，x
d
、y
d
、z
d
分别为X、Y、Z轴期望位置；r
e
＝[x
e y
e z
e
]T
＝r
‑
r
d
表示四旋翼无人机位置误差；v＝[v
x v
y v
z
]T
表示四旋翼无人机在惯性坐标系下的速度，v
x
、v
y
、v
z
分别为X、Y、Z轴速度；M1＝
‑
C
t
v/m，m表示四旋翼无人机的质量，C
t
＝diag{C
tx C
ty C
tz
}表示四旋翼无人机阻力系数矩阵，C
tx
,C
ty
,C
tz
＞0；表示四旋翼无人机在惯性坐标系下的外环虚拟控制量，分别为X、Y、Z轴虚拟控制量，考虑输入饱和问题，对及i＝1,2,3，需满足其中分别为给定的下界和上界；D1＝[D
11 D
12 D
13
]T
表示四旋翼无人机在惯性坐标系下外环所受到的未知时变干扰，D
11
、D
12
、D
13
分别作用在X、Y、Z轴；U
g
＝[U
g1 U
g2 U
g3
]T
表示四旋翼无人机在惯性坐标系下的外环实际控制量，U
g1
、U
g2
、U
g3
分别为X、Y、Z轴实际控制量；η＝[φ θ ψ]T
表示四旋翼无人机在惯性坐标系下的欧拉角，其中φ、θ、ψ分别为滚转角、俯仰角及偏航角；η
d
＝[φ
d θ
d ψ
d
]T
表示四旋翼无人机在惯性坐标系下的期望欧拉角，其中φ
d
、θ
d
、ψ
d
分别为期望滚转角、期望俯仰角及期望偏航角，φ
d
与θ
d
通过与ψ
d
计算得到：计算得到：g表示当地重力加速度；η
e
＝η
‑
η
d
表示四旋翼无人机姿态误差；ω＝[ω
x ω
y ω
z
]T
表示四旋翼无人机在机体坐标系下的角速度，其中ω
x
、ω
y
、ω
z
分别为绕X、Y、Z轴角速度；其中J＝diag{J
xx J
yy J
zz
}表示四旋翼无人机惯性矩阵，J
xx
,J
yy
,J
zz
＞0；表示ω的反对称矩阵；U
a
＝[U
a1 U
a2 U
a3
]T
表示四旋翼无人机在机体坐标系下的内环控制量，U
a1
、U
a2
、U
a3
分别为X、Y、Z轴控制量，考虑输入饱和问题，对及i＝1,2,3，U
ai
需满足其中分别为给定的U
ai
下界和上界；D2＝[D
2本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种四旋翼无人机抗饱和及干扰的位置和姿态跟踪控制方法，其特征在于，包括以下步骤：步骤一：考虑输入饱和与未知时变干扰，基于牛顿
‑
欧拉方法建立四旋翼无人机外环位置和内环姿态综合模型；所述四旋翼无人机外环位置和内环姿态综合模型为：所述四旋翼无人机外环位置和内环姿态综合模型为：所述四旋翼无人机外环位置和内环姿态综合模型为：所述四旋翼无人机外环位置和内环姿态综合模型为：其中：r＝[x y z]
T
表示四旋翼无人机在惯性坐标系下的位置，x、y、z分别为X、Y、Z轴位置；r
d
＝[x
d y
d z
d
]
T
表示四旋翼无人机在惯性坐标系下的期望位置，x
d
、y
d
、z
d
分别为X、Y、Z轴期望位置；r
e
＝[x
e y
e z
e
]
T
＝r
‑
r
d
表示四旋翼无人机位置误差；v＝[v
x v
y v
z
]
T
表示四旋翼无人机在惯性坐标系下的速度，v
x
、v
y
、v
z
分别为X、Y、Z轴速度；M1＝
‑
C
t
v/m，m表示四旋翼无人机的质量，C
t
＝diag{C
tx C
ty C
tz
}表示四旋翼无人机阻力系数矩阵，C
tx
,C
ty
,C
tz
＞0；表示四旋翼无人机在惯性坐标系下的外环虚拟控制量，分别为X、Y、Z轴虚拟控制量，考虑输入饱和问题，对及i＝1,2,3，需满足其中分别为给定的下界和上界；D1＝[D
11 D
12 D
13
]
T
表示四旋翼无人机在惯性坐标系下外环所受到的未知时变干扰，D
11
、D
12
、D
13
分别作用在X、Y、Z轴；U
g
＝[U
g1 U
g2 U
g3
]
T
表示四旋翼无人机在惯性坐标系下的外环实际控制量，U
g1
、U
g2
、U
g3
分别为X、Y、Z轴实际控制量；η＝[φ θ ψ]
T
表示四旋翼无人机在惯性坐标系下的欧拉角，其中φ、θ、ψ分别为滚转角、俯仰角及偏航角；η
d
＝[φ
d θ
d ψ
d
]
T
表示四旋翼无人机在惯性坐标系下的期望欧拉角，其中φ
d
、θ
d
、ψ
d
分别为期望滚转角、期望俯仰角及期望偏航角，φ
d
与θ
d
通过与ψ
d
计算得到：计算得到：g表示当地重力加速度；η

【专利技术属性】
技术研发人员：王翔宇，王继，刘维明，王国栋，李世华，
申请(专利权)人：东南大学，
类型：发明
国别省市：