FANUC(发那科)接口程序指令说明
FANUC 机器人程序调用说明:
-
程序的形参列表中各个参数之间以逗号分隔;
-
每个形参变量都定义为局部变量,只在程序中有效;
-
程序的形参列表支持定义输入参数和输出参数。
标准接口程序指令如下。
初始化通信参数指令
启动 Mech-Vision 工程
该指令用于触发 Mech-Vision 工程的运行,执行相机拍照和视觉处理。用于只使用 Mech-Vision 而不使用 Mech-Viz 的场景。
参数
参数 | 描述 |
---|---|
输入参数 |
|
Job |
Mech-Vision 工程编号,可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。 |
Pos_Num_Need |
预期视觉点数量,即期望从 Mech-Vision 得到的视觉点数量。可设置范围 [0~20],0 表示获取所有。 |
SendPos_Type |
机器人位姿类型,该参数指定真实机器人的位姿将以何种形式传入 Mech-Vision。参数范围:[0~3]。
|
Pr_Num |
PR 寄存器号,用于保存机器人预定义的关节角数据(此时将 PR 寄存器的数据形式改为关节),仅当 SendPos_Type=3 时才会使用此寄存器内的关节角数据。 |
获取视觉目标点
该指令用于启动 Mech-Vision 工程之后,获取视觉识别结果。用于只使用 Mech-Vision 而不使用 Mech-Viz 的场景。
参数
参数 | 描述 |
---|---|
输入参数 |
|
Job |
Mech-Vision 工程编号,可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。 |
输出参数 |
|
Reg_Lst_Data |
R 寄存器号,用于记录点位是否发送完毕,值为 0 或 1。
|
Reg_Pos_Num |
R 寄存器号,用于保存返回的位姿数量,取值范围为 1~20。 |
Reg_Status |
R 寄存器号,用于保存状态码,具体可参考《标准接口状态码及错误排查》。 |
启动 Mech-Viz 工程
该指令用于启动 Mech-Viz 工程,调用相应的 Mech-Vision 工程,并规划抓取路径。用于既有 Mech-Vision 又有 Mech-Viz 的场景。
参数
参数 | 描述 |
---|---|
输入参数 |
|
SendPos_Type |
机器人的位姿类型。参数范围:[0~2]。
|
Pr_Num |
PR 寄存器号,用于保存机器人预定义的关节角数据(此时将 PR 寄存器的数据形式改为关节),仅当 SendPos_Type=2 时才会使用此寄存器内的关节角数据。 |
获取 Mech-Viz 数据
用于获取Mech-Viz工程规划的抓取路径。
参数
参数 | 描述 |
---|---|
输入参数 |
|
Jps_Pos |
要获取的路径上点的位姿类型。
|
输出参数 |
|
Reg_Lst_Data |
R 寄存器号,用于表示点位是否发送完毕,0 代表未发送完毕,1 代表发送完毕。 |
Reg_Pos_Num |
R 寄存器号,用于保存接收到的位姿数量,Pose 点数量为 1~20。 |
Reg_VPos_Num |
R 寄存器号,用于保存第一个视觉移动在路径中的位置编号。
|
Reg_Status |
R 寄存器号,用于保存状态码,具体可参考《标准接口状态码及错误排查》。 |
获取视觉点坐标值
获取视觉点关节角(使用 Mech-Viz 软件规划时有效)
切换 Mech-Vision 配方
选择 Mech-Viz 分支
设置移动索引
获取软件状态
用于获取 Mech-Vision,Mech-Viz,Mech-Center 的软件运行状态。目前只支持检测 Mech-Vision 是否注册就绪。
参数
参数 | 描述 |
---|---|
输出参数 |
|
MM_Status |
R 寄存器号,用于保存指令状态码,具体可参考《标准接口状态码及错误排查》。 |
向 Mech-Vision 传入物体尺寸
获取 DO 列表 / 设置 DO
当需要使用 Mech-Viz 中的吸盘分区/多抓功能时,可通过该指令来获取规划的分区 DO 信号列表。调用该指令之前需要先调用 MM_GET_VIZ 。
请参考 XXXX/Mech-Center-xxx/tool/viz_project/suction_zone
中 Mech-Viz 模板工程使用,并在运行之前在工程中设置对应的吸盘配置文件。
设置外部位姿
该指令用于向 Mech-Viz 工程动态传入位姿数据,配合 Mech-Viz 软件中的“外部移动”步骤使用。该功能需要配合 XXXX/Mech-Center-xxx/tool/viz_project/outer_move
工程使用,并在运行之前把其中的 外部移动 放到合适的位置。 该指令需要在调用 MM_START_VIZ 程序之前调用。
标定
该程序用于相机外参的自动标定。该程序配合 Mech-Vision 的相机标定工具,可以实现标定过程全自动。具体可以参见标定操作流程。
获取 Mech-Vision 的通知消息
该指令用于获取 Mech-Vision 中“通知”步骤的消息,注意需要与 启动 Mech-Vision 工程 或 启动 启动 Mech-Viz 工程 一同使用才能有效。
Mech-Vision 工程中“通知”步骤的参数设置要求如下:
-
“服务名称”参数值固定为 Standard Interface Notify。
-
“消息”参数表示机器人端希望收到的数据,类型必须为正整数。
获取 Mech-Vision 自定义数据
将获取的 Mech-Vision 自定义输出数据保存至寄存器变量
该指令用于将 Mech-Vision 返回的自定义输出数据结果转存到机器人指定的寄存器变量中,在触发 获取 Mech-Vision 自定义数据 指令之后使用。
从 Mech-Viz 获取路径点
该指令用于从 Mech-Viz 获取路径规划结果。其中,路径点可以是一般移动路径点,也可以是视觉移动路径点。路径点可能包含位姿、速度、工具信息、工件信息等。
执行该指令得到的路径点可以是以下三种之一。
-
除了视觉移动之外的一般移动路径点,其信息包括运动类型(关节运动或直线运动)、工具编号、速度。
-
视觉移动路径点,其信息包括标签、已抓取的工件总数、本次抓取的工件数量、吸盘边角号、TCP 偏移量、工件朝向、工件组尺寸。
-
包含自定义数据的视觉移动路径点,此时 Mech-Vision 工程“输出”步骤的端口类型需设置为“自定义”。
参数
参数 | 描述 |
---|---|
输入参数 |
|
Jps_Pos |
预期的返回数据格式,取值范围为 1~4,详情参见下表。 |
输出参数 |
|
Reg_Pos_Num |
R 寄存器号,用于保存接收到的路径点个数,范围为 [1~50]。 |
Reg_VPos_Num |
R 寄存器号,用于保存第一个视觉移动在规划路径中的位置编号。 |
Reg_Status |
R 寄存器号,用于保存该指令返回的状态码。 |
以下是四种预期的返回数据格式说明。
预期的返回数据格式 参数值 | 预期的返回数据 说明(每个字段的具体解释参见下文) |
---|---|
1 |
位姿(JPs 形式), 运动类型, 工具编号, 速度, 自定义数据项个数, 自定义数据项 1, …, 自定义数据项 N |
2 |
位姿(TCP 形式), 运动类型, 工具编号, 速度, 自定义数据项个数, 自定义数据项 1, …, 自定义数据项 N |
3 |
位姿(JPs 形式), 运动类型, 工具编号, 速度, 视觉规划结果, 自定义数据项个数, 自定义数据项 1, …, 自定义数据项 N |
4 |
位姿(TCP 形式), 运动类型, 工具编号, 速度, 视觉规划结果, 自定义数据项个数, 自定义数据项 1, …, 自定义数据项 N |
位姿
路径点的位姿可以是机器人关节角(JPs,单位为度)或工具位姿(TCP,其中三维坐标单位为毫米,欧拉角单位为度),其形式取决于发送的指令参数。
运动类型
-
1
:关节运动,MOVEJ -
2
:直线运动,MOVEL
工具编号
路径点的工具编号。 -1 表示不使用工具。
速度
路径点的速度百分比值,其值为 Mech-Viz 工程中该路径点对应移动类步骤的参数中设置的速度乘以 Mech-Viz 中设置的全局速度,单位为 %。
视觉规划结果
路径中的规划结果信息(如果路径点对应移动步骤为视觉移动),通常用于纸箱多拣、卸垛等。信息包括:
-
标签:由 10 个正整数组成,默认为 10 个 0。
-
已抓取的工件总数。
-
本次抓取的工件数量。
-
吸盘边角号:用于指定工件靠近吸盘的哪个边角。在 Mech-Viz 的“工程资源”中双击对应的末端工具名称,然后单击 控制逻辑配置窗口 ,便可查看吸盘边角号。
-
工具位姿(TCP)偏移量:从对应工件中心的 TCP 到 实际 TCP 的偏移量。
-
工件朝向:工件坐标系 X 轴相对于 TCP X 轴的方向。
-
工件组尺寸。
自定义数据项个数
当 Mech-Vision 工程中“输出”步骤的端口类型为“自定义”时,除 poses 和 labels 之外其他端口的数量。
自定义数据项
当 Mech-Vision 工程中“输出”步骤的端口类型为“自定义”时,除 poses 和 labels 之外其他端口的数据。
各自定义数据按照端口名称的字母顺序(A—Z)排列。
将从 Mech-Viz 获取的路径点数据保存至寄存器变量
该指令用在 从 Mech-Viz 获取路径点 后,用于将从 Mech-Viz 获取的路径点数据转存到机器人指定的寄存器变量中。
参数
参数 | 描述 |
---|---|
输入参数 |
|
Serial |
指定要转存第几个路径点。 |
Jps_Pos |
与 从 Mech-Viz 获取路径点 中的 Jps_Pos 所选值一致。 |
输出参数 |
|
Pr_Num |
PR 寄存器号,用于保存指定路径点对应的位姿数据。 |
Reg_MoveType |
R 寄存器号,用于保存指定路径点对应的运动类型。1 表示 MOVEJ,2 表示 MOVEL。 |
Reg_ToolNum |
R 寄存器号,用于保存指定路径点对应的工具编号。-1 表示空工具。 |
Reg_Speed |
R 寄存器号,用于保存指定路径点对应的移动速度。 |
Reg_UserData |
R 寄存器号,用于保存指定路径点对应的自定义输出数据。此为起始寄存器编号,根据自定义数据数量依次向后进行存储,目前数量最大值为 50。 |
Reg_PlanRes |
R 寄存器号,用于保存指定路径点对应的视觉规划结果。此为起始寄存器编号,根据视觉规划结果数据数量依次向后进行存储,目前数量为 20。 |
获取 Mech-Vision “路径规划”步骤的结果
在启动 Mech-Vision 工程后,该指令用于获取 Mech-Vision 中“路径规划”步骤输出的免碰撞抓取路径。
在使用该指令时,Mech-Vision “输出”步骤的 端口类型 参数需要设置为“预定义(机器人路径)”。
参数
参数 | 描述 |
---|---|
输入参数 |
|
Job |
Mech-Vision 工程编号,可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。 |
Jps_Pos |
指定“路径规划”步骤返回的路径点的位姿类型。
|
输出参数 |
|
Reg_Lst_Data |
R 寄存器号,用于表示路径点是否发送完成。
|
Reg_Pos_Num |
R 寄存器号,用于保存该指令返回的路径点个数,范围为 [1~20]。 |
Reg_VPos_Num |
R 寄存器号,用于保存路径规划工具中设置的“视觉移动”路径点在整个路径中的位置。
|
Reg_Status |
R 寄存器号,用于保存该指令返回的状态码。 |