欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2019101794025
申请人: 南京邮电大学
专利类型:发明专利
专利状态:未下证
专利领域: 控制;调节
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种基于饱和受限情况下的无人机自适应跟踪控制算法,其特征在于,包括以下步骤:步骤A、在考虑扰动存在的情况下,建立四旋翼无人机的二阶系统数学模型;

步骤B、基于四旋翼无人机的二阶系统模型,对于外环位置子系统,提出滑模控制器对无人机系统进行控制,以实现对无人机位置状态的控制;

步骤C、基于四旋翼无人机的二阶系统模型,对于内环姿态子系统,提出自适应控制策略对无人机系统进行控制,以实现对无人机姿态状态的控制。

2.根据权利要求1所述的基于饱和受限情况下的无人机自适应跟踪控制算法,其特征在于,步骤A具体为:所述二阶系统数学模型为其中,状态x,y,z表示四旋翼的位置,状态θ,φ,ψ由三个姿态角组成,g是重力加速度,Ii(i=1,2,3)代表惯性矩,Ki(i=1,2…6)代表阻力系数,di(i=1,2…6)是系统扰动,滚动角φ和俯仰角θ的范围(-2/π<φ、θ<2/π),偏航角ψ的范围也限于(-π<ψ<π),ui(i=1,2,3,

4)表示四旋翼的四个控制输入量。

将公式(1)所表示的四旋翼无人机数学模型拆分成位置和姿态两部分,以便于分布式处理:将四旋翼无人机模型写成矩阵形式,因此,公式(2)可以用以下形式书写:其中,ξ=[x y z]T是四旋翼无人机在惯性坐标系中的质心位置, 是垂直单位矢量,g是重力加速度,令dF=[md1 md2 md3]T,m是四旋翼无人机的质量;

是旋转矩阵,其中c·=

cos(·)、s·=sin(·)。

3.根据权利要求2所述的基于饱和受限情况下的无人机自适应跟踪控制算法,其特征在于,步骤B具体为:所述滑模控制器为:定义一个滑模控制函数

其中,λ1是一个正数并满足Hurwitz条件,并且s1(t)表示平动的滑模面。

选择指数收敛的控制律,滑模面的导数应如下其中ε1≥DF/m和k1是正常数,符号函数定义如下考虑公式(5),公式(6)的导数是

因此,对比公式(5)和公式(8),位置子系统的滑模控制律可以设计如下

4.根据权利要求3所述的基于饱和受限情况下的无人机自适应跟踪控制算法,其特征在于,步骤C具体为:所述自适应控制器为:假设预期跟踪的参考姿态是δd=[θd φd ψd]T并且虚拟控制律是αi=[α1 α2 α3]T;定义错误变量e1=δ-δd和e2=δ1-αi,虚拟控制定律αi可以定义如下 其中I3×3表示单位矩阵;

考虑公式(3)并求导,我们得到可用位置子系统的误差方程其中δ=[θ φ ψ]T为无人机姿态角,U=[u2 u3 u4]T, I=[I1 I2 I3]T代表惯性矩,dF=[d4 d5 d6]T代表阻力系数。

考虑Lyapunov函数

Vi求导可得

引入αi,可得

为方便输入饱和受限影响的分析,给出了辅助设计系统其中

η∈R3是辅助设计系统的状态,设计参数是正常数,应根据跟踪性能的要求选择适当的值;

考虑输入饱和的影响,请选择以下控制律

5.根据权利要求4所述的基于饱和受限情况下的无人机自适应跟踪控制算法,其特征在于,其对于四旋翼无人机在获得虚拟输入之后,还得计算实际升程控制输入并将其传递到姿态子系统中间命令信号,具体包括以下步骤:将虚拟控制输入写为向量Uξ=[ux,uy,uz]T,将中间命令信号设置为Θd=[φd,θd,ψd]T表示无人机的虚拟姿态角;

考虑 Uξ=[ux,uy,uz]T和 可以得到进一步

变为矩阵形式

使用Θd代替姿态子系统的中间命令信号Θ,获得因为

可得

滚转角指令信号是

俯仰角指令信号是

偏航角ψd可用于跟踪给定指令信号的任意偏航角。

6.根据权利要求5所述基于饱和受限情况下的无人机自适应跟踪控制算法,其特征在于,其对于四旋翼无人机的稳定性采用如下方式验证:是利用Lyapunov稳定性理论,设计Lyapunov函数证明在四旋翼无人机位置子系统和姿态子系统的稳定性;具体包括以下步骤:步骤a:对于采用滑模控制策略的位置子系统,考虑Lyapunov函数V1的导数如下:

由于ε1≥DF/m,可得

从上面的分析我们可以看出s1是指数收敛,即eξ指数收敛。类似地,位置误差子系统是指数稳定的。

步骤b:对于采用自适应控制策略的姿态子系统,考虑Lyapunov函数根据公式(27),V的导数

将公式(15)带入公式(28),可得

为了确保系统的稳定性,选择适当的参数k22来确保k22-I3×3≥0。

7.根据权利要求6所述基于饱和受限情况下的无人机自适应跟踪控制算法,其特征在于,在外界扰动和内在误差无法估计的时候,提出非线性ESO控制策略,对内部不可建模和外部不可估计的扰动进行估计和补偿:ESO可用于姿态子系统,以估计和补偿外部环境的总干扰,对于这种情况,系统扩张状态方程是状态观察器,即ESO是为了扩张状态而建立的选择适当的参数βi(i=1,2,3),d4可以被估计和补偿;

类似地,φ和ψ也可以使用扩展状态观察器来估计误差,这样也可以通过ESO进行补偿;

通过将自适应跟踪控制方法与ESO相结合,可以得到新的姿态角控制律,如下所示其中di是对系统总扰动的估计,δ=[θ φ ψ]T为无人机姿态角,U=[u2 u3 u4]T,I=[I1 I2 I3]T代表惯性矩,dF=[d4 d5 d6]T代表阻力系数。