1.多机械臂系统的自适应有限时间命令滤波反步控制方法,其特征在于,包括如下步骤:
设定多机械臂系统具有N个跟随机械臂和M个领导机械臂,跟随机械臂集υF={1,...,N},领导机械臂集υL={N+1,...,N+M};
N个跟随机械臂和M个领导机械臂之间的通信拓扑结构关系由有向图 表示;
其中,节点集υ={1,2,...,N+M},边集定义邻接矩阵A=[amn]∈R(N+M)×(N+M);
其中,amn表示边的权重,R(N+M)×(N+M)表示矩阵维数为(N+M)×(N+M)维;
若存在有向边(m,n)∈ε,则节点n称为节点m的父节点,节点m称为节点n的子节点;
节点m的邻居节点集合为Nm={n|(n,m)∈ε},若(n,m)∈ε,amn>0, amn=0;
邻接矩阵A对角线元素均为0;
定义有向图 的拉普拉斯矩阵为L=[lmn]∈R(N×M)(N×M),lmn=-amn,有向图 的s个节点间的有向路径是具有边的序列(k1,k2),(k2,k3),...,(ks-1,ks);
假设第i个跟随机械臂系统的模型为:式中,qi∈Rn为跟随机械臂关节位置向量;Mi(qi)∈Rn×n为对称惯性矩阵;
为向心力矩和科里奥利力矩矩阵;Gi(qi)∈Rn为重力项;τi∈Rn为驱动力矩;
Rn表示向量维数为n维,Rn×n表示矩阵维数为n×n维;
定义领导机械臂关节位置向量为qj∈Rn,j∈vL;
下面构造多机械臂系统的自适应有限时间命令滤波反步控制方法,使跟随机械臂关节位置向量qi能够在有限时间内收敛到领导机械臂关节位置向量qj形成的凸包;
在反步控制方法的每一步中都将采用下面的滑模微分器作为命令滤波器:其中,ri,1,z表示滑模微分器参数,ri,2,z表示滑模微分器参数;αi,1,z表示虚拟控制信号αi,1的第z个分量,z=1,2,...,n;ωi,1,z表示滑模微分器的状态,ωi,2,z表示滑模微分器的状态;sign表示符号函数;ιi,2=[ωi,1,1,...,ωi,1,n]T作为第i个跟随机械臂所使用滑模微分器的输出;虚拟控制信号αi,1作为第i个跟随机械臂所使用滑模微分器的输入;
在包容控制设计中,定义以下仅依赖于相邻信息的局部跟踪误差:其中,ei,1表示局部跟踪误差向量;ei,2表示关节速度向量与滑模微分器输出向量的误差;
qc表示跟随机械臂集合中与qi有通信连接的跟随机械臂的关节位置向量;qw表示领导机械臂集合中与qi有通信连接的领导机械臂的关节位置向量;
定义 Ni表示第i个跟随机械臂邻居节点集合,i∈υF;
定义
其中 分别表示每个跟随机械臂局部跟踪误差向量的转置, 分别表示每个跟随机械臂关节位置向量的转置, 分别表示每个领导机械臂关节位置向量的转置;
其中,L1是对称正定的,L2表示拉普拉斯矩阵的对应分量;
定义
其中, 分别表示每个跟随机械臂对应的集合跟踪向量的转置;
如果||EF||→0,即QF→Qd确保有限时间内满足,则qi∈υF有限时间到达Co{qj,j∈υL},即跟随机械臂关节位置向量qi在有限时间到达领导机械臂关节位置向量qj形成的凸包内;
其中,Co表示领导机械臂关节位置向量qj形成的凸包;
由公式(3)构造虚拟控制信号αi,1和驱动力矩τi为:其中,κi,1>0,κi,2>0,φi,1>0,φi,2>0均为常数增益; 为奇数;
表示动态回归矩阵,表示自适应更新律;
在公式(4)中,
其中,ηc,1表示跟随机械臂集合中与qi有通信连接的第c个跟随机械臂的误差补偿向量;
lic为拉普拉斯矩阵的对应分量;
选取误差补偿信号:
其中,ηi,1(0)=0,ψi,1>0为常数增益;
自适应更新律 为:
其中,ρi>0,Γi是正定对称矩阵;
选择虚拟控制信号αi,1、驱动力矩τi和自适应更新律 使跟随机械臂关节位置向量在有限时间内以期望的精度收敛到领导机械臂关节位置向量形成的凸包内;
选取Lyapunov函数:
其中, In表示单位矩阵;
则有:
其中, 表示集合跟踪向量的导数,vi,1表示局部跟踪误差向量与误差补偿信号的差;
将公式(9)代入αi,1和 得:其中,vi,2=ei,2表示关节速度向量与滑模微分器输出向量的差;
选取Lyapunov函数:
对U2求导:
r1
第i个跟随机械臂系统的不确定动态由参数向量θi∈R 线性化表示:其中:
是动态回归矩阵, 是可微的向量,是ξi的导数,r1为正常数;
是斜对称矩阵,即对任意的q, 和x∈Rn有:根据以上内容,进一步得到:
定义 将τi代入公式(13)能够得到:其中,θi表示不确定动态参数向量,表示θi的估计;
vi,1,z表示参数vi,1的第z个分量,vi,2,z表示参数vi,2的第z个分量,z=1,2,...,n;
通过不等式放缩得到:
其中,ηi,1,z表示ηi,1的第z个分量;
将公式(15)和公式(16)代入公式(14)得:定义 能够得到:
其中,λmin表示矩阵 的最小特征值;
选取函数 将公式(6)代入 的导数:若滑模微分器的输入不受噪声影响,则|(ωi,1,z-αi,1,z)|≤Πi,1,z,1,z=1,...,n;
其中, Πi,1,z,1>0表示未知有界常数;
选取Lyapunov函数 对U3求导:构造全局的Lyapunov函数 对U求导并将公式(7)代入能够得到:根据 的定义能够得知, 为给定常数,于是:其中,ρi>0表示给定常数,r1为正常数,θip表示θi的第p个分量,如果 能够得到
如果 能够得到
故:
进一步得到:
其中:
其中,λmax表示矩阵 的最大特征值,k2>0表示与惯性矩阵相关的给定常数;
故公式(25)改写为:
其中,0<π<1;
如果 公式 (26) 为 能够得知在有限时间内,
如果 公式(27)为 能够得知在有限时间内,
其中,U(0)表示U在0时刻的状态; 表示U(0)的 次幂;
根据以上分析能够得到:
同时根据U的定义能够得知, 也有限时间 内实现;
由于 因此:
为了使跟随机械臂关节位置向量在有限时间内以期望的精度收敛到领导机械臂关节位置向量形成的凸包内,且闭环系统所有信号在有限时间内有界,控制增益需要满足下列不等式:通过参数κi,1,κi,2,φi,1,ψi,1调整包容控制的误差收敛区域,保证收敛到具有较小半径的域内;
如果αi,1不受噪声的影响,则Πi,1,z,1=0,z=1,...,n;
如果系统动态已知,θi是已知项,利用 在有限时间内能够得到EF=0,且所有信号在闭环系统中都是稳定的;若φi,1=0,φi,2=0,ψi,1=0,则EF和闭环系统都是渐近收敛的;
当选择υL={N+1},在有限时间内自适应有限时间命令滤波反步控制方法使跟随机械臂关节位置向量与领导机械臂关节位置向量的一致性跟踪误差收敛到原点的任意可调节的邻域内,且在有限的时间内闭环系统所有信号有界。