1.一种多机器人协同搬运力位混合控制方法,其特征在于,所述方法包括:S1、建立机器人的搬运动力学模型,根据机器人的搬运动力学模型建立多个机器人组成的机器人系统的协同搬运动力学模型;
S2、设置机器人位置误差,引入误差转换函数对所述机器人位置误差进行转换,得到机器人转换后位置误差,根据所述机器人转换后位置误差和所述协同搬运动力学模型得到误差传递动力学模型;
S3、重写所述误差传递动力学模型,得到重写后的误差传递动力学模型,设置滑模函数和扰动估计误差,根据重写后的误差传递动力学模型、滑模函数和扰动估计误差设计规定性能控制器,根据规定性能控制器计算出机器人系统的输入力矩;
S4、预设阻抗模型、弹簧模型和环境刚度估计,根据阻抗模型、弹簧模型和环境刚度估计设计阻抗控制方法,计算出机器人系统末端执行器的接触力估计和位置;
S5、根据所述协同搬运动力学模型、误差传递动力学模型和规定性能控制器搭建数学仿真模型,将计算出的机器人系统的输入力矩、机器人系统末端执行器的接触力估计以及位置输入至仿真模型中,验证机器人系统的协同搬运控制方法的有效性。
2.如权利要求1所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S1中的协同搬运动力学模型具体为:其中,
式中, 为机器人系统的对
称正定惯性矩阵, 为机器人系统的离心项和克利奥利项矩阵, 为机器人系统在建模过程产生的总摩擦力,为从机器人系统的关节矢量至工作空间的速度雅可比矩阵,为重力加速度矩阵,为机器人系统的关节矢量,和 分别为机器人系统的关节矢量 的一阶导数和二阶导数,为机器人系统的自由度, ,为第 个机器人的自由度,为机器人系统末端执行器的实际接触力,为机器人系统的输入力矩。
3.如权利要求2所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S2具体包括:S21、设置机器人的规定性能和性能函数,根据所述规定性能和性能函数确定机器人的位置误差;
S22、设置误差转换函数,使用所述误差转换函数对所述机器人的位置误差进行转换,得到机器人转换后位置误差;
S23、根据所述机器人转换后位置误差建立机器人系统转换后位置误差,对所述机器人系统转换后位置误差进行处理,并结合所述协同搬运动力学模型,得到误差传递动力学模型。
4.如权利要求3所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S23中的误差传递动力学模型,具体公式为:其中,
式中,为机器人系统转换后位置误差 的二阶导数, 为机器人系统的对称正定惯性矩阵,为机器人系统的离心项和克利奥利项矩阵,为从机器人系统的关节矢量至工作空间的速度雅可比矩阵,为重力加速度矩阵, 和 表示第i个机器人系统规定性能的上下界,表示第i个机器人的性能函数,为机器人系统的输入力矩,为机器人系统的位置误差 的一阶导数,为第i个机器人的位置误差,为机器人系统的关节矢量 的一阶导数,为第i个机器人的关节矢量, 为机器人系统的期望位置 的二阶导数, 为第i个机器人的希望位置,为机器人系统末端执行器的实际接触力,、、、 为误差传递动力学模型的中间变量。
5.如权利要求4所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S3具体包括:S31、对所述误差传递动力学模型进行重写,得到重写后的误差传递动力学模型,所述重写后的误差传递动力学模型中包含规定性能控制器;
S32、根据步骤S23中所述机器人系统转换后位置误差设置滑模函数;
S33、设置扰动估计误差,根据滑模函数和扰动估计误差设置第一李雅普诺夫函数;
S34、根据所述第一李雅普诺夫函数判定所述误差传递动力学模型的稳定性,并设计所述误差传递动力学模型稳定时对应的规定性能控制器。
6.如权利要求5所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S34中的规定性能控制器,具体可用公式表示为:式中,为机器人系统的输入力矩, 为机器人系统
的对称正定惯性矩阵,为滑模函数, 为规定性能控制器增益, 为扰动估计,也就是实际扰动 的估计值,为机器人系统转换后位置误差的一阶导数,为对角增益矩阵,为机器人系统的位置误差 的一阶导数,为机器人系统转换后位置误差 的一阶导数,、为误差传递动力学模型的中间变量。
7.如权利要求6所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S4具体包括:S41、预设阻抗模型和弹簧模型,根据所述阻抗模型和弹簧模型推导出末端执行器的接触力误差;
S42、根据所述末端执行器的接触力误差和所述阻抗模型得到力跟踪误差传递动力学模型;
S43、设计环境刚度估计,根据所述力跟踪误差传递动力学模型和所述环境刚度估计设计第二和第三李雅普诺夫函数,通过所述第二和第三李雅普诺夫函数推导出环境刚度估计的一阶导数;
S44、根据所述环境刚度估计的一阶导数和所述弹簧模型得出机器人系统末端执行器的接触力估计;
S45、根据所述末端执行器的接触力误差和所述阻抗模型得到机器人系统末端执行器的位置。
8.如权利要求7所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S42中的力跟踪误差传递动力学模型具体为:式中, 、 、 分别为第i个机器人的阻抗模型的
惯性、阻尼和刚度, 为第i个机器人环境刚度 的估计值, 为第i个机器人末端执行器的接触力误差, 和 分别为第i个机器人末端执行器的接触力误差 的一阶导数和二阶导数, 。
9.如权利要求8所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S44中机器人系统末端执行器的接触力估计,具体公式为:式中,为第i个机器人末端执行器的接触力估计, 为第i个机器人环
境刚度 的估计, 为第i个机器人末端执行器的位置, 为目标物体的位置。
10.如权利要求9所述的多机器人协同搬运力位混合控制方法,其特征在于,所述S45中机器人系统末端执行器的位置,具体公式为:式中, 为阻抗模型输出的第i个
机器人末端执行器的位置, 为阻抗模型输出的第i个机器人末端执行器位置的一阶导数, 为阻抗模型输入的第i个机器人末端执行器位置, , 、 分别为第i个阻抗模型的惯性、阻尼和刚度, 和 分别为阻抗模型输入的第i个机器人末端执行器位置的一阶导数和二阶导数, 为第i个机器人末端执行器的位置误差, 为第i个机器人环境刚度的估计。