工业机器人实操进阶手册
上QQ阅读APP看本书,新人免费读10天
设备和账号都新为新人

9.3 结构标志FL1

“位置点”是由XYZABC(FL1,FL2)标记的。由于机器人结构的特殊性,即使是同一“位置点”,机器人也可能出现不同的“形位(POSE)”。为了区别这些“形位(POSE)”,采用了结构标志,用位置标记的(XYZABC)(FL1,FL2)中的“FL1”标记,标记方法如下。

9.3.1 垂直多关节型机器人

(1)左右标志

①5轴机器人:以J1轴旋转中心线为基准,判别第5轴法兰中心点P位于“该中心线”的左面还是右面。如果在右边(RIGHT),则FL1 bit2=1;如果在左边(LEFT),则FL1 bit2=0,如图9-7所示。

图9-7 左右判定

②6轴机器人:以J1轴旋转中心线为基准,判别J5轴中心点P位于“该中心线”的左面还是右面。如果在右边(RIGHT),则FL1 bit2=1;如果在左边(LEFT),则FL1 bit2=0;如图9-8所示。

图9-8 FL1标志的左右判断

注意FL1标志信号用一组二进制码表示,检验左右位置用bit2表示。

(2)上下判断

①5轴机器人:以J2轴旋转中心和J3轴旋转中心的连接线为基准,判别J5轴中心点P是位于“该中心连接线”的上面还是下面。如果在上面(ABOVE),则FL1 bit1=1;如果在下面(BELOW),则FL1 bit1=0,如图9-9所示。

图9-9 FL1标志中“上下”的判定

②6轴机器人:以J2轴旋转中心和J3轴旋转中心的连接线为基准,判别J5轴中心点P是位于“该中心连接线”的上面还是下面。如果在上面(ABOVE),则FL1bit1=1;如果在下面(BELOW),则FL1bit1=0,如图9-10所示。

图9-10 FL1标志中“上下”的判定及显示

注意FL1标志信号用一组二进制码表示,检验上下位置用bit1表示。

(3)高低判断

第6轴法兰面(6轴机型)方位判断。以J4轴旋转中心和J5轴旋转中心的连接线为基准,判别6轴的法兰面是位于“该中心连接线”的上面还是下面。如果在下面(NON FLIP),则FL1bit0=1;如果在上面(FLIP),则FL1bit0=0,如图9-11所示。

图9-11 J6轴法兰面位置的判定

注意FL1标志信号用一组二进制码表示,检验高低位置用bit0表示。

9.3.2 水平运动型机器人

以J1轴旋转中心和J2轴旋转中心的连接线为基准,判别机器人前端位置控制点是位于“该中心连接线”的左面还是右面。如果在右面(RIGHT),则FL1bit2=1;如果在左面(LEFT),则FL1bit2=0,如图9-12所示。

图9-12 水平运动型机器人的FL1标志