![工业机器人实操进阶手册](https://wfqqreader-1252317822.image.myqcloud.com/cover/942/29974942/b_29974942.jpg)
9.3 结构标志FL1
“位置点”是由X,Y,Z,A,B,C(FL1,FL2)标记的。由于机器人结构的特殊性,即使是同一“位置点”,机器人也可能出现不同的“形位(POSE)”。为了区别这些“形位(POSE)”,采用了结构标志,用位置标记的(X,Y,Z,A,B,C)(FL1,FL2)中的“FL1”标记,标记方法如下。
9.3.1 垂直多关节型机器人
(1)左右标志
①5轴机器人:以J1轴旋转中心线为基准,判别第5轴法兰中心点P位于“该中心线”的左面还是右面。如果在右边(RIGHT),则FL1 bit2=1;如果在左边(LEFT),则FL1 bit2=0,如图9-7所示。
![](https://epubservercos.yuewen.com/5C8169/16499765204637706/epubprivate/OEBPS/Images/image193.jpg?sign=1734449414-Hk1vjiJuJQgEVQBBnjguJithGZsGxAOM-0-36166bb0685dc1b221b232fa13000c40)
图9-7 左右判定
②6轴机器人:以J1轴旋转中心线为基准,判别J5轴中心点P位于“该中心线”的左面还是右面。如果在右边(RIGHT),则FL1 bit2=1;如果在左边(LEFT),则FL1 bit2=0;如图9-8所示。
![](https://epubservercos.yuewen.com/5C8169/16499765204637706/epubprivate/OEBPS/Images/image194.jpg?sign=1734449414-VMzphQeRtOIe082sfOVyrvo8vV6XVZ8z-0-f3488a8f33f5b84b958544e0ef683c9f)
图9-8 FL1标志的左右判断
注意FL1标志信号用一组二进制码表示,检验左右位置用bit2表示。
(2)上下判断
①5轴机器人:以J2轴旋转中心和J3轴旋转中心的连接线为基准,判别J5轴中心点P是位于“该中心连接线”的上面还是下面。如果在上面(ABOVE),则FL1 bit1=1;如果在下面(BELOW),则FL1 bit1=0,如图9-9所示。
![](https://epubservercos.yuewen.com/5C8169/16499765204637706/epubprivate/OEBPS/Images/image195.jpg?sign=1734449414-rvcPwJhmAjbk2g0g6sbIRoQCfTB9Oq7z-0-da8cbb4d7365dad64e9a844a854b75dc)
图9-9 FL1标志中“上下”的判定
②6轴机器人:以J2轴旋转中心和J3轴旋转中心的连接线为基准,判别J5轴中心点P是位于“该中心连接线”的上面还是下面。如果在上面(ABOVE),则FL1bit1=1;如果在下面(BELOW),则FL1bit1=0,如图9-10所示。
![](https://epubservercos.yuewen.com/5C8169/16499765204637706/epubprivate/OEBPS/Images/image196.jpg?sign=1734449414-FxeFqe1iIVnCwi6x4mfKT0eJt5ApgSpA-0-a9d2ecb11002965b3603432c8e065611)
图9-10 FL1标志中“上下”的判定及显示
注意FL1标志信号用一组二进制码表示,检验上下位置用bit1表示。
(3)高低判断
第6轴法兰面(6轴机型)方位判断。以J4轴旋转中心和J5轴旋转中心的连接线为基准,判别6轴的法兰面是位于“该中心连接线”的上面还是下面。如果在下面(NON FLIP),则FL1bit0=1;如果在上面(FLIP),则FL1bit0=0,如图9-11所示。
![](https://epubservercos.yuewen.com/5C8169/16499765204637706/epubprivate/OEBPS/Images/image197.jpg?sign=1734449414-lZUAvsMMkgXiC4whY9C8LwzdfhUBSGvm-0-06f06695d822ac16b50dc5f936845992)
图9-11 J6轴法兰面位置的判定
注意FL1标志信号用一组二进制码表示,检验高低位置用bit0表示。
9.3.2 水平运动型机器人
以J1轴旋转中心和J2轴旋转中心的连接线为基准,判别机器人前端位置控制点是位于“该中心连接线”的左面还是右面。如果在右面(RIGHT),则FL1bit2=1;如果在左面(LEFT),则FL1bit2=0,如图9-12所示。
![](https://epubservercos.yuewen.com/5C8169/16499765204637706/epubprivate/OEBPS/Images/image198.jpg?sign=1734449414-cITv7gku0sS0cgQq5QqitNuYdsEBpdTm-0-3cf6fc590cf9d0fb69ed46481032a37f)
图9-12 水平运动型机器人的FL1标志