CN106097395B - 一种基于直线位移传感器的工业机器人运动学参数的标定方法 - Google Patents

Abstract

本发明公开一种基于直线位移传感器的工业机器人运动学参数的标定方法，属于机器人技术领域。该方法将传感器固定于机器人工作空间内若干位置，根据示教程序指令让机器人运动到不同的指定位置停止，并通过传感器获取机器人末端TCP与传感器基准位置的距离数据，记录关节角度值；然后进行粗标定，利用机器人TCP获得传感器的基准位置的初始值，根据测量数据和标定方程，获得传感器基准位置的较准确值，只考虑关节角度零位偏差得到标定方程，完成粗标定；接着进行精标定，考虑机器人所有DH参数、末端连杆参数、传感器零位偏差，建立标定方程，多次迭代后完成标定。本发明具有结构简单、容易实现、标定精度高及收敛速度快等特点。

Description

一种基于直线位移传感器的工业机器人运动学参数的标定 方法

技术领域：

本发明属于机器人技术领域，具体涉及一种基于直线位移传感器的工业机器人运动学参数的标定方法。

背景技术：

随着工业机器人在工业生产中应用范围及其任务复杂程度的不断扩大，对工业机器人的位置和姿态精度要求也越来越高。目前工业机器人具有很高的重复定位精度，在0.1mm以内，而绝对定位精度却很低，在1mm以上，甚至达到1cm，这严重限制了工业机器人的应用范围。众多原因导致工业机器人定位精度低，其中最重要的是运动学模型中几何结构的参数偏差。标定技术是补偿这些参数偏差的有效方法，因此成为研究热点。标定就是应用先进的测量手段和基于模型的参数识别方法辨识出机器人模型的准确参数，从而提高机器人绝对定位精度。

三十余年来，机器人标定领域已经取得了一些令人瞩目的成果。测量方法主要有两类方法，其中一类方法需要高精度的测量设备来精确测量机器人末端的位置向量，比如三坐标测量机和激光跟踪仪等。这些设备昂贵，限制了其应用场合。另一类方法是在机器人末端施加一些约束形成运动学闭链，主要是平面约束和球约束。这方法需要复杂精确的手工操作和效率不高。随着高精度直线位移传感器的发展，如拉线传感器，利用拉线传感器进行机器人标定具有便于携带，低成本，操作方便的特点。但是由于直线位移传感器本身特点，如精度相对于激光跟踪仪来说很低，测量数据是一维的(只能测量两点之间的距离)等，限制了其在机器人标定领域的应用，因此开发基于直线位移传感器的机器人运动学参数标定方法成为迫切需求。

发明内容

本发明的目的在于提供一种基于直线位移传感器的工业机器人标定方法，该方法标定精度高，收敛速度快，并且易于编程实现，能够标定工业机器人的所有连杆参数，主要包括关节角度的零位偏差、连杆长度、连杆扭角、连杆偏置，本方法能标定拉线传感器的零位偏差。

直线位移传感器以拉线传感器为首选，拉线传感器具有成本低，精度高，量程大，体积小等优点，十分适合机器人现场标定。由于机器人标定对传感器的要求是精度高，量程大，但拉线传感器量程越大精度越低，为了保证标定精度，选用小量程高精度的拉线传感器。为了提高标定效果，标定点需尽可能遍布机器人全工作空间，这与拉线传感器小量程形成矛盾。为了解决这一矛盾，本发明标定过程中，拉线传感器可固定在若干位置进行测量。每一位置采集机器人工作空间的部分区域，这样可采用小量程拉线传感器；多个位置采集，就可覆盖机器人全工作空间。

本发明所提供的一种基于直线位移传感器的工业机器人标定方法包括以下步骤：

第一步：直线位移传感器固定在若干位置获取测量数据：

(1.1)直线位移传感器固定在某任意位置，对工业机器人进行示教；

(1.2)根据示教程序指令让所述工业机器人运动到指定位置停止，并记录所述工业机器人在不同位置时所述直线位移传感器的数据及所述工业机器人的关节角度值；

(1.3)改变所述直线位移传感器的位置并固定，对所述工业机器人进行示教，重复步骤(1.2)；

(1.4)重复步骤(1.3)若干次，一般情况下直线位移传感器位置数为1到3；

第二步：直线位移传感器固定在每个位置时的粗标定：

(2.1)首先让所述工业机器人末端TCP尽可能靠近所述直线位移传感器，获取TCP位置，并把此位置作为所述直线位移传感器的基准位置初值；

(2.2)根据所述直线位移传感器的基准位置初值、测量数据和所述机器人名义参数，标定所述直线位移传感器的基准位置；

(2.3)根据标定出的所述直线位移传感器基准位置与建立的标定模型对所述工业机器人的关节零位偏差和所述直线位移传感器基准位置偏差进行粗标定；

第三步：综合所述直线位移传感器所有位置粗标定结果的精标定：

(3.1)建立标定模型，对所述工业机器人所有DH参数、末端连杆参数和所述直线位移传感器的零位偏差进行标定；

(3.2)迭代标定，多次重复步骤(3.1)，一般重复步骤(3.1)四次后标定结果变化足够小，标定结束。

本发明提供的机器人标定方法，方法结构简单，容易实现，并且标定精度高，收敛速度快。采用本发明的标定方法和市场上高精度拉线传感器，能对机器人的结构参数进行校准，以提高机器人的绝对定位精度。同时可在中小企业得到广泛运用，补偿机器人结构因长期工作而造成的损耗，为机器人长时间高可靠性工作提供质量保障。涉及用于工业机器人在各个行业的运用，如飞机装配孔、弧焊、点焊、喷漆等。

附图说明：

图1是基于直线位移传感器的工业机器人标定方法流程图；

图2是本发明所涉及的机器人标定系统。

图中：1：机器人控制器1；2：待标定的工业机器人；3：连接杆；4：拉线传感器，5：数据采集卡；6：计算机。

具体实施方式：

下面结合附图和具体实施例进一步说明本发明的技术方案。

如图2所示。直线位移传感器采用拉线传感器，当然也可采用其他传感器，如激光跟踪仪。标定系统由机器人控制器1，待标定的工业机器人2，连接杆3，拉线传感器4，数据采集卡5和计算机6组成。基本过程是：待标定的工业机器人2安装在某一固定位置上，工业机器人的末端法兰安装有与拉线传感器匹配的连接杆3，拉线传感器4尽量固定放置在工业机器人工作空间内，在这一原则下，拉线传感器的位置可以任意，待标定的工业机器人2在机器人控制器1的驱动下运动到空间各个不同的位置，装有标定软件的计算机6通过数据采集卡5获得测量数据。多次改变拉线传感器4的位置并固定，拉线传感器4尽量固定放置在工业机器人工作空间内，在这一原则下，拉线传感器的位置可以任意，进行测量。根据所有测量数据最终标定出机器人运动学参数。

对工业机器人标定前，首先对工业机器人进行示教，示教的目的是使示教点尽量分散在机器人工作范围内，确保工业机器人的结构误差对机器人绝对定位精度影响最大。需要工业机器人按照指令运动规定位置并停止，通过拉线传感器对每个示教点位置进行测量。本发明中拉线传感器固定在多个位置，在每个位置的示教点尽量分散；多个位置的全部示教点尽量分散在机器人整个工作范围内。每个位置的示教点一般在100左右。

该方法的关键就是将拉线传感器当作工业机器人误差传递的一部分，并且粗精标定分开。

首先进行粗标定，目的是获得拉线传感器每个位置的精确坐标。为了公式简洁，粗标定时拉线传感器在每个位置时，不加下标区别，采用的测量数据仅限于该位置时的测量数据。拉线传感器坐标在工业机器人的基座坐标系中定义，记为基准点P₀(x₀,y₀,z₀)。

在具体的标定过程中，需要工业机器人按照示教好的程序运动到示教位置，记工业机器人运动到每个位置的TCP实际坐标为P_ai(x_ai,y_ai,z_ai)，名义坐标为P_ni(x_ni,y_ni,z_ni)，名义坐标是根据机器人前向运动学，采用机器人名义参数(设计参数)计算出的。通过拉线传感器对每个示教点位置进行测量，那么通过拉线传感器测量获得的就是基准点P₀到示教点P_ai的长度l_i，该长度由下式定义：

(x₀-x_ai)²+(y₀-y_ai)²+(z₀-z_ai)²＝l_i ² (1)

本发明提出根据测量数据计算出基准点P₀的预估值。

下面进行粗标定，首先让工业机器人TCP尽可能靠近拉线传感器，获取此时TCP名义坐标，并把此坐标作为拉线传感器的基准位置初值P′₀(x'₀,y'₀,z'₀)，则拉线传感器基准位置偏差ΔP₀：

ΔP₀(Δx,Δy,Δz)＝ΔP₀(x₀-x'₀,y₀-y'₀,z₀-z'₀) (2)

由于工业机器人还未标定，不能得到示教点P_ai，故采用P_ni近似，带入方程(1)，得到：

(x₀-x_ni)²+(y₀-y_ni)²+(z₀-z_ni)²＝l_i ² (3)

任意取两个测量点i,j的方程进行相减，整理得到：

方程(2)带入方程(4)，整理得到：

方程(5)中只有拉线传感器基准位置偏差是未知的，且是位置偏差的线性方程，取拉线传感器在该位置的所有测量数据的组合，则可得到个方程，N是该位置的示教点数。通过最小二乘法计算得到位置偏差ΔP₀，获得拉线传感器基准位置的标定初值P′₀(x'₀+Δx,y'₀+Δy,z'₀+Δz)，为了方便表示，此标定初值还是记为P′₀(x'₀,y'₀,z'₀)。

由于工业机器人的绝对定位精度主要受关节零位偏差影响，此时只标定工业机器人的关节零位偏差。由于方程(3)采用名义位置P_ni，故拉线传感器基准位置标定初值还是存在较大偏差，需和机器人的关节零位偏差参数同时标定。

只考虑关节零位偏差时，机器人TCP实际位置P_ai和名义位置P_ni之间关系为：

x_ai＝x_ni+J_ixθΔθ,y_ai＝y_ni+J_iyθΔθ,z_ai＝z_ni+J_izθΔθ (6)

其中Δθ是关节零位偏差列向量，J_ixθ是机器人x坐标方程对关节角度的雅可比行向量，其他两个雅可比行向量分别对应y和z坐标，三个雅可比行向量均为已知值。

拉线传感器基准位置的实际位置与标定初值的偏差，如方程(2)定义，为了方便表示，还是记为ΔP₀(Δx,Δy,Δz)。

将方程(6)和拉线传感器基准位置偏差，带入方程(1)，忽略偏差的二次项，整理得到：

方程(7)中只有角度零位偏差和基准位置偏差是未知，且是偏差的线性方程，取所有的N个示教点数据，得到N个方程，通过最小二乘法计算得到这些偏差，获得关节角度零位偏差和拉线传感器基准位置的粗标定位置，为了方便表示，此粗标定位置还是记为P′₀(x'₀,y'₀,z'₀)。这样完成了拉线传感器一个位置的粗标定。

对拉线传感器每个位置的测量数据进行粗标定，得到拉线传感器每个位置对应的基准位置的粗标定位置。

下面进行精标定，此时可标定工业机器人所有DH参数，当然也包括工业机器人末端连杆参数，同时拉线传感器一般存在零位偏差，为了提高标定精度，必须对此零位偏差同时进行标定。

为了公式简洁，拉线传感器在每个位置，推导精标定的标定模型时，不加下标区别。最后综合所有位置的模型时，加下标以区别。

考虑拉线传感器零位偏差时，测量数据表示为：

l_ai＝l_i+Δl (8)

l_ai是实际距离，l_i是测量距离，Δl是零位偏差。

方程(1)变为：

(x₀-x_ai)²+(y₀-y_ai)²+(z₀-z_ai)²＝l_ai ²＝(l_i+Δl)² (9)

当工业机器人标定参数为Δρ列向量时，机器人TCP实际位置P_ai和名义位置P_ni之间关系为：

x_ai＝x_ni+J_ixρΔρ,y_ai＝y_ni+J_iyρΔρ,z_ai＝z_ni+J_izρΔρ (10)

其中J_ixρ是工业机器人x坐标方程对标定参数向量Δρ的雅可比行向量，其他两个雅可比行向量分别对应y和z坐标，三个雅可比行向量均为已知值。

拉线传感器基准位置的实际位置与标定初值的偏差，如方程(2)定义，为了方便表示，还是记为ΔP₀(Δx,Δy,Δz)。

将方程(8)、(10)和拉线传感器基准位置偏差，带入方程(9)，忽略偏差的二次项，整理得到：

方程(11)中只有机器人标定参数向量Δρ、传感器基准位置偏差ΔP₀(Δx,Δy,Δz)和零位偏差Δl是未知，且是偏差的线性方程。

如果对每个拉线传感器位置的测量数据，都分别采用方程(11)，通过最小二乘法计算得到工业机器人标定参数。由于拉线传感器每个位置的标定结果不同，如何融合这些结果，是个难题。只是简单的取平均值，效果不佳。

本发明采用整体标定的方法，即利用拉线传感器所有位置的测量数据，建立方程(11)，把所有方程整合成一个大的线性方程组，进行标定。

仔细研究方程(11)，发现只有传感器基准位置偏差ΔP₀(Δx,Δy,Δz)与拉线传感器的位置有关，工业机器人标定参数向量Δρ、拉线传感器零位偏差Δl与拉线传感器位置无关。

令k＝1,...,m为拉线传感器位置编号，m为拉线传感器不同位置数，一般取1到3，每个位置的示教点数为N_k＝N₁,...,N_m，拉线传感器每个位置的实际坐标为粗标定的坐标为位置偏差为

把拉线传感器每个位置的测量数据带入方程(11)，得到：

综合所有示教点，可得个线性方程，通过最小二乘法解此线性方程组，可得到工业机器人标定参数向量Δρ、拉线传感器零位偏差Δl和拉线传感器在每个位置的基准位置偏差利用这些标定偏差对机器人和拉线传感器进行更新。显然上述精标定可迭代进行，来提高标定精度，一般迭代四次后，标定结果改变很小，标定结束。

以上所有的线性方程组的最小二乘法，可以采用普通最小二乘法，但优先采用基于奇异值分解的最小二乘法，以提高解算稳定性和精度。

以上所述，仅为本发明最佳实施方式，任何熟悉本技术领域的技术人员在本发明披露的技术范围内，可显而易见地得到的技术方案的简单变化或等效替换均落入本发明的保护范围内。

Claims (2)

1.一种基于直线位移传感器的工业机器人运动学参数的标定方法，其特征在于该标定方法包括以下步骤：

第一步：直线位移传感器固定在若干位置获取测量数据：

(1.1)直线位移传感器固定在某任意位置，对工业机器人进行示教；

(1.2)根据示教程序指令让所述工业机器人运动到指定位置停止，并记录所述工业机器人在不同位置时所述直线位移传感器的数据及所述工业机器人的关节角度值；

(1.3)改变所述直线位移传感器的位置并固定，对所述工业机器人进行示教，重复步骤(1.2)；

(1.4)重复步骤(1.3)若干次，直线位移传感器位置数为1到3；

第二步：直线位移传感器固定在每个位置时的粗标定：

(2.1)首先让所述工业机器人末端TCP尽可能靠近所述直线位移传感器，获取TCP位置，并把此位置作为所述直线位移传感器的基准位置初值，记为基准点P′₀(x'₀,y'₀,z'₀)；

(2.2)根据所述直线位移传感器的基准位置初值、测量数据和机器人名义参数，标定所述直线位移传感器的基准位置；得到方程：

(x_nj-x_ni)Δx+(y_nj-y_ni)Δy+(z_nj-z_ni)Δz＝l′_ij

l′_ij＝l_ij-[(x_nj-x_ni)x'₀+(y_nj-y_ni)y'₀+(z_nj-z_ni)z'₀]

方程中名义坐标P_ni(x_ni,y_ni,z_ni)是工业机器人运动到每个位置时TCP的位置，是根据机器人前向运动学，采用机器人名义参数计算出的；拉线传感器的基准位置真实值为P₀(x₀,y₀,z₀)，则拉线传感器基准位置偏差ΔP₀：ΔP₀(Δx,Δy,Δz)＝ΔP₀(x₀-x'₀,y₀-y'₀,z₀-z'₀)，通过最小二乘法计算得到位置偏差ΔP₀；

(2.3)根据标定出的所述直线位移传感器基准位置与建立的标定模型对所述工业机器人的关节零位偏差和所述直线位移传感器基准位置偏差进行粗标定；

得到方程：

方程中Δθ是关节零位偏差列向量，J_ixθ是机器人x坐标方程对关节角度的雅可比行向量，其他两个雅可比行向量分别对应y和z坐标，三个雅可比行向量均为已知值，通过最小二乘法计算得到这些偏差，获得关节角度零位偏差和拉线传感器基准位置的粗标定位置；

第三步：综合所述直线位移传感器所有位置粗标定结果的精标定：

(3.1)建立标定模型，对所述工业机器人所有DH参数、末端连杆参数和所述直线位移传感器的零位偏差进行标定；

首先得到拉线传感器在每个位置的标定方程：

a_ix＝x′₀-x_ni,a_iy＝y′₀-y_ni,a_iz＝z′₀-z_ni

方程中l_i是测量距离，Δl是零位偏差，J_ixρ是工业机器人x坐标方程对标定参数向量Δρ的雅可比行向量，其他两个雅可比行向量分别对应y和z坐标，三个雅可比行向量均为已知值，方程中只有机器人标定参数向量Δρ、传感器基准位置偏差ΔP₀(Δx,Δy,Δz)和零位偏差Δl是未知，且是偏差的线性方程；

最后，采用整体标定的方法，即利用拉线传感器每个位置的测量数据，分别建立对应的方程，然后把所有这些方程整合成一个大的线性方程组，进行标定；得到方程

方程中k＝1,...,m为拉线传感器位置编号，m为拉线传感器不同位置数，取1到3，每个位置的示教点数为N_k＝N₁,...,N_m，拉线传感器每个位置的实际坐标为粗标定的坐标为位置偏差为综合所有示教点，可得个线性方程，通过最小二乘法解此线性方程组，可得到工业机器人标定参数向量Δρ、拉线传感器零位偏差Δl和拉线传感器在每个位置的基准位置偏差

(3.2)迭代标定，多次重复步骤(3.1)，重复步骤(3.1)四次后标定结果变化足够小，标定结束。

2.根据权利要求1所述的标定方法，其特征在于所述直线位移传感器采用拉线传感器。