1.一种多机器人协同搬运大型工件性能约束控制方法,其特征在于,所述方法包括以下步骤:S100、采用单位四元数对物体与各移动机器人末端的位姿进行表示,在任务参考坐标系下描述机器人与待搬运物体的运动学和动力学关系,结合协同搬运大型物体形成的闭链运动学约束,得到多移动机器人协同搬运的耦合动态模型;
S200、利用多移动机器人邻居间的信息交互,设计完全分布式有限时间观测器,对任务参考坐标系的参考轨迹进行一致性估计,得到参考估计值;S200中,完全分布式有限时间观测器被设计为估计任务参考点的理想轨迹、期望速度和期望加速度,设机器人的观测器的输出定义为,,,其具体形式为:其中,为任务参考点的理想轨迹,包括位置和姿态四元数,为任务参考点的期望速度,包括线速度和角速度,为任务参考点的期望加速度,包括线加速度和角加速度,,,为机器人i的观测器对、、的估计值,观测器增益,分数幂指数,为期望位置观测值的一致性误差,为期望线速度观测值的一致性误差,为期望线加速度观测值的一致性误差,为期望姿态四元数观测值的一致性误差,为期望角速度观测值的一致性误差,为期望角加速度观测值的一致性误差,其具体定义为:其中,和分别是机器人i对任务参考点的期望位置和姿态四元数的估计值,和分别是机器人i对任务参考点的期望线速度和角速度的估计值,和分别是机器人i对任务参考点的期望线加速度和角加速度的估计值,是机器人j对姿态四元数的估计值的共轭四元数,是期望姿态的共轭四元数;此外,自适应增益和由自适应律和自适应律更新得到:其中,为机器人i的邻居集合,为二元指示系数,为正定对称矩阵,、分别为第i、j个机器人在方向d上的估计位置,为期望位置参考值,为第i个机器人在方向d上的估计姿态,为第i个机器人在方向d上的估计角速度,为投影算子;
S300、基于S200的参考估计值,设计一致性驱动的指示函数与预设性能误差变换:当一致性指示函数表明邻域观测误差未收敛时,不施加性能约束;当一致性指示函数表明邻域观测误差收敛至设定阈值后,渐进激活预设的性能约束函数,以对轨迹跟踪误差施加暂态与稳态性能边界,并据此生成每个机器人在性能约束下的期望速度和加速度;S300中一致性指示函数定义为:其中,为邻居观测值的一致性误差函数和,常数满足,且是一个充分小的正常数;
S300中,预设性能误差变换通过定义机器人的误差变换函数向量实现,其中,为位置误差变换子向量,为姿态误差变换子向量,误差变换向量的第j个元素的具体定义为:其中,表示机器人的位姿跟踪误差的第j个元素,和分别表示位置跟踪误差和姿态跟踪误差,表示参考位置,表示参考姿态,表示机器人i对姿态四元数的估计值的共轭四元数,函数和分别为一致性驱动的性能约束上边界和下边界,其显式定义为:其中,分别表示性能约束的上边界和下边界的最大稳态跟踪误差,函数定义为:
其中,表示首次成立的时间时刻,为预设的过渡时间常数;
S400、基于S300生成的性能约束下的期望速度和加速度,为每个机器人设计鲁棒分布式性能约束控制器以实现对全局参考轨迹的跟踪,并保证闭环系统信号有界且跟踪误差在性能约束触发后满足预设的暂态与稳态边界。
2.根据权利要求1所述的方法,其特征在于,S100包括:
S110:建立第个移动机器人系统的动力学模型为:
其中,是第i个移动机器人的质量惯性矩阵,为向心力与科氏力矩阵,代表重力向量,为移动机器人的约束矩阵,是移动机器人的输入变换矩阵,为控制输入,为移动机器人末端执行器受到的非完整约束力和完整约束力,为移动机器人的广义关节坐标,其中为移动平台的位姿,为机械臂的关节角位置,分别代表的一阶导数和二阶导数,代表移动机器人的总数,表示转置;
S120:考虑第个移动平台的非完整约束为,得到降阶的关节速度,使得:
其中,是的零空间矩阵,满足,为第个移动平台的非完整约束矩阵,为第个移动平台的广义速度向量;因此,将S110中移动机器人的动力学模型两边同时乘以投影矩阵,其动力学模型重写为:其中,为降阶后的科氏力矩阵,、、、为原惯性矩阵的分块子矩阵,、、、为原科氏力矩阵的分块子矩阵,为降阶后的输入变换矩阵,、为原输入变换矩阵的分块对角子矩阵,为降阶后的系统惯性矩阵,为降阶后的控制输入向量,为降阶后的重力向量,、为原重力向量的分块子向量,为降阶后的机器人末端执行器雅可比矩阵,、为原雅可比矩阵的分块子矩阵,为降阶后的广义状态向量,为移动机器人末端执行器受到的外部力旋量。
3.根据权利要求2所述的方法,其特征在于,S100还包括:
S130:建立物体的动力学模型,其具体为:
其中,是物体的质量惯性矩阵,代表物体的向心力与科氏力矩阵,是物体的重力向量,为多移动机器人作用在物体质量中心上的合力,和分别为物体的位姿和速度旋量;
S140:根据物体的质量中心的速度旋量与参考点速度旋量的关系:代入S130并在等式两边左乘,将S130中物体的动力学模型改写为:其中,为参考坐标系下物体的向心力与科氏力矩阵,表示物体上任务参考点的位姿,为参考坐标系下物体的惯性矩阵,物体受到的合力,物体的重力向量,为参考点与物体质量中心的速度映射矩阵,为的导数;
S150:考虑第个移动机器人对应的负载分配系数矩阵和第个移动机器人的末端作用于物体参考点的间接作用力,而且分解为操作力和内力,即,第个移动机器人的操作力写为:其中,负载分配系数矩阵满足,内力之和满足;
S160:根据运动学关系可得,其中,为机器人末端速度,为物体到机器人末端的运动学雅可比,为机器人自身关节到末端的运动学雅可比,为雅可比矩阵,为的伪逆矩阵;因此,第个移动机器人与物体的耦合动态方程写为:其中,为机器人-物体的耦合向心力与科氏力矩阵,为该机器人按比例所分担的部分物体科氏力,为机器人-物体的耦合重力向量,为该机器人按比例所分担的部分物体重力,为等效输入向量,为机器人-物体的耦合惯性矩阵,为该机器人按比例所分担的部分物体的惯性。
4.根据权利要求3所述的方法,其特征在于,S400中鲁棒分布式性能约束控制器的设计包括:S410:定义增广的位姿跟踪误差为:
其中,是积分增益,是积分时间窗口的半宽,和分别为机器人i和邻居机器人j在时刻的跟踪误差向量,是平滑窗口函数,定义为:对增广的位姿跟踪误差求导,并利用关系式有:
其中,为性能约束的速度变换矩阵,、为与性能约束相关参数,为误差变换的雅可比矩阵,为速度误差;
S420:为了同时实现一致性驱动的性能约束和邻居间的共识,机器人的参考速度设计为:其中,是个正定对称矩阵,为机器人i的观测器对任务参考点的期望速度的估计值,为的逆矩阵,为平滑窗口函数在当前时刻的值,为窗口函数关于时间的导数;
因此,性能约束的速度跟踪误差定义为:
以及,实际参考速度的导数为:
其中,为的导数,为的导数;
S430:在S160公式两边同时乘以性能约束的速度变换矩阵有如下的误差动力学:其中,为性能约束的惯性矩阵,为性能约束的科氏力矩阵,为参考速度下的耦合动力学,为机器人i的控制输入,其中,和分别为任务参考坐标系下机器人i与物体的耦合惯性矩阵,向心力与科氏力矩阵,以及重力向量;值得注意的是,可被线性参数化,即存在动力学回归矩阵和动力学参数向量,使得;因此,设计如下分布式性能约束控制律:其中,为正定的控制增益矩阵,是动力学参数向量的估计值,是对鲁棒项的估计值;对的参数估计误差定义为,对的参数估计误差定义为,的自适应律以及和自适应律,具体表达式如下:其中,自适应增益矩阵是一个正定对角矩阵,自适应增益是一个正常数。
5.一种多机器人协同搬运大型工件性能约束控制系统,用于执行如权利要求1-4中任一项所述的方法,其特征在于,包括:耦合动力学模型建立模块,用于采用单位四元数表示待搬运物体与各移动机器人末端的位姿,在预设的任务参考坐标系下,建立包含由协同搬运大型物体形成的闭链运动学约束的多机器人协同搬运的耦合动力学模型;
完全分布式有限时间观测器设计模块,用于利用多移动机器人邻居间的信息交互,设计完全分布式有限时间观测器,对任务参考坐标系的参考轨迹进行一致性估计,得到参考估计值;
性能约束下的期望状态确定模块,用于基于参考估计值,设计一致性驱动的指示函数与预设性能误差变换;当一致性指示函数表明邻域观测误差未收敛时,不施加性能约束;当一致性指示函数表明邻域观测误差收敛至设定阈值后,渐进激活预设的性能约束函数,以对轨迹跟踪误差施加暂态与稳态性能边界,并据此生成每个机器人在性能约束下的期望速度和加速度;
分布式控制律构建模块,用于基于生成的期望速度和加速度,为每个机器人设计鲁棒分布式性能约束控制器以实现对全局参考轨迹的跟踪,并保证闭环系统信号有界且跟踪误差在性能约束触发后满足预设的暂态与稳态边界。
6.一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至4中任一项所述的方法的步骤。
7.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至4中任一项所述的方法的步骤。