1.基于鱼鳞预测算法和PID的多机械臂协同控制方法,其特征在于包括以下步骤:S1、在多机械臂协同操作系统中,引入鱼鳞预测算法;
S2、在多机械臂协同操作系统中,每个机械臂具有多个自由度,而每个自由度均需要进行控制,以此建立多机械臂协同操作系统的状态空间;
S3、在多机械臂协同操作系统中,引入PID控制;
S4、建立扰动抵消PID控制定理,并将扰动抵消PID控制定理应用在鱼鳞预测算法中,获得多机械臂参数优化控制器;
S5、通过多机械臂参数优化控制器,进行多机械臂协同操作系统的参数整定,从而实现对于多机械臂协同操作系统的协同控制;
所述的S1中,构建鱼鳞预测算法的过程为:S11、鱼鳞预测算法中,鱼鳞个数为N,与多机械臂协同操作系统中机械臂的数量相同,每个鱼鳞对应一个机械臂,每个鱼鳞的维度为D,所有鱼鳞的初始数据集合表示为:,每个鱼鳞的初始数据都是n个数据的融合,即为D=n;
S12、每个鱼鳞关于调控对象的期望范围为,其中p1为期望范围的最低标准;p2为期望范围的最高标准;
S13、定义鱼鳞预测算法的参数差异为,且;为稳态参数,用于调节中的的稳定性,的大小在一个长度为的领域范围内,即;因此,当时,参数异常;
S14、通过鱼鳞差异矩阵来表示每个参数差异的状态:(1);
关于的结构矩阵表示为:
(2);
S15、设定为扰动因子,建立扰动平衡方程:(3);
式中,表示鱼鳞预测算法的抗干扰输出;为鱼鳞预测算法的稳态输入参数;为鱼鳞预测算法的控制输入参数;为鱼鳞预测算法当前的输入;
S16、迭代后的鱼鳞参数表示为:;代表每次迭代的学习率;第k个鱼鳞的参数适应度函数表示为;
(4);
(5);
(6);
(7);
式中,为第k-1个鱼鳞的参数适应度函数;为第k个鱼鳞的分配权重;为第k个鱼鳞对应参数的稳定误差;和表示和对迭代更新的影响函数;为迭代优化后的鱼鳞参数;公式(5)表示隶属于;公式(6)和公式(7)为约束条件;公式(6)表示满足的邻域范围之内;代表鱼鳞参数的迭代范围;代表迭代后所组成的鱼鳞参数向量;
所述的S2中,建立多机械臂协同操作系统的状态空间的过程为:S21、在多机械臂协同操作系统中,每个机械臂具有多个自由度,而每个自由度均需要进行控制,设定机械臂的个数为R1,每个机械臂的自由度为R2,通过集合表示为:(8);
(9);
其中,Rot为机械臂的集合,Rot中的元素代表各个机械臂;Rod为自由度的集合,Rod中的元素代表各个自由度;
S22、鱼鳞个数为N,即N=R1,每个鱼鳞的初始数据都是n个数据的融合,进而D=n=R2,多机械臂协同操作系统的状态空间可以表示成一个大小为的旋转矩阵:(10);
其中,为第x个机械臂在第y个自由度的旋转状态,,;
S23、将机械臂的旋转速度作为多机械臂协同操作系统的调控对象,将作为关于旋转速度的状态空间,那么调控对象的常规期望范围为:(11);
所述的S3中,引入PID控制的方法为:S31、建立高维度PID输入模块,将高维度PID输入模块通过高维度空间矩阵HPID来表示:(12);
式中,表示第x个机械臂中第y个自由度的PID控制输入;
S32、选择绝对误差的时间积分ITAE作为PID控制的性能评估指标,已知ITAE代表误差随时间的积分,而机械臂的旋转速度等同于多机械臂协同操作系统的输出之一,旋转速度的变化反映了多机械臂协同操作系统对误差的响应速度,将期望旋转速度与实际旋转速度之间的差值作为误差函数,设定为,属于的拓展对象,表示为:(13);
(14);
式中,为期望旋转速度;为实际旋转速度;则此时的ITAE定义为:(15);
式中,t为时间;T表示时间周期;
S33、鱼鳞参数的结构矩阵是HPID调节的结果,此时表示为:(16);
S34、在多机械臂协同操作系统中,控制,控制决策随着机械臂的运作机制而不断发生改变,通过在线优化PID控制的参数比例增益Kp、积分增益Ki和微分增益Kd,以最小化ITAE;的运作过程中,每个机械臂关节的控制输出特性表示为:(17);
式中,、和分别表示第x个机械臂中第y个自由度的比例增益、积分增益和微分增益;
其中,每个机械臂关节的控制输出特性指的是PID控制时生成的控制信号,即为,同时也是用于控制机械臂关节的输入信号,即表示PID控制输入;
所述的S4中,建立扰动抵消PID控制定理的过程为:S41、在机械臂关节的控制输出过程中出现干扰信号时,控制输出特性变为:(18);
式中,为扰动信号;Dxy为扰动抵消增益;
S42、扰动抵消PID控制定理表示为,当设计一个反馈控制器增益矩阵使得系统状态矩阵的特征多项式为所期望的特征多项式时,即时,即可实现干扰信号的抵消,从而实现扰动抵消PID控制;其中,为结构矩阵,即;为HPID调节之后的结构矩阵;det()是行列式函数;是复数域上的IQ与s的乘积,IQ是复数域上的单位矩阵,s是复变量;表示多机械臂协同操作系统在频域中的传递函数矩阵;
所述的S4中,在多机械臂参数优化控制器中,扰动抵消PID控制定理通过对多机械臂协同操作系统的扰动进行实时监测和补偿,使多机械臂参数优化控制器能够响应外部干扰和内部变化;
多机械臂参数优化控制器响应外部干扰和内部变化的过程为:多机械臂协同操作系统的系统状态方程表示为:(19);
式中,x(t)为机械臂关节之前的系统输入向量;
对进行线性化处理,给定工作点和,在工作点附近对于和进行线性近似,表示为:(20);
(21);
式中,g是关于和的状态函数;、分别表示在工作点处对和进行线性近似化后的结果;工作点附近即为长度为的邻域范围;
将式(20)和式(21)带入得到线性化状态方程:(22);
当时,,从而实现对干扰信号的抵消;此时,依据鱼鳞预测算法,不断的更新被控制对象的参数,最终实现在线优化PID控制的参数,即为完成对Kp、Ki和Kd的在线优化。
2.根据权利要求1所述的基于鱼鳞预测算法和PID的多机械臂协同控制方法,其特征在于:所述的S5中,多机械臂参数优化控制器的参数整定过程表示为:(23);
式中,wxy表示第x个机械臂中第y个自由度的分配权重;g0表示上一周期的状态函数,表示上一周期的状态函数g0的值;g1为当前周期的状态函数;表示增益矩阵的迭代范围;代表迭代后所组成的PID参数向量。