发明内容
本发明所要解决的技术问题是提供一种用于附加外部轴的机器人系统分站式精度补偿方法,该方法的定位精度高,响应速度快,能耗较小且成本较低。
本发明所述的一种用于附加外部轴的机器人系统分站式精度补偿方法,该附加外部轴的机器人系统包括导轨和滑台,该方法包括如下步骤:
(1)建立世界坐标系,在此基础上将机器人系统的导轨分为N个分站;
(2)确定各分站处机器人基坐标系与世界坐标系之间的转换关系;
(3)在第一个分站,使用激光跟踪仪建立补偿机器人本体误差的空间立体网格;
(4)对于第i个分站,将在第一个分站建立的机器人空间立体网格转换到第i个分站,建立第i个分站处机器人误差补偿模型;
(5)重复步骤(4)完成所有分站处机器人误差补偿模型,并最终建立附加外部轴的机器人系统精度补偿模型。
所述步骤(1)中分站个数的确定根据导轨的长度以及机器人的工作范围进行,确保机器人在各个分站的工作范围满足实际工作的需要,即确保机器人具有可达性。
所述步骤(2)的具体步骤是:通过激光跟踪仪来建立机器人在第一个分站的基坐标系,确定其与世界坐标系之间的转换关系;在其他分站,将机器人基坐标系定义为机器人的动基坐标系,之后确定所有分站动基坐标系在世界坐标系下与第一个分站基坐标系之间的转换关系。
本发明具有如下技术效果:
i)针对不同型号的工业机器人和不同尺寸的工作对象,确定了合适的机器人分站,使得机器人无需经常在导轨上移动,减少了导轨误差不确定性对机器人系统精度的影响,同时扩大了机器人的工作范围,提高了机器人的工作适应性;
ii)本发明是在笛卡尔坐标系中进行的,与通常的外部轴与机器人联动补偿方式比较起来,无需对导轨全部位置的误差参数进行辨识与标定,计算过程简单迅速,且稳定性较高。
iii)本发明在确定各分站机器人基坐标系与世界坐标系之间的转换关系时引入了辅助坐标系,测量简单快捷。
iv)本发明中只需对工作范围内其中的一个分站的原始数据点进行测量,大大减少了测量工作量。
v)本发明可以显著提高机器人系统的绝对定位精度,使得标定后的机器人系统能适应更广泛的应用场合。
具体实施方式
如图1、2所示,本发明用于附加外部轴的机器人系统分站式精度补偿方法的步骤如下:
步骤1:建立世界坐标系,在此基础上将导轨分为N个分站。
使用激光跟踪仪建立世界坐标系的方法是:在机器人加工系统空间选取3个固定点,用激光跟踪仪测量3点的位置,令其中一点为原点(命名为P
w0),另一点为X轴上一点(命名为P
w1),另一点为XY平面上一点(命名为P
w2)。以
为世界坐标系的X轴,以
为临时Y轴,根据右手法则,用X轴叉乘临时Y轴得到世界坐标系的Z轴,再用世界坐标系的Z轴叉乘世界坐标系的X轴得到世界坐标系的Y轴。至此,世界坐标系构造完毕。
划分分站的方法是:根据机器人说明手册确定机器人的最大工作范围,根据工作目标的尺寸,划分有限个分站使得总的工作范围包括工作目标的尺寸即可。
步骤2:确定各分站处机器人基坐标系与世界坐标系之间的转换关系。根据机器人基坐标系建立的方法,通过激光跟踪仪来建立机器人在第一个分站的基坐标系,确定其与世界坐标系之间的转换关系;在其他分站,将机器人基坐标系定义为机器人的动基坐标系;在确定各分站动基坐标系与第一个分站基坐标系之间的转换关系时,引入辅助坐标系,其测量方法如下:
①在滑台上预置三个基准孔,通过测量这三个基准孔的位置,在第一个分站构建出一个辅助坐标系;
②驱动机器人运动到第i个分站处,建立该分站下的辅助坐标系,确定其与世界坐标系之间的转换关系;
③在世界坐标系下,通过第i个分站处辅助坐标系与第一个分站处辅助坐标系之间的转换关系求出第i个分站处动基坐标系与第一个分站基坐标系之间的转换关系;
④重复步骤②和③以确定所有分站动基坐标系在世界坐标系下与第一个分站基坐标系之间的转换关系。
由于机器人放置在滑台固定位置,同时机器人与滑台上的三个基准孔相对位置固定,因此,在任意一个分站下,该分站的辅助坐标系与当前机器人基坐标系之间的转换关系是不变的。所以,在世界坐标系下,第i个分站的动基坐标系与第1个分站的基坐标系之间的转换关系可以用第i个分站的辅助坐标系与第1个分站的辅助坐标系之间的转换关系所代替。
所述步骤2中机器人基坐标系的建立方法参考中国专利“一种用于工业机器人的空间立体网格精度补偿方法”(公开号102230783A)。辅助坐标系的建立方法与所述步骤(1)中世界坐标系的建立方法相同。如图2,设世界坐标系为{Ow Xw Yw Zw},分站i处的机器人动基坐标系为{Oib Xib Yib Zib},由基准孔P1,P2,P3建立的辅助坐标系为{Oia Xia Yia Zia}。辅助坐标系{Oia Xia Yia Zia}在世界坐标系{Ow Xw Yw Zw}下的位置和姿态可以如下用齐次变换矩阵表示:
其中,
表示在世界坐标系下辅助坐标系{O
ia X
ia Y
ia Z
ia}的齐次变换矩阵,
wp
1表示辅助坐标系{O
ia X
ia Y
ia Z
ia}的原点(即P
1点)在世界坐标系下的平移向量,
表示辅助坐标系{O
ia X
ia Y
ia Z
ia}相对于世界坐标系的旋转矩阵,它是由辅助坐标系{O
ia X
ia Y
ia Z
ia}的三个单位主矢量x
ia,y
ia,z
ia相对于世界坐标系{O
w X
w Y
w Z
w}的方向余弦组成的3×3矩阵,即:
在世界坐标系下,确定第i个分站处动基坐标系相对于第1个分站处的基坐标系的变换关系为:
式中
即相同分站处辅助坐标系{O
ia X
ia Y
ia Z
ia}相对于动基坐标系{O
ib X
ib Y
ib Z
ib}的转换关系是固定的,因此
与
相似;
为第i个分站处辅助坐标系相对于第1个分站处辅助坐标系的变换关系。变换矩阵
可以很容易通过测量和计算求出,因此可以快速通过辅助坐标系求出各分站基坐标系之间的相互变换关系,而不需要在每个分站都建立机器人的基坐标系,简化了测量操作。
步骤3:在第一个分站,同样参考中国专利“一种用于工业机器人的空间立体网格精度补偿方法”使用激光跟踪仪建立补偿机器人本体误差的空间立体网格。
所述步骤3中空间立体网格的网格点坐标值为世界坐标系下的坐标值。网格步长的确定及机器人本体的网格补偿方法见上述专利,本文不再赘述。
步骤4:对于第i个分站,根据步骤2中确定的第i个分站处机器人动基坐标系与第一个分站基坐标系之间的转换关系,将在第一个分站建立的机器人空间立体网格转换到第i个分站,建立第i个分站处机器人误差补偿模型。
所述步骤4中第i个分站处机器人误差补偿模型的建立方法是:设第一个分站处建立的网格中任意一个网格点为在世界坐标系下的齐次坐标表示为:
式中
1bp
j为点
在第一个分站处机器人基坐标系下的齐次坐标。由坐标变换原理,点
转换到第i个分站后的齐次坐标为:
至此,根据第i个分站的辅助坐标系与世界坐标系之间的变换关系,以及第一个分站的辅助坐标系与世界坐标系之间的变换关系即可计算点在第i个分站的坐标。重复此过程,计算出所有网格点在第i个分站的坐标,即可建立第i个分站处机器人误差补偿模型。
步骤5:重复步骤4完成所有分站处机器人误差补偿模型,并最终建立附加外部轴的机器人系统精度补偿模型。
下面以KUKA KR150-2机器人为例说明本发明的具体实施步骤。
步骤1:建立世界坐标系,在此基础上将导轨分为N个分站。
这里沿导轨方向划分了3个分站,分站1与分站2相距400mm,分站2与分站3相距300mm。
步骤2:确定各分站处机器人基坐标系与世界坐标系之间的转换关系。根据机器人基坐标系建立的方法,通过激光跟踪仪来建立机器人在第一个分站的基坐标系,确定其与世界坐标系之间的转换关系;在其他分站,将机器人基坐标系定义为机器人的动基坐标系;在确定各分站动基坐标系与第一个分站基坐标系之间的转换关系时,引入辅助坐标系。
根据激光跟踪仪建立的世界坐标系和辅助坐标系之间的转换关系如下:
步骤3:在第一个分站,使用激光跟踪仪建立补偿机器人本体误差的空间立体网格。
对KUKA KR150-2型机器人,以300mm为网格步长,在分站1建立12个机器人本体精度补偿空间立体网格,网格点在世界坐标系下的坐标如图3所示:
实际测量得到的网格坐标如下:
步骤4:对于第i个分站,根据步骤2中确定的第i个分站处机器人动基坐标系与第一个分站基坐标系之间的转换关系,将在第一个分站建立的机器人空间立体网格转换到第i个分站,建立第i个分站处机器人误差补偿模型。
步骤5:重复步骤4完成所有分站处机器人误差补偿模型,并最终建立附加外部轴的机器人系统精度补偿模型。
对KUKA KR150-2型机器人,以300mm为网格步长,在分站1建立12个空间立体网格建立机器人本体的精度补偿模型,通过各动基坐标系之间的变换关系建立机器人系统的综合精度补偿模型。在机器人工作空间中选取72个点进行试验验证。试验结果如下表(单位mm):
使用分站式补偿方法进行补偿后,测量这72个目标点,试验结果如下表(单位mm):
分析比较补偿前与补偿后的试验结果如图4,得到误差分布情况,如下表(单位mm):
根据上述试验结果,证明本发明用于附加外部轴的机器人系统分站式精度补偿方法是正确有效的,与机器人本体补偿前的绝对定位精度2mm相比,本发明将机器人的绝对定位精度调高到了0.3mm的水平,效果显著。