利索能及
我要发布
收藏
专利号: 2018114231993
申请人: 浙江工业大学
专利类型:发明专利
专利状态:已下证
更新日期:2025-09-11
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种基于龙伯格观测器的刚性飞行器状态约束控制方法,其特征在于,所述控制方法包括以下步骤:

步骤1,建立基于修正罗德里格参数的刚性飞行器的运动学和动力学模型,过程如下:

1.1刚性飞行器系统的运动学方程为:T

其中σ=[σ1,σ2,σ3] 为修正罗德里格参数,其描述了飞行器的姿态特征; 是σ的导数,T 3 3×3 ×

σ是σ的转置;G表示方向余弦矩阵;ω∈R是刚性飞行器的角速度;I3是R 单位矩阵;σ的形式为:

G形式为 其有性质 ||G||是G的二范数;

1.2刚性飞行器系统的动力学方程为:

3×3

其中J∈R 是刚性飞行器的转动惯量矩阵; 是ω的导数,表示刚性飞行器的角加

3 3 ×

速度;u∈R和d∈R分别为控制力矩和外部扰动;ω 形式为:ω1,ω2,ω3表示三个正常数;

1.3对 求导并代入式(3),得‑1 ‑1

其中E表示新的状态量,L=G , 是L的导数;J 是J的逆矩阵;

×

Λ 的形式为:

‑1

d′=GJ d且满足||d′||≤dm,其中dm是一个正常数;

步骤2,针对带有外部干扰和无角速度测量的刚性飞行器系统,设计控制器,过程如下:T

2.1设计龙伯格状态观测器,令x1=[x11,x12,x13]=σ, x1表示观测器第一变量;x2表示观测器第二变量;飞行器的输出为y=σ,式(1)和(3)改写为:E(x)=E表示新的状态量; 是将E(x)中的变量替换x为 时的值;

令 然后将式(9)改成状态空间形式其中

k1,k2是两个正常数;根据李雅普诺夫定理,只要矩阵A是赫尔维茨矩阵,则对于任意对称矩阵Q,一定存在一个正定矩阵P使得下式成立:T

AP+PA=‑2Q                        (12)设计的龙伯格观测器形式如下:其中 分别为x1和x2的估计值,是 的导数; 是将E(x)中的变量替换x为 时的值;H是观测器的增益矩阵,形式为:其中h1,h2,δ都是正常数; H1表示是增益子矩阵1,H2表示是增益子矩阵2;

令 定义 为观测器观测误差,用式(10)第一个方程减去式(13)得到

其中 为观测器观测误差, 是xe的导数, 表示估计误T

差,满足 是 的二范数,M=[m1,m2,m3] ,M表示一个正向量,mi是正常数,i=1,2,3,||M||是M的二范数,||xe||是xe的二范数;

2.2设计控制器,首先定义虚拟变量:其中z1表示虚拟变量1,z2表示虚拟变量2,σd是期望姿态;α是虚拟控制律,其形式为2

其中 Φ1表示控制器参数1,kb1是正常数,满足kb1≥||z1(0)|| ,而||z1(0)||是z1初始值的二范数, 是z1的转置;c1是正常数; 是σd的导数;

控制器设计为:

其中c2是正常数; Φ2表示控制器参数2,kb2是正常数,满足kb2≥||z22

(0)||,而||z2(0)||是z2初始值的二范数, 是z2的转置;是α的导数;

步骤3,刚性飞行器姿态系统稳定性证明,其过程如下:

3.1证明刚性飞行器系统的姿态观测误差和跟踪误差一致最终有界,设计改进型障碍李雅普诺夫函数为如下形式:其中ln是自然对数;e自然常数;P表示一个正定矩阵;

对式(19 )求导并将式(12)、(14)、(17)和(18)代入得:其中η是正常数;||H2||是H2的二范数;||P||是P的二范数;

将式(20)化简得:

其中 C表示一个正常量,λmax(P)是矩阵P的最大特征值; μ表示一个正常量;

因此,根据李雅普诺夫定理,刚性飞行器系统姿态观测误差和跟踪误差能够实现一致最终有界;

3.2证明刚性飞行器状态量受到约束:令 μ0表示一个正常量,解式(21 )得如下不等式:‑Ct

0≤V≤μ0+(V(0)‑μ0)e                (22)其中V(0)是V的输出值;

结合式(19)和(22),得通过解不等式(23),得z1最终收敛到如下邻域:通过相同的推导,得z2最终收敛到如下邻域:从式(24)和(25)看出,z1和z2分别受到kb1和kb2的约束,再结合系统描述,得刚性飞行器所有状态量都受到约束。