1.一种异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,包括以下步骤:
S1、建立六自由度四旋翼无人机的运动学和动力学模型以及三自由度无人艇的运动学和动力学模型;
S2、根据六自由度四旋翼无人机与三自由度无人艇的运动学和动力学模型,确定空海异构集群系统的编队跟踪误差和速度跟踪误差;
S3、构建预设性能函数,并根据空海异构集群系统的编队跟踪误差和速度跟踪误差生成误差转换函数;
S4、根据误差转换函数,确定固定时间鲁棒虚拟控制律和分布式固定时间鲁棒控制器;
S5、建立动态事件触发机制,确定动态时间触发机制下的分布式固定时间鲁棒控制器;
S6、利用动态事件触发机制下的分布式固定时间鲁棒控制器完成轨迹跟踪控制。
2.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S1中,六自由度四旋翼无人机的运动学和动力学模型的表达式为:;
式中,表示无人机滚转角的加速度,表示无人机俯仰角的加速度,表示无人机偏航角的加速度,表示无人机的前进方向的加速度,表示无人机横向方向的加速度,表示无人机的垂直方向的加速度,表示无人机俯仰角的速度,表示无人机偏航角的速度,表示无人机滚转角的速度,表示前进方向的速度,表示横向方向的速度,表示垂直方向的速度,Jxk表示第一转动惯量,Jyk表示第二转动惯量,Jzk表示第三转动惯量,Jrk示转子的转动惯量,表示总的剩余转子角度,dφk表示第一空气动力学阻尼系数,dθk表示第二空气动力学阻尼系数,dψk表示第三空气动力学阻尼系数,dyk表示第四空气动力学阻尼系数,dzk表示第五空气动力学阻尼系数,uφk表示第一待设计控制器,uθk表示第二待设计控制器,uψk表示第三待设计控制器,u1k表示第四待设计控制器,fφk表示第一时变未知海洋扰动,fθk表示第二时变未知海洋扰动,fkψ表示第三时变未知海洋扰动,fxk表示第四时变未知海洋扰动,fyk表示第五时变未知海洋扰动,fzk表示第六时变未知海洋扰动,ηφk表示滚转角,ηθk表示俯仰角,ηψk表示偏航角,g表示重力加速度,ma表示无人机的质量。
3.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S1中,三自由度无人艇的运动学和动力学模型的表达式为:;
式中,表示无人艇在大地坐标下的速度变量,表示无人艇在机体坐标下的加速度变量,ψsh表示无人艇的偏航角,Jsh表示旋转矩阵,vsh表示第h艘无人艇在机体坐标下的速度变量和角速度变量,ush表示第h艘无人艇待设计的控制输入,fsh表示第h艘无人艇的外部扰动,表示惯性矩阵,表示科里奥利矩阵向心矩阵,表示阻尼矩阵。
4.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S2中,编队跟踪误差包括无人机位置环跟踪误差、无人机姿态环跟踪误差和无人艇跟踪误差;
所述第k个无人机位置环跟踪误差的表达式为:
;
式中,exk,1表示无人机前进方向的跟踪误差,eyk,1表示无人机横向方向的跟踪误差,ez,1表示无人机垂直方向的跟踪误差,N1表示UAV-USV系统中无人机的数量,N2表示UAV-USV系统中无人艇的数量,ak,j表示第k个无人机第j个跟随者之间的通信,bkl表示第k个无人机与虚拟领导者之间的通信,ηxk表示无人机前进方向的位置,ηyk表示无人机横向方向的位置,ηzk表示无人机垂直方向的位置,ηxj表示第j个跟随者前进方向的位置,ηyj表示第j个跟随者横向方向的位置,ηzj表示第j个跟随者垂直方向的位置,Δdxk表示第k个无人机与虚拟领导者之间前进方向的相对位置距离,Δdyk表示第k个无人机与虚拟领导者之间横向方向的相对位置距离,Δdzk表示第k个无人机与虚拟领导者之间垂直方向的相对位置距离,Δdxj表示跟随者与虚拟领导者的第一相对位置,Δdyj表示跟随者与虚拟领导者的第二相对位置,Δdzj表示跟随者与虚拟领导者的第三相对位置,Lxd表示虚拟领导者的第一期望轨迹信息,Lyd表示虚拟领导者的第二期望轨迹信息,Lzd表示虚拟领导者的第三期望轨迹信息,j表示异构集群系统中跟随者编号;
所述第k个无人机姿态环跟踪误差的表达式为:
;
式中,eφk,1表示无人机滚转角的跟踪误差,eθk,1表示无人机俯仰角的跟踪误差,eψk,1表示无人机偏航角的跟踪误差,ηφk表示滚转角,ηθk表示俯仰角,ηψk表示偏航角,ηψj表示第j个跟随者的偏航角,ηφk.d表示无人机滚转角的期望角度,ηθk,d表示无人机俯仰角的期望角度,Δdψk表示无人机与虚拟领导者之间偏航角的相对距离,Δdψj表示跟随者与虚拟领导者的第四相对位置,Lψd表示虚拟领导者的第四期望轨迹信息;
所述无人艇跟踪误差的表达式为:
;
式中,exh,1表示无人艇的前进方向的跟踪误差,eyh,1表示无人艇横向方向的跟踪误差,eψh,1表示无人机偏航角的跟踪误差,ah,j表示第h个无人机与第j个跟随者之间的通信,bhl表示第k个无人艇与虚拟领导者之间的通信,ηxh表示无人艇在大地坐标下的前进方向的位置,ηyh表示无人艇在大地坐标下的横向方向的位置,ηψh表示无人艇在大地坐标下的偏航角的位置,Δdxh表示无人艇与虚拟领导者之间前进方向的相对距离,Δdyh表示无人艇与虚拟领导者之间横向方向的相对距离,Δdψh表示无人艇与虚拟领导者之间偏航角方向的相对距离,ηψj表示第j个跟随者的偏航角位置,Δdψj表示第j个跟随者的偏航角与虚拟领导者之间的相对距离。
5.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S2中,速度跟踪误差的表达式为:;
式中,epk,2表示无人机位置环的速度误差变量,eak,2表示无人机姿态环的速度误差变量,esh,2表示无人艇的速度误差变量,ηpk,2表示无人机的速度,ηak,2表示无人机的角速度,ηsh,2表示无人艇的速度,αpk表示所需要设计的第一虚拟控制律,αak表示所需要设计的第二虚拟控制律,αsh表示第三所需要设计的虚拟控制律。
6.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S3中,预设性能函数βg(t)的表达式为:;
式中,βg,0表示性能函数的第一领域参数,βg,∞表示性能函数的第二领域参数,exp(·)表示指数函数,t表示时间,表示性能函数速度参数;
所述S3中,误差转换函数的表达式为:
;
式中,表示无人机和无人艇的位置误差转换函数,表示无人机和无人艇的速度误差转换函数,eg,1表示无人机和无人艇的位置误差,eg,2表示无人机和无人艇的速度误差,βg表示预设性能函数,g表示无人机位置环和姿态环及无人艇位置,pk表示无人机的位置环,ak表示无人机的姿态环,sh表示无人艇的位置。
7.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S4中,鲁棒虚拟控制律的表达式为:;
式中,αpk表示所设计的无人机位置环的虚拟控制律,αak表示所设计的无人机姿态环的虚拟控制律,αsh表示所设计的无人艇的虚拟控制律,epk,1表示无人机位置环的位置误差,eak,1表示无人机姿态环的位置误差,esh,1表示无人艇的位置误差,Λpk表示无人机位置环的通信参数,Λak表示无人机姿态环的通信参数,Λsh表示无人艇的通信参数,λpk,1表示无人机位置环虚拟控制律的第一固定时间增益参数,λpk,2表示无人机位置环虚拟控制律的第二固定时间增益参数,λak,1表示无人机姿态环虚拟控制律的第一固定时间增益参数,λak,2表示无人机姿态环虚拟控制律的第二固定时间增益参数,λsh,1表示无人艇虚拟控制律的第一固定时间增益参数,λsh,2表示表示无人艇虚拟控制律的第二固定时间增益参数,χpk,1表示无人机位置环的位置误差转换函数的时变系数,χak,1表示无人机姿态环的位置误差转换函数的时变系数,χsh,1表示无人艇的位置误差转换函数的时变系数,Фpk,1表示无人机位置环的位置误差转换函数向量,Фak,1表示无人机姿态环的位置误差转换函数向量,Фsh,1表示无人艇的位置误差转换函数向量,κpk,1表示无人机位置环的位置误差转换函数偏置,κak,1表示无人机姿态环的位置误差转换函数偏置,κsh,1表示无人艇的位置误差转换函数偏置,Ξpk表示无人机位置环速度误差变量,Ξak表示无人机姿态环速度误差变量,Ξsh表示无人艇速度误差变量,∂pk,1表示无人机位置环鲁棒H∞虚拟控制律的参数,∂ak,1表示无人机姿态环鲁棒H∞虚拟控制律的参数,∂sh,1表示无人艇鲁棒H∞虚拟控制律的参数,σ表示第一固定时间指数项参数,表示第二固定时间指数项参数。
8.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S4中,分布式固定时间鲁棒控制器的表达式为:;
式中,upk表示所设计的无人机位置环的分布式固定时间鲁棒H∞控制器,uak表示所设计的无人机姿态环的分布式固定时间鲁棒H∞控制器,ush表示所设计的无人艇的分布式固定时间鲁棒H∞控制器,epk,2表示无人机位置环的速度误差,eak,2表示无人机姿态环的速度误差,esh,2表示无人艇的速度误差,Λpk表示无人机位置环的通信参数,Λak表示无人机姿态环的通信参数,Λsh表示无人艇的通信参数,λpk,3表示无人机位置环固定时间鲁棒H∞控制器的第一固定时间增益参数,λpk,4表示无人机位置环固定时间鲁棒H∞控制器的第二固定时间增益参数,λak,3表示无人机姿态环固定时间鲁棒H∞控制器的第一固定时间增益参数,λak,4表示无人机姿态环固定时间鲁棒H∞控制器的第二固定时间增益参数,λsh,3表示无人艇固定时间鲁棒H∞控制器的第一固定时间增益参数,λsh,4表示无人艇固定时间鲁棒H∞控制器的第二固定时间增益参数,χpk,2表示无人机位置环的速度误差转换函数的时变系数,χak,2表示无人机姿态环的速度误差转换函数的时变系数,χsh,2表示无人艇的速度误差转换函数的时变系数,Фpk,2表示无人机位置环的速度误差转换函数向量,Фak,2表示无人机姿态环的速度误差转换函数向量,Фsh,2表示无人艇的速度误差转换函数向量,κpk,2表示无人机位置环的速度误差转换函数偏置,κak,2表示无人机姿态环的速度误差转换函数偏置,κsh,2表示无人艇的速度误差转换函数偏置,表示无人机位置环虚拟控制律的导数,表示无人机姿态环虚拟控制律的导数,表示无人艇虚拟控制律的导数,A表示无人机的第一模型参数,B表示无人机的第二模型参数,表示无人艇的第一模型参数,表示无人艇的第二模型参数,表示无人艇的第三模型参数,表示无人机位置环的速度变量,表示无人机姿态环的速度变量,表示无人艇在大地坐标系下的速度变量,∂pk,2表示无人机位置环的固定时间鲁棒H∞控制器的第一参数,∂ak,2表示无人机姿态环的固定时间鲁棒H∞控制器的第一参数,∂sh,2表示无人艇的固定时间鲁棒H∞控制器的第一参数,表示无人机位置环的固定时间鲁棒H∞控制器的第二参数,表示无人机姿态环的固定时间鲁棒H∞控制器的第二参数,表示无人机位置环的固定时间鲁棒H∞控制器的第二参数,σ表示第一固定时间指数项参数,表示第二固定时间指数项参数。
9.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S5中,动态事件触发机制的表达式为:;
式中,uEg(t)表示事件触发机制更新的控制器,g表示无人机位置环和姿态环及无人艇位置,t表示时间,表示控制函数,tk表示控制器更新的时刻,tk+1表示事件触发更新的下一时刻,R表示实数集,zg(t)表示事件触发控制器的误差,表示时变函数,og表示事件触发的参数。
10.根据权利要求1所述的异构集群系统分布式固定时间鲁棒编队轨迹跟踪控制方法,其特征在于,所述S5中,动态事件触发机制下的分布式固定时间鲁棒编队控制器的表达式为:;
式中,表示无人机位置环事件触发机制下设计的控制器,表示无人机姿态环事件触发机制下设计的控制器,表示无人艇事件触发机制下设计的控制器,I3表示三维单位向量,表示无人机位置环第一事件触发条件参数,表示无人机姿态环第一事件触发条件参数,表示无人艇第一事件触发条件参数,表示无人机位置环第二事件触发条件参数,表示无人机姿态环第二事件触发条件参数,表示无人艇第二事件触发条件参数,epk,2表示无人机位置环的速度跟踪误差,eak,2表示无人机姿态环的速度跟踪误差,esh,2表示无人艇的速度跟踪误差,χpk,2表示无人机位置环的速度误差转换函数的时变参数,χak,2表示无人机姿态环的速度误差转换函数的时变参数,χsh,2表示无人艇的速度误差转换函数的时变参数,upk表示所设计的无人机位置环的分布式固定时间鲁棒H∞控制器,uak表示所设计的无人机姿态环的分布式固定时间鲁棒H∞控制器,ush表示所设计的无人艇的分布式固定时间鲁棒H∞控制器,qpk表示无人机位置环的事件触发的参数,qak表示无人机姿态环的事件触发的参数,qsh表示无人艇的事件触发的参数,Jsh表示旋转矩阵,Msh表示无人艇的模型参数,A表示无人机的第一模型参数,B表示无人机的第二模型参数。