一种基于电气控制的工业机器人的控制方法及系统

摘要: 本发明涉及工业机器人控制,更具体地说,它涉及一种基于电气控制的工业机器人的控制方法及系统。背景技术:1、工业机器人通常由机器人控制器、伺服驱动器、电驱关节、减速...
一种基于电气控制的工业机器人的控制方法及系统

本发明涉及工业机器人控制,更具体地说,它涉及一种基于电气控制的工业机器人的控制方法及系统。

背景技术:

1、工业机器人通常由机器人控制器、伺服驱动器、电驱关节、减速器和编码器构成,各关节按照任务轨迹完成装配、搬运、焊接或打磨等作业。机器人连续执行高频往复动作时,伺服电机输出转矩经减速器传递,啮合摩擦和传动损耗持续产生热量;作业节拍、负载及停机时间变化,又会改变发热与散热过程。减速器内部温度变化会引起尺寸、啮合间隙和摩擦状态改变,使关节等效零位随运行时间发生变化,同一目标角在冷机、热机及停机再启动阶段可能对应不同的末端位置。

2、现有控制方式多依据电机侧编码器执行位置闭环,并以固定几何标定关系计算末端位姿。该方式能够修正装配形成的静态误差,但对运行过程中逐渐变化的传动热状态适应性有限。采用壳体温度传感器进行补偿时,测得温度与减速器内部摩擦热状态之间存在传热滞后,且附加传感器会增加布线、安装和维护工作;采用总电机电流估计发热时,负载重力、加减速和摩擦所对应的电流相互叠加,换载或轨迹改变后容易造成估计偏差,导致工业机器人长期运行中的末端定位时变漂移难以得到适当补偿。

技术实现思路

1、本发明提供一种基于电气控制的工业机器人的控制方法及系统,解决相关技术中补偿关节减速器热状态变化引起的工业机器人末端定位时变漂移的技术问题。

2、第一方面,本发明提供了一种基于电气控制的工业机器人的控制方法,利用机器人控制器对具有多个电驱关节的工业机器人进行任务轨迹控制,包括:

3、在各关节的速度符号改变时刻前后采集电机电流向量、关节角向量和关节速度向量,并依据关节角分量、速度分量和加速度方向形成对称换向样本;

4、计算所述对称换向样本的电机电流差,结合力矩常数矩阵获得摩擦力矩向量,再利用所述摩擦力矩向量和所述关节速度向量获得摩擦热流向量;

5、利用相邻换向更新之间的更新间隔、热时间常数、所述摩擦热流向量和上一热积累向量递推当前热积累向量;

6、基于漂移映射矩阵和所述当前热积累向量获得热漂移角向量,并从目标角向量中减去所述热漂移角向量,获得修正角向量;

7、向各关节伺服位置环写入所述修正角向量,并以所述关节角向量作为位置反馈控制所述工业机器人运动。

8、本发明的有益效果在于:通过在正常任务轨迹的换向段选取姿态近似一致、速度绝对值近似一致且加速度方向相同的成对数据,可在电机电流差中减弱重力负载和惯性分量的影响,并据此形成与减速器摩擦损耗相关的摩擦热流向量;利用实际更新间隔和热时间常数递推当前热积累向量,可表征换向频率、节拍变化及短暂停机造成的热状态变化;再通过经多组稳定热状态标定的漂移映射矩阵得到热漂移角向量并修正目标角向量,能够在不增设减速器温度传感器的条件下补偿关节等效零位漂移,使冷机、连续运行和停机再启动阶段的末端定位表现保持较好一致性。

9、第二方面,本发明提供了一种基于电气控制的工业机器人的控制系统,包括:

10、换向样本构建模块,用于在各关节的速度符号改变时刻前后采集电机电流向量、关节角向量和关节速度向量,并依据关节角分量、速度分量和加速度方向形成对称换向样本;

11、摩擦热流计算模块,用于计算所述对称换向样本的电机电流差,结合力矩常数矩阵获得摩擦力矩向量,再利用所述摩擦力矩向量和所述关节速度向量获得摩擦热流向量;

12、热积累向量递推模块,用于利用相邻换向更新之间的更新间隔、热时间常数、所述摩擦热流向量和上一热积累向量递推当前热积累向量;

13、修正角向量生成模块,用于基于漂移映射矩阵和所述当前热积累向量获得热漂移角向量,并从目标角向量中减去所述热漂移角向量,获得修正角向量;

14、机器人运动控制模块,用于向各关节伺服位置环写入所述修正角向量,并以所述关节角向量作为位置反馈控制所述工业机器人运动。

15、第三方面,本发明提供了一种计算机可读存储介质,所述计算机可读存储介质包括计算机程序,所述计算机程序运行时控制所述计算机可读存储介质所在服务器实现第一方面所述方法的步骤。

1.一种基于电气控制的工业机器人的控制方法,利用机器人控制器对具有多个电驱关节的工业机器人进行任务轨迹控制,其特征在于,所述方法包括:

2.根据权利要求1所述的一种基于电气控制的工业机器人的控制方法,其特征在于,所述对称换向样本的形成,包括:针对每个关节的速度符号改变时刻,在轨迹插补周期中选取位于所述速度符号改变时刻前后且时间距离相等的两个采样点;分别提取两个采样点中对应关节的电流分量、角度分量和速度分量,并按关节顺序组装为电机电流向量、关节角向量和关节速度向量;以编码器分辨率核验两个采样点的关节角分量一致,并以轨迹插补数据核验两个采样点的速度分量绝对值一致且加速度方向相同。

3.根据权利要求1所述的一种基于电气控制的工业机器人的控制方法,其特征在于,所述摩擦力矩向量的获得,包括:以各伺服电机的力矩常数构成力矩常数矩阵;对对称换向样本中换向前后的电机电流向量求差,按向量分量取绝对值,乘以所述力矩常数矩阵并取1/2,获得摩擦力矩向量。

4.根据权利要求1所述的一种基于电气控制的工业机器人的控制方法,其特征在于,所述摩擦热流向量的获得,包括:计算换向前后关节速度向量绝对值的关节速度平均向量;将摩擦力矩向量与所述关节速度平均向量按分量相乘,获得摩擦热流向量。

5.根据权利要求1所述的一种基于电气控制的工业机器人的控制方法,其特征在于,所述当前热积累向量的递推,包括:由控制器时钟获取更新间隔;按照更新间隔相对于热时间常数的负指数关系计算热记忆系数;以所述热记忆系数对上一热积累向量进行加权,以由1减去所述热记忆系数所得数值对摩擦热流向量进行加权,求取两个加权结果之和作为当前热积累向量;在工业机器人冷机初始化时将所述上一热积累向量设为零向量。

6.根据权利要求1所述的一种基于电气控制的工业机器人的控制方法,其特征在于,所述热漂移角向量的获得,包括:将漂移映射矩阵与当前热积累向量相乘,获得热漂移角向量;所述漂移映射矩阵通过多组稳定热状态下的热积累向量和关节等效零位漂移,采用带满列秩约束的最小二乘辨识确定,并存入机器人控制器。

7.根据权利要求1所述的一种基于电气控制的工业机器人的控制方法,其特征在于,所述修正角向量的获得,包括:从目标角向量中减去热漂移角向量,获得修正角向量。

8.根据权利要求1所述的一种基于电气控制的工业机器人的控制方法,其特征在于,所述工业机器人运动的控制,包括:将修正角向量写入各关节伺服位置环;从编码器采集关节角向量作为位置反馈;各关节伺服位置环依据所述位置反馈闭环跟踪所述修正角向量,控制工业机器人运动。

9.一种基于电气控制的工业机器人的控制系统,其特征在于,执行如权利要求1到8任一项所述方法的步骤,包括:

10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质包括计算机程序,所述计算机程序运行时控制所述计算机可读存储介质所在服务器实现权利要求1到8任一项所述方法的步骤。