专利名称：：一种工业机器人的标定方法
技术领域：
：本发明涉及一种工业机器人的标定方法，具体的说是一种用以提高工业机器人的定位精度的标定方法。
背景技术：
：机器人的重复定位精度是指操作机器人运动达到某一示教点，机器人连杆位置传感器读取各连杆的关节变量的数据并存储，操作机器人返回该示教点时的位置精度，就是机器人的重复定位精度。现今机器人生产厂家在机器人出厂时都只给出了机器人的重复定位精度，该精度一般在0.05毫米至0.1毫米。工业机器人在运动中的目标位姿一般都是通过笛卡尔坐标系确定的，机器人逆运动学研究的问题是，为了将机器人移动到工作空间中的一个从未示教过的点(计算点)所求出的相应的连杆的关节变量值。机器人通过求出的关节变量值运动到这个计算点的精度就是机器人的定位精度。由于加工、装配、调试等各方面的误差，造成机器人的定位精度相对重复定位精度较低，一般在2毫米至3毫米范围。然而，工业机器人在实际应用中，通常需要适应各种广泛的应用场合和各种不同的工作位置。现有的采用重复定位精度标定的工业机器人在其未示教过的点的定位精度往往不够高，不能适应实际需求。为了提高工业机器人的定位精度，必须对其进行相应的标定。
发明内容本发明目的就是为了克服现有技术的不足而提供一种用以提高工业机器人的定位精度的标定方法。为达到上述目的，本发明采用的技术方案是一种工业机器人的标定方法，包括以下步骤(a)在笛卡尔坐标系下，利用修正的D-H运动学模型建立机器人的运动学模型，得出机器人的末端执行器的坐标系相对于基坐标系的位姿变换矩阵，该位姿变换矩阵与机器人各连杆的杆件结构参数《、",、^及关节变量《相关；(b)所述的机器人的末端执行器上安装有激光跟踪仪，所述的激光跟踪仪具有测头中心，根据步骤(a)的位姿变换矩阵建立所述的测头中心相对于基坐标系在空间的位置坐标矢量p;(c)对测头中心在空间的位置坐标矢量户进行全微分，从而建立测头中心位置误差A/7与结构参数误差AJ,、A",、A",及关节变量误差A《之间的线性关系模型；(d)在不改变激光跟踪仪与机器人的末端执行器的相对姿态的情况下，移动机器人各个关节，即改变机器人的关节变量《，使得激光跟踪仪的测头中心处于多个不同的位姿，将激光跟踪仪所记录的实际位姿坐标^与机器人控制器所计算的名义位姿坐标p"相比较，得到该位姿的位置误差的数值二^-p";(e)将步骤(d)中的各个不同位姿的关节变量《和相对应的位置误差的数值带入步骤(c)的线性关系模型中，利用最小二乘法得到结构参数误差A《、A化、Aa,和关节变量误差A《的补偿值，对步骤(b)中的测头中心在空间的位置坐标矢量p进行修正；(f)移动机器人各个关节使得激光跟踪仪的测头中心处于多个不同的位姿，将激光跟踪仪所记录的实际位姿坐标/^与机器人控制器所计算的名义位姿坐标p"相比较，得到该位姿的位置误差的数值~=;/-;/，将所有位置误差的数值与定位精度所要求的数值进行比较，如果存在任一位置误差的数值不满足定位精度要求，返回步骤((O，如果所有位置误差的数值都满足定位精度要求，则表明已经获得位置误差的满意值，最终获得各关节变量《与机器人的末端执行器的坐标系在机器人坐标系下的准确映射关系，即机器人的真实位姿，完成机器人绝对定位精度的标定。由于上述技术方案运用，本发明与现有技术相比具有下列优点该发明提出一种有效的对工业机器人进行定位精度标定方法，通过反复迭代可以使工业机器人的精度达到满意的效果，改变现有工业机器人只采用重复定位精度标定的现状，使得定位精度标定后的工业机器人能够适应更广泛的应用场合和各种不同的工作位置。图1为连杆坐标系的设定原理图；图2为机器人连杆坐标系的原理图。说明书第3/7页具体实施方式下面对本发明一种工业机器人的标定方法的具体实施方式进行说明，它包括以下步骤(a)在笛卡尔坐标系下，建立机器人的运动学模型，得出机器人的末端执行器的坐标系相对于基坐标系的位姿变换矩阵。选择机器人的运动学模型是标定的关键过程，因为运动学模型是决定机器人各种精度的重要因素。机器人最基本最通用的运动学模型就是Denavit-Hartenberg(简称D-H)模型。在此模型里，相邻关节之间的关系可用4个独立的D-H参数来表达，其中1个是关节变量《，其它3个是杆件结构参数常量《、";、",(该4个参数的定义见后)。Denavit-Hartenberg提出了一种建立相对位姿的矩阵方法。它用一个4X4的齐次变换矩阵描述相邻两关节的空间关系，从而推导出末端执行器坐标系相对于基坐标系的等价齐次坐标变换矩阵，建立操作臂的运动方程。为了得到图2中末端执行器坐标系相对于基坐标系的等价齐次坐标变换矩阵，先要建立各个连杆的坐标系，建立步骤如下1、建立基座坐标系在基座上按右手法则建立坐标系，使Z。轴沿连杆1的运动轴心线方向(参见图2)。2、建立中间关节i的坐标系使Z,轴与关节i的运动轴心线共线，指向任意规定；使I,轴沿关节i的公法线方向，由关节i指向关节i+l，并且当^=0时，使X,;士Z,xZ,+,，其中a,为连杆i的长度；^轴由右手法则确定；原点O,取在Z,与Z,的交点处，当Z,与Z,+,相交时取交点作为原点，当Z,与Z,+,轴平行时原点0,取在使",+1=0处，其中《+1为连杆i+l的偏置(参见图l)。3、建立末端连杆坐标系末端连杆坐标系的建立与基座坐标系的建立相似。4、规定连杆参数a,4，《，《a,—1:从Z,—,到Z,沿义,—,测量的距离，即连杆i-l的长度。从Z,一i到Z,绕Xw旋转的角度，即连杆i-l的扭角。《从I,4到《沿Z,测量的距离，即连杆i相对于连杆i-l的偏置。《从《—,到X,绕Z,旋转的角度，即连杆i相对于连杆i-l的夹角。尽管D-H运动学模型有许多优点，但是4个参数的D-H运动学模型在个别情况下存在不足当两相邻关节运动轴线平行时(参见图2机器人的2、3轴)，关节姿态的微小变化将使D-H参数产生巨大的变化。因此，本发明采用修正的D-H运动学模型——MDH运动学模型，在标准D-H运动学模型的基础上增加了一个辅助变量A(々,的定义为从坐标系/-1到坐标系/，相对坐标系z'的Y轴的扭角)，提出了识别机器人实际几何参数的误差模型。通常无论两相邻关节运动轴线是否平行，A的值都定义为零，这样建立的5参数MDH运动学模型就可以消除4参数的D-H运动学模型中的无解奇异点。因此，在用修正的D-H运动学模型建立了杆件坐标系后，坐标^'-i《-iHi)与坐标{"《"《}之间的变换可以用坐标系的平移、旋转来实现。可以把坐标系仍相对于坐标系^-l)先绕义w轴转aw角，再沿Xw轴移动X,—p再绕Z,轴转0,角，再沿Z,轴移动《，再绕"轴转^角，用变换矩阵表示，则有'—i'r=iWC—pa,—!)7Vara(Xw,a卜!)7Vara(Z〃《)io"Z,，c/,)io《《，々,)其中的简写c表示cos，s表示sin。工业机器人从机械结构上通常可以看成是一个6自由度串联型机器人，本发明中采用的实施例即为6自由度串联型机器人。其一端固定在机座上，另一端是自由的，安装激光跟踪仪，如图2所示，利用D-H运动学模型建立杆件坐0标系，其中坐标系(^z^""为机器人的基坐标系，^^A^z"为机器人末端执行器中心的坐标系，可知{06^《2"相对于基坐标系的位姿变换矩阵为06r=o!n《);r(6p23r(6p34r(《)45r(6>5)《)其中各连杆的参数表如下表(i)图2所示机器人连杆参数表<table>tableseeoriginaldocumentpage8</column></row><table>(b)所述的机器人的末端执行器上安装有激光跟踪仪，所述的激光跟踪仪具有测头中心。对于工业机器人的定位标定来说，只需要关心测头中心在空间的位置坐标矢量，而不需要了解其在空间的姿态。于是，建立测头中心的位置坐标矢量P-"，乂z)7，根据姿态变换矩阵可知P=°J*76P，其中X0，0,/,lf,Z是激光跟踪仪的结构参数。(C)6自由度串联机器人末端的测头中心的位置误差Ap主要是由各杆件的结构参数误差A《、Afl,、Aa,和关节变量误差A《所决定。A《反映的是杆件长度误差(理论值与实际值的偏差)；A^是由于相邻关节的旋转轴线不相交于一点而产生的误差；A^是两相邻关节不垂直产生的角度误差；A《是由于在机器人装配过程中，角度光学编码器的零位与理论模型中连杆旋转零位不重合而产生的零位偏置误差。假设各杆件的结构参数误差/W,、Aa,、Aa,和关节变量误差A《足够小，对测头中心在空间的位置坐标矢量；=(1，乂#进行全微分，从而建立测头中心位置误差和结构参数误差、关节变量误差M,、△",、△,、A《之间的线性关系模型<formula>formulaseeoriginaldocumentpage9</formula>将其写成矩阵的形式描述，艮P:A/=力A5其中^是一个3X31的误差系数矩阵，<formula>formulaseeoriginaldocumentpage9</formula>A^是一个31X1的误差参数矢量，即<formula>formulaseeoriginaldocumentpage9</formula>(d)在不改变激光跟踪仪与机器人的末端执行器的相对姿态的情况下，移动机器人各个关节，即改变机器人的关节变量《，使得激光跟踪仪的测头中心处于多个不同的位姿，将激光跟踪仪所记录的实际位姿坐标^与机器人控制器所计算的名义位姿坐标p"相比较，得到该位姿的位置误差的数值Ap-^-;7"。(e)将步骤(d)中的各个不同位姿的关节变量《和相对应的位置误差的数值Ap带入步骤(c)的线性关系模型中，利用最小二乘法得到结构参数误差A《、Aa,、A",和关节变量误差A《的补偿值，对步骤(b)中的测头中心在空间的位置坐标矢量p进行修正。之所以采用最小二乘法，是因为最小二乘法是一种较为符合实际情况、能够有效减小误差的迭代算法。(f)移动机器人各个关节使得激光跟踪仪的测头中心处于多个不同的位姿，在每个不同的位姿，将激光跟踪仪所记录的实际位姿坐标^与机器人控制器所计算的名义位姿坐标p"相比较，得到该位姿的位置误差的数值Ap二^-;7"，将所有的位置误差的数值与定位精度所要求的数值进行比较，如果存在任意一个位置误差的数值不满足定位精度要求，返回步骤(d)，如果所有的位置误差的数值都满足定位精度要求，则表明已经获得位置误差的满意值，最终获得各关节变量《与机器人的末端执行器的坐标系在机器人坐标系下的准确映射关系，即机器人的真实位姿，完成机器人绝对定位精度的标定。实际测试结果选择一台新组装的6自由度串联机器人，该机器人的各个关节具有较为理想的重复精度、激光跟踪仪具有理想的定位精度，经过测量该机器人在标定前的定位精度为10至15毫米，使用本发明的方法经过两次迭代之后，移动机器人到任意位姿，机器人末端执行器的定位精度达到0.4毫米之内，已经能够满足焊接工业的定位精度需求。权利要求1、一种工业机器人的标定方法，其特征在于包括以下步骤(a)建立机器人的运动学模型，得出机器人的末端执行器的坐标系相对于基坐标系的位姿变换矩阵，该位姿变换矩阵与机器人各连杆的杆件结构参数di、ai、αi及关节变量θi相关；(b)所述的机器人的末端执行器上安装有激光跟踪仪，所述的激光跟踪仪具有测头中心，根据步骤(a)的位姿变换矩阵建立所述的测头中心相对于基坐标系在空间的位置坐标矢量p；(c)对测头中心在空间的位置坐标矢量p进行全微分，从而建立测头中心位置误差Δp与结构参数误差Δdi、Δai、Δαi及关节变量误差Δθi之间的线性关系模型；(d)在不改变激光跟踪仪与机器人的末端执行器的相对姿态的情况下，移动机器人各个关节，即改变机器人的关节变量θi，使得激光跟踪仪的测头中心处于多个不同的位姿，将激光跟踪仪所记录的实际位姿坐标pc与机器人控制器所计算的名义位姿坐标pn相比较，得到该位姿的位置误差的数值Δp＝pc-pn；(e)将步骤(d)中的各个不同位姿的关节变量θi和相对应的位置误差的数值Δp带入步骤(c)的线性关系模型中，利用最小二乘法得到结构参数误差Δdi、Δai、Δαi和关节变量误差Δθi的补偿值，对步骤(b)中的测头中心在空间的位置坐标矢量p进行修正；(f)移动机器人各个关节使得激光跟踪仪的测头中心处于不同的位姿，将激光跟踪仪所记录的实际位姿坐标pc与机器人控制器所计算的名义位姿坐标pn相比较，得到该位姿的位置误差的数值Δp＝pc-pn，将该位置误差的数值与定位精度所要求的数值进行比较，如果该位置误差的数值不满足定位精度要求，返回步骤(d)，如果该位置误差的数值满足定位精度要求，则表明已经获得位置误差的满意值，最终获得各关节变量θi与机器人的末端执行器的坐标系在机器人坐标系下的准确映射关系，即机器人的真实位姿，完成机器人绝对定位精度的标定。2、根据权利要求1所述的一种工业机器人的标定方法，其特征在于所述的步骤(a)中的机器人的运动学模型是在笛卡尔坐标系下建立的。3、根据权利要求1所述的一种工业机器人的标定方法，其特征在于机器人的末端执行器的坐标系相对于基坐标系的位姿变换矩阵和激光跟踪仪的测头中心在空间的位置坐标矢量是通过D-H运动学模型得出的。4、根据权利要求1所述的一种工业机器人的标定方法，其特征在于机器人的末端执行器的坐标系相对于基坐标系的位姿变换矩阵和测头中心在空间的位置坐标矢量是通过修正的D-H运动学模型得出的，机器人的末端执行器的坐标系相对于基坐标系的位姿变换矩阵还与辅助变量A相关，A的值定义为零。5、根据权利要求1所述的一种工业机器人的标定方法，其特征在于在进行步骤(f)时，移动机器人各个关节使得激光跟踪仪的测头中心处于多个不同的位姿，只有当所有位姿的位置误差的数值满足定位精度要求时，才表明已经获得位置误差的满意值，只要有一个位姿的位置误差的数值不满足，则返回步骤(d)。全文摘要本发明涉及一种工业机器人的标定方法，通过建立机器人末端执行器的坐标系相对于基坐标系的位姿变换矩阵，再通过该位姿变换矩阵建立末端执行器上激光跟踪仪的测头中心相对于基坐标系的位置坐标矢量p，对该位置坐标矢量p全微分后得到位置误差与结构参数误差、关节变量误差的线性关系，将实验数据代入线性关系，求得结构参数误差、关节变量误差的补偿值，最终获得准确的机器人末端执行器的坐标系相对于基坐标系的位姿变换矩阵，完成机器人的定位精度的标定，克服技术偏见，使得标定后的工业机器人能够满足各种不同的应用场合和不同的工作位置需求。文档编号G01B11/03GK101231749SQ20071030241公开日2008年7月30日申请日期2007年12月20日优先权日2007年12月20日发明者丁思成,南小海,杨文玉,程学刚申请人:昆山华恒工程技术中心有限公司