一种参数约束下的抗饱和时变队形协同控制方法

技术特征：
1.一种参数约束下的抗饱和时变队形协同控制方法，其特征在于，步骤如下：步骤1：建立无人艇编队运动学动力学模型；步骤2：对控制系统进行模型转换并确定控制目标；步骤3：设计时变队形的抗饱和控制器；步骤4：验证无人艇编队系统的有限时间稳定性和鲁棒性。2.根据权利要求1所述的一种参数约束下的抗饱和时变队形协同控制方法，其特征在于，在步骤1中建立无人艇编队运动学和动力学模型具体包括：首先每艘单艇的运动学模型如下所示：其中η
i
＝[x
i
,y
i
,ψ
i
]
t
表示无人艇在地球坐标系下的位置信息和偏航角；θ
i
＝[p
i
,v
i
,r
i
]
t
表示无人艇相对于本体坐标系下的线速度和角速度；j
i
(ψ
i
)是坐标转换矩阵，定义如下：定义每艘单艇的动力学模型如下所示：其中代表惯性矩阵；表示科里奥利力和向心力的集合；表示阻尼矩阵；表示阻尼矩阵；和是可知的名义参数项；δm
i
，δc
i
(θ
i
)和δd
i
(θ
i
)是未知的参数项；代表外界干扰；e
i
＝diag{e1,e2,e3}代表执行器效率矩阵；w
i
＝[w
i1
,w
i2
,w
i3
]
t
表示命令控制信号；sat(w
i
)＝[sat(w
i1
),sat(w
i2
),sat(w
i3
)]
t
代表控制实际控制信号，sat(
·
)定义如下：其中代表每艘无人艇执行器信号的可接受的最大值。3.根据权利要求1所述的一种参数约束下的抗饱和时变队形协同控制方法，其特征在于，在步骤2中对控制系统进行转换并确定控制目标具体包括：将系统模型改写为欧拉-拉格朗日形式如下：其中：是不确定项的集合，表示饱和约束下转换后的控制输入，和的定义如下：的定义如下：的定义如下：定义时变参数如下：
η
i
λ
i
＝η
d
,其中作为时变参数可以实现无人艇编队进行队形转换；定义辅助变量为得到轨迹跟踪误差并确定控制目标如下：4.根据权利要求1所述的一种参数约束下的抗饱和时变队形协同控制方法，其特征在于，在步骤3中设计有限时间抗饱和控制器如下：选取积分滑模为：其中k
i
和α
i
,i＝1,2是正参数并且α1∈(0,1)，α2＝(1 α1)-1
2α1；通过假设无人艇编队中单艇速度θ
i
满足有界条件其中为已知参数；并且外部干扰w
i
满足其中为未知参数；同时期望轨迹满足和时变参数满足设计有限时间抗饱和控制器如下：设计有限时间抗饱和控制器如下：设计有限时间抗饱和控制器如下：设计有限时间抗饱和控制器如下：其中是为使系统稳定性设计的控制信号；和分别是为了克服不确定项和执行器容错误差而设计的辅助控制信号，其中k
i
,i＝1,2,...,5为正控制参数，满足不等关系使得制器输出的控制信号受到参数约束，即实现自身抗饱和；设计自适应律如下：设计自适应律如下：其中ρ和l是正参数；表示为其中e
i,min
表示无人艇编队中第i艘无人艇的执行器有效矩阵e
i
的最小特征值。5.根据权利要求1所述的一种参数约束下的抗饱和时变队形协同控制方法，其特征在于，在步骤4中验证了无人艇编队系统的稳定性和鲁棒性：定义：对于函数f:在原点附近的开区间u0满足连续且满足
则称f(ξ)为齐次函数并且称系统为齐次系统；定理：考虑如下系统：其中f(ξ)为连续齐次矢量并且定义为当ξ＝0为系统的渐近稳定平衡点且满足则可以得出上述系统可以在有限时间内全局收敛至ξ＝0；通过选取通过选取和设计李雅普诺夫函数如下：最终证明系统是全局有限时间收敛的；通过所设计的滑模面可以得出在经过有限时间后满足下式：通过选取和得到如下系统：得到如下系统：其中其中是的第三个元素；设计如下李雅普诺夫函数：最终可以得到跟踪误差全局渐近稳定；通过设计和得到如下系统：得到如下系统：
设计如下李雅普诺夫函数：最后可以证明跟踪误差有限时间内全局收敛到零点。

技术总结
本发明提供一种参数约束下的抗饱和时变队形协同控制方法，包括：建立无人艇编队运动学动力学模型；对控制系统进行模型转换并确定控制目标；设计时变队形的抗饱和控制器；验证无人艇编队系统的有限时间稳定性和鲁棒性。通过设计时变编队控制器使得无人艇编队可随着时间改变队形以适应不同工况，并且通过设计控制器满足自身参数约束，实现了抗饱和的控制能力，相比于引入辅助系统等传统方法，简化了控制架构。在解决模型参数不确定的问题上，所设计的控制器具有优良的控制性能，可以保证跟踪误差最终收敛至零点，这是传统编队方法无法实现的。现的。现的。


技术研发人员：王巍凯 黄兵 张磊 苏玉民 朱骋 周彬
受保护的技术使用者：哈尔滨工程大学
技术研发日：2022.02.24
技术公布日：2022/6/7