第5章 工业机器人控制技术
5.3 机器人编程
5.3.4 动作级语言
(4)坐标系(FRAME ) 。 FRAME型坐标系变量用来建立坐标系,以描述作业空间中对象物
体的姿态和位置,变量的值表示物体的固联坐标系与作业空间的参考 坐标系之间的相对位置关系和姿态关系。作业空间的参考坐标系在AL 语言中已顶先用Station定义。作业空间中任何一坐标系可通过调用 函数FRAME来构成。该函数有两个参数:一个表示姿态的旋转,另 一个表示位置的向量。
第5章 工业机器人控制技术
5.3 机器人编程
5.3.4 动作级语言
(5)变换(TRANS) TRANS型变量用来进行坐标变换,与FRAME一样仅有旋转和向
量两个参数。在执行时,先相对于作业空间的基座坐标系旋转然后对 向量参数相加,进行平移操作。
AL语言中有一个预先说明的变换niltrans,定义为: niltrans←TRANS( nilrot,nilvect);
程序中的变量名以英文字母开头,由字母、数字和横划线“_”组 成的字符串,如Puma_base, BEAR , Bolt,大小写字母具有同等 意义。但变量必须在使用前说明其数据类型。
变量可以用赋位语句进行赋值。变量与数值表达式用“←”符号 来连接。当执行赋值语句时,先计算表达式的值,然后将该值赋值 给左边的变量。
符号“ ”可用在语句中,表示当前位置,如:
MOVE barm TO -2﹡zhat﹡inches; 该指令表示机械手从当前位置向下移动2in。由此可以看出,基本的 MOVE语句具有如下形式: MOVE <机械手> TO <目的地> <修饰子句> ; 例如 MOVE barm TO < destination > VIA f1 f2 f3 表示机械手经过中间 点 f1、 f2、 f3移动到目标坐标系 < destination > 。 MOVE barm TO block WITH APPROCH=3﹡zhat﹡inches表示把机 械手移动到在z轴方向上离block 3in的地方;如果DEPARTURE 代替 APPROACH,则表示离开block。关于接近/退避点可以用设定坐标系的 一个矢量来表示,如: WITH APPROACH = < 表达式 > ; WITH DEPARTURE=< 表达式 > ;