- ABB工业机器人进阶编程与应用
- 陈瞭 肖辉编著
- 1031字
- 2022-08-16 16:20:24
1.2.1 定义TCP
1.通用机器人
如果现场加工的工具与设计的数模一致,则可以通过3D数模软件直接获取工具末端相对于机器人法兰盘的位姿(TCP数据),输入机器人系统即可。但现场由于加工和安装等问题,通常TCP数据需要使用四点法(或者更多点)人工示教并计算得到。
使用四点法(或者更多点)时,将需要定义的工具末端以不同姿态接近空间一个固定点(见图1-15),并分别记录4个不同姿态时的机器人在tool0坐标系中的位姿信息,利用RAPID函数自动计算获得。
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_28_1.jpg?sign=1739031051-mL9S7my4MQO3km2o1uqL28nmN1JMwouR-0-94caa9ab2ab856e4cbb117823f97b57c)
图1-15 四点法定义TCP
ABB工业机器人在示教器中提供定义TCP的辅助方法,具体步骤如下。
(1)如图1-16所示,在示教器中的“手动操纵”界面中,单击“工具坐标”,并单击“新建”。
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_28_2.jpg?sign=1739031051-WQr97dAhxCGiCniUR9aOzgRowz28T5MR-0-75975a60facf3b9493e5314824a0a58b)
图1-16 单击“工具坐标”
(2)ABB工业机器人采用tooldata类型的数据表示工具数据,工具数据中除TCP坐标系数据外,还有工具质量、重心位置及惯性矩和惯性轴等数据。默认质量(Mass)数据为-1,需要根据实际情况修改(工具质量和重心也可通过系统的LoadIdentify服务例行程序自动获得,如图1-17所示),如图1-18所示,单击“更改值”即可进行修改。
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_29_1.jpg?sign=1739031051-tW2dzSuqLCA78chjcwmWWNvidbMx1XYG-0-a7c7bfd3e702801e0379efb007d41988)
图1-17 LoadIdentify服务例行程序
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_29_2.jpg?sign=1739031051-9mIfXo5cTgFjNd7r7VXDk5Qc6tkqNeUu-0-91ea5c3112939b632127e221c395e9a4)
图1-18 单击“更改值”,修改工具数据中的质量及重心数据
(3)单击图1-18中的“定义”,按照图1-15所示,令工具末端以不同的4种姿态接近空间中的同一固定点,并分别记录位置。最后单击“确定”,计算得到当前TCP。
(4)使用图1-19所示的“TCP(默认方向)”方法获得TCP,姿态数据与tool0坐标系平行。若要自定义TCP的方向,可以选择图1-20所示的方法。其中,“延伸器点Z”如图1-21所示,“延伸器点Z”到定点的连线为TCP的Z方向。
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_29_3.jpg?sign=1739031051-8Tkb3VHNJ5bWanmP2dkJcJETi1KAUINo-0-016794cfa51eab2f28df56767741290a)
图1-19 记录4个不同姿态位置
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_30_1.jpg?sign=1739031051-NvYFwDh0hQHbsHfV1i79KU1BA7U46T9L-0-f6bdc124cf3de43c7bd0c05a379eb4c6)
图1-20 带方向的TCP定义
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_30_2.jpg?sign=1739031051-D71tGQ74FSq1W4RnkviNuGDGf9oTUzgg-0-f98ff0e97fd060fbb84afd64c919d704)
图1-21 “延伸器点Z”及其TCP的Z方向定义
2.SCARA与四轴码垛机器人
在使用示教器提供的TCP定义功能时,通常需要人工让机器人以不同的4种姿态接近同一个点,如图1-15所示。对于Scara机器人(平面关节机器人,如图1-22中左边的机器人)和四轴码垛机器人(如图1-22中右边的机器人),由于其机械结构特性,机器人是无法绕工具末端任意旋转(通常只能绕z轴旋转)的。对于该类型的机器人,其TCP只能定义x、y和rz。
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_30_3.jpg?sign=1739031051-2p6h8wA2ZzRCNbpWO1Xvo6oloa99Puhy-0-98e78ae563b46bc33c7142266f72b19a)
图1-22 Scara机器人和四轴码垛机器人
Robotware 6.09之前的版本,机器人示教器不支持该类型机器人TCP的定义,但可以人工编写代码实现,其原理如图1-23所示:机器人令工具末端以不同姿态接近同一个点,此时不同位置的tool0在一个圆上。通过多点计算圆心,再利用坐标转化获得TCP数据。
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_31_1.jpg?sign=1739031051-R2L8IvEuFAnoCmHjXaPLX5HY3DVpw2Su-0-4282b7cee4a851a04af968379942e5f1)
图1-23 Scara机器人计算TCP原理
在Robotware 6.09以后的版本中,示教器支持四轴机器人TCP的定义,可以使用图1-24所示的界面进行定义。默认得到的TCP数据中的z为0。
![](https://epubservercos.yuewen.com/315336/23950325101463306/epubprivate/OEBPS/Images/43597_31_2.jpg?sign=1739031051-7doPqVofiQ61OHz9bEYKFBaUDtvdYLdk-0-4296f0360ba6d5d85458303f29ccd1dc)
图1-24 Robotware 6.09开始支持4轴机器人TCP的定义