[发明专利]工业机器人及其连杆变形补偿方法、装置

说明书

本发明实施例提供一种工业机器人及其连杆变形补偿方法、装置，涉及机器人领域。该连杆变形补偿方法包括：获取所述末端执行器的设定坐标值；获取所述连杆的受力情况，并根据所述连杆的受力情况计算所述连杆的变形量；根据所述末端执行器的设定坐标值以及所述连杆的变形量控制所述关节电机，以使所述末端执行器的实际坐标值等于所述设定坐标值。本发明实施例能够提升机器人的绝对定位精度，从而实现精度更好的自动化装配。

技术领域

本发明涉及机器人领域，具体而言，涉及一种工业机器人及其连杆变形补偿方法、装置。

背景技术

工业机器人一般具有良好的单向重复定位精度，但由于负载和自身重力的影响，机器人各个关节及连杆会发生变形，导致其绝对定位精度差，尤其不能满足精度要求高的自动化装配作业。

发明内容

本发明的目的在于提供一种工业机器人及其连杆变形补偿方法、装置，其能够提升机器人的绝对定位精度，从而实现精度更好的自动化装配。

本发明的实施例是这样实现的：

第一方面，本发明提供一种连杆变形补偿方法，用于工业机器人，所述工业机器人包括末端执行器、关节电机、以及相互转动连接的多根连杆，其中，所述末端执行器与所述多根连杆中位于末端的所述连杆连接，所述关节电机用于驱动相邻的两个所述连杆中的一者相对另一者转动，以调节所述末端执行器的空间位置，所述连杆变形补偿方法包括：

获取所述末端执行器的设定坐标值；

获取所述连杆的受力情况，并根据所述连杆的受力情况计算所述连杆的变形量；

根据所述末端执行器的设定坐标值以及所述连杆的变形量控制所述关节电机，以使所述末端执行器的实际坐标值等于所述设定坐标值。

本发明实施例提供的连杆变形补偿方法充分考虑到连杆变形对连杆绝对位置的影响。在计算连杆坐标时，不仅引入了因关节电机转动所带来的坐标变化，而且还考虑了连杆因受力而引起的变形，并计算其变形量对连杆的绝对位置的影响。通过该方法，实时补偿由于连杆变形导致的绝对精度误差，提升工业机器人的作业精度；尤其对于重载工业机器人，其受力引起的变形量更大，本发明提供的连杆变形补偿方法也有利于提升重载工业机器人的精度。

在可选的实施方式中，所述根据所述末端执行器的设定坐标值以及所述连杆的变形量控制所述关节电机，以使所述末端执行器的实际坐标值等于所述设定坐标值的步骤包括：

根据坐标计算公式，计算每一所述连杆的坐标值，其中，所述坐标计算公式为：

P_TCP＝A₁*A₂*A₃*...*A_n-1*A_n

式中：P_TCP表示所述末端执行器的设定坐标值，n为正整数，A_n表示第n连杆的坐标值，且，所述第n连杆的坐标值的计算公式为：

A_n＝A_n-1+Θ(θ)+d(F)

式中：A_n表示第n连杆的坐标值，A_n-1表示第n-1连杆的坐标值，其中，所述第n-1连杆靠近所述末端执行器，Θ(θ)表示所述关节电机转动使所述第n连杆的坐标变化的变化量，θ为所述关节电机的转动角度，d(F)表示所述第n连杆的变形量；

根据每一所述连杆的坐标值，控制所述关节电机的转动角度。

在可选的实施方式中，在所述获取所述连杆的受力情况，并根据所述连杆的受力情况计算所述连杆的变形量的步骤中，通过受力变形量计算公式，计算所述连杆的变形量，其中，所述受力变形量计算公式为：

d(F)＝J_d*F