![工业机器人实战应用及调试](https://wfqqreader-1252317822.image.myqcloud.com/cover/838/43806838/b_43806838.jpg)
3.1.4 工具坐标系
1.工具坐标系的定义及设置基准
(1)定义 由于实际使用的机器人都要安装夹具抓手等辅助工具,所以机器人的实际控制点就移动到了工具的中心点上,为了控制方便,以工具的中心点为基准建立的坐标系就是TOOL坐标系,如图3-6所示。
(2)设置 由于夹具抓手直接安装在机械法兰面上,所以TOOL坐标系就是以机械IF坐标系为基准建立的。建立TOOL坐标系有参数设置法和指令设置法,实际上都是确定TOOL坐标系原点在机械IF坐标系中的位置和形位(POSE)。
(3)TOOL坐标系的原点数据 TOOL坐标系与机械IF坐标系的关系如图3-7所示。TOOL坐标系用Xt,Yt,Zt表示。TOOL坐标系是在机械IF坐标系基础上建立的。在TOOL坐标系的原点数据中,X,Y,Z表示TOOL坐标系在机械IF坐标系内的直交位置点。A,B,C表示TOOL坐标系绕机械IF坐标系Xm,Ym,Zm轴的旋转角度。TOOL坐标系的原点不仅可以设置在任何位置,而且坐标系的形位也可以通过A,B,C值任意设置(相当于一个立方体在一个万向轴接点任意旋转)。
![](https://epubservercos.yuewen.com/F85A97/23083822101913406/epubprivate/OEBPS/Images/39_01.jpg?sign=1739536839-mM3oHnCPdd0zHDCIZtBKawiQ4FAYfZWZ-0-7b5344785b667e100c425147f0040e7c)
图3-6 工具(TOOL)坐标系示意图
![](https://epubservercos.yuewen.com/F85A97/23083822101913406/epubprivate/OEBPS/Images/39_02.jpg?sign=1739536839-vhkkxNdnfbPzJkYdwaQHCWeWudbLWKJf-0-38afd9c304b70fff17e5225ec9e44aa6)
图3-7 TOOL坐标系与机械IF坐标系的关系
在图3-7中,TOOL坐标系绕Y轴旋转了-90°,所以Zt轴方向就朝上(与机械IF坐标系中的Zm方向不同)。而且当机械法兰面旋转(J6轴旋转)时,TOOL坐标系也会随着旋转,分析时要特别注意。
2.动作比较
(1)JOG或示教动作 未设置TOOL坐标系时,使用机械IF坐标系以出厂值法兰面中心为控制点,在Xm方向移动(此时Xm轴垂直向下),其移动形位如图3-8所示。
(2)设置TOOL坐标系 以TOOL坐标系动作。注意在X方向移动时,是沿着TOOL坐标系的Xt轴方向动作。这样就可以平行或垂直于抓手面动作,使JOG动作更简单易行,如图3-9所示。
![](https://epubservercos.yuewen.com/F85A97/23083822101913406/epubprivate/OEBPS/Images/39_03.jpg?sign=1739536839-Zj1uRan5NuSpzgHJXZbEgRX0KCiSD55l-0-452639932756a5266dc78961401a2be8)
图3-8 X方向移动的形位
![](https://epubservercos.yuewen.com/F85A97/23083822101913406/epubprivate/OEBPS/Images/39_04.jpg?sign=1739536839-fPe4J44JKW7c6WQTlRDvVIbEQpAASD0L-0-0702e705311c7190d5335ee17946add8)
图3-9 在TOOL坐标系X方向移动
(3)A方向动作 未设置TOOL坐标系时,使用机械IF坐标系,绕Xm轴旋转,抓手前端大幅度摆动,如图3-10所示。
设置TOOL坐标系后,绕Xt轴旋转,抓手前端绕工件旋转。在不偏离工件位置的情况下,改变机器人形位,如图3-11所示。以上是在JOG运行时的情况。
![](https://epubservercos.yuewen.com/F85A97/23083822101913406/epubprivate/OEBPS/Images/40_01.jpg?sign=1739536839-IYYiMloRXnZUqRxVyz22x9TlN0g729Xl-0-095b5e9261a07d34fed75affe7992f3a)
图3-10 A方向的动作
![](https://epubservercos.yuewen.com/F85A97/23083822101913406/epubprivate/OEBPS/Images/40_02.jpg?sign=1739536839-SbqESsqKdTePBYmZarNtvEFO5V5jXoiL-0-47cdfe12ae4ac502c30412000cc5f57c)
图3-11 在TOOL坐标系中绕Xt轴旋转
3.自动运行
(1)近点运行 在自动程序运行时,TOOL坐标系的原点为机器人控制点。在程序中发出的定位点是以世界坐标系为基准的,但是Mov指令中的近点运行功能中的近点位置则是以TOOL坐标系的Z轴正负方向为基准移动,这是必须充分注意的。
指令例句:Mov P1,50:其动作是将TOOL坐标系原点移动到P1点的近点,近点为P1点沿TOOL坐标系的Z轴正向移动50mm,如图3-12所示。
(2)相位旋转 绕工件位置点旋转(Zt),可以使工件旋转一个角度。
例:指令在P1点绕Z轴旋转45°(使用两点的乘法指令)。
![](https://epubservercos.yuewen.com/F85A97/23083822101913406/epubprivate/OEBPS/Images/40_03.jpg?sign=1739536839-0CTieEctrhg2zSVGZKrHThdiaG9eJJIt-0-39c52e44f9e405adf60f28dfe2787a5d)
图3-12 在TOOL坐标系中的近点动作
1 Mov P1*(0,0,0,0,0,45)
实际的运动结果如图3-13所示。
![](https://epubservercos.yuewen.com/F85A97/23083822101913406/epubprivate/OEBPS/Images/40_04.jpg?sign=1739536839-LnrNyeEL4gxugm4gZHfEkzR26EEZYjSf-0-8bd0baa8c535d73c0fc434097c98e885)
图3-13 在TOOL坐标系中的相位旋转