KUKA (库卡)接口程序指令说明
KUKA 机器人子程序调用说明:
-
子程序的 形参列表 中各个 参数 之间以逗号分隔;
-
每个 形参变量 都定义为 局部变量 ,只在程序中有效;
-
子程序的 形参列表 支持定义 输入参数 和 输出参数 。
本章将介绍以下指令。
初始化通信参数
启动 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]。
|
MM_J |
E6AXIS 类型变量,用于保存机器人预定义的关节角数据,仅当 SendPos_Type=3 时才会使用此关节角数据。 |
获取视觉目标点
用于只有 Mech-Vision,不用 Mech-Viz 的场景。该指令用于在启动 Mech-Vision 之后,获取视觉识别结果。
参数说明
参数 | 描述 |
---|---|
输入参数 |
|
Job |
Mech-Vision 工程编号,可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。 |
输出参数 |
|
Pos_Num |
变量,用于保存返回的位姿数量。 |
MM_Status |
变量,用于保存指令状态码,具体可参考《标准接口状态码及错误排查》。 |
启动 Mech-Viz 工程
用于既有 Mech-Vision 又有 Mech-Viz 的场景。该指令用于启动 Mech-Viz 工程,调用相应的 Mech-Vision 工程,并规划抓取路径。
参数说明
参数 | 描述 |
---|---|
输入参数 |
|
SendPos_Type |
机器人的位姿类型。参数范围:[0~2]。
|
MM_J |
E6AXIS 类型变量,用于保存机器人预定义的关节角数据,仅当 SendPos_Type=2 时才会使用此关节角数据。 |
获取 Mech-Viz 数据
用于获取 Mech-Viz 工程规划的抓取路径。
参数说明
参数 | 描述 |
---|---|
输入参数 |
|
Jps_Pos |
要获取的路径上点的位姿类型。
|
输出参数 |
|
Pos_Num |
变量,用于保存接收到的位姿数量。 |
VisPos_Num |
变量,用于保存第一个视觉移动在路径中的位置编号。 例如路径是:定点移动-1,定点移动-2,视觉移动-1,定点移动-3,则视觉移动的位置是3。若路径中无视觉移动,则返回值为零。 |
MM_Status |
变量,用于保存指令状态码,具体可参考《标准接口状态码及错误排查》。 |
获取视觉点坐标值
获取视觉点关节角(用 Mech-Viz 规划时有效)
切换 Mech-Vision 配方
选择 Mech-Viz 分支
设置移动索引
获取软件状态
用于获取 Mech-Vision,Mech-Viz,Mech-Center 的软件运行状态。目前只支持检测 Mech-Vision 是否注册就绪。
参数说明
参数 | 描述 |
---|---|
输出参数 |
|
MM_Status |
变量,用于保存指令状态码,具体可参考《标准接口状态码及错误排查》。 |
向 Mech-Vision 传入物体尺寸
获取吸盘DO信号
该指令用于获取Mech-Vision或Mech-Viz规划的吸盘DO信号。机器人通过MM_Set_DoList将获取的吸盘DO信号作用于末端工具。
设置吸盘DO信号
该指令用于将机器人获取的吸盘DO信号作用于末端工具。
该指令需在 MM_Get_DoList 之后被调用。 |
标定
获取 Mech-Vision 自定义数据
将获取的 Mech-Vision 自定义输出数据保存至变量
该指令用于将 Mech-Vision 返回的自定义输出数据结果转存到机器人指定的变量中,在触发 获取 Mech-Vision 自定义数据 指令之后使用。
获取视觉移动规划数据或自定义数据
该指令用于获取Mech-Vision工程的视觉移动规划数据,或者获取Mech-Viz工程的视觉移动规划数据或自定义数据。MM_Get_PlanPose或MM_Get_PlanJps可将获取的数据分配至各变量中。
参数说明
参数 | 描述 |
---|---|
输入参数 |
|
Resource |
该参数指定视觉移动规划数据的来源。
|
Jps_Pos |
预期的返回数据格式,详情参见以下说明。 |
输出参数 |
|
Pos_Num |
变量,用于保存接收到的路径点个数。 |
VisPos_Num |
变量,用于保存第一个视觉移动在规划路径中的位置编号。 |
MM_Status |
变量,用于保存该指令返回的状态码。 |
-
当Resource为0时,Jps_Pos 参数取值范围为 1~4,具体说明如下。
Jps_Pos 参数值 预期的返回数据 说明(每个字段的具体解释参见下文) 1
位姿(JPs 形式), 移动类型, 末端工具编号, 速度, 自定义数据项 1, …, 自定义数据项 N
2
位姿(TCP 形式), 移动类型, 末端工具编号, 速度, 自定义数据项 1, …, 自定义数据项 N
3
位姿(JPs 形式), 移动类型, 末端工具编号, 速度, Mech-Viz视觉移动规划数据, 自定义数据项 1, …, 自定义数据项 N
4
位姿(TCP 形式), 移动类型, 末端工具编号, 速度, Mech-Viz视觉移动规划数据, 自定义数据项 1, …, 自定义数据项 N
-
当Resource为正整数时,Jps_Pos 参数取值范围为 1~2,具体说明如下。
Jps_Pos 参数值 预期的返回数据 说明(每个字段的具体解释参见下文) 1
位姿(JPs 形式), 移动类型, 末端工具编号, 速度, Mech-Vision视觉移动规划数据
2
位姿(TCP 形式), 移动类型, 末端工具编号, 速度, Mech-Vision视觉移动规划数据
位姿
路径点的位姿可以是机器人关节角(JPs,单位为度)或工具位姿(TCP,其中三维坐标单位为毫米,欧拉角单位为度),其形式取决于发送的指令参数。
移动类型
-
1:关节移动。
-
2:直线移动。
末端工具编号
路径点的末端工具编号。若值为-1,表示不使用末端工具。
速度
路径点的速度值。
视觉移动规划数据
Mech-Vision或Mech-Viz中“视觉移动”步骤规划的数据,包括被抓取工件的标签、已抓取的工件总数、本次抓取的工件数量、吸盘边角号、TCP偏移量、工件组朝向、单个工件朝向、工件组尺寸。
自定义数据项
当 Mech-Vision 工程中“输出”步骤的端口类型为“自定义”时,除 poses 和 labels 等之外其他自定义端口的数据。 各自定义数据按照端口名称的字母顺序(A—Z)排列。
将从MM_GET_PLANDATA获取的数据保存至各变量
该指令用在获取视觉移动规划数据或自定义数据指令后,用于将获取的数据存放到不同变量中。根据获取视觉移动规划数据或自定义数据指令中指定的Jps_Pos参数值,选择不同的程序。
子程序
MM_Get_PlanPose(Serial:IN,Jps_Pos:IN,MM_P:OUT,MM_MoveType:OUT,MM_ToolNum:OUT,MM_Speed:OUT) (当 Jps_Pos=2 或者 4 时)
MM_Get_PlanJps(Serial:IN,Jps_Pos:IN,MM_J:OUT,MM_MoveType:OUT,MM_ToolNum:OUT,MM_Speed:OUT) (当 Jps_Pos=1 或者 3 时)
参数说明
参数 | 描述 |
---|---|
输入参数 |
|
Serial |
指定要转存第几个路径点。 |
Jps_Pos |
与 获取视觉移动规划数据或自定义数据 指令中的 Jps_Pos 所选值一致。 |
输出参数 |
|
MM_P |
位姿变量,用于保存指定路径点对应的 TCP 数据。 |
MM_J |
关节角变量,用于保存指定路径点对应的关节角数据。 |
MM_MoveType |
变量,用于保存指定路径点对应的移动类型。1表示关节移动,2表示直线移动。 |
MM_ToolNum |
变量,用于保存指定路径点对应的末端工具编号。若值为-1,表示不使用末端工具。 |
MM_Speed |
变量,用于保存指定路径点对应的移动速度。 |
MM_UserData |
已定义的全局数组变量,用于保存指定路径点对应的自定义输出数据。目前数组大小为 50。 |
MM_Plan_Results |
已定义的全局数组变量,用于保存指定路径点对应的视觉移动规划数据。目前数组大小为 21。 |
MM_Plan_Results数组变量的具体内容如下表所示。
数据 | 说明 | 变量 |
---|---|---|
被抓取工件的标签 |
由10个整数组成,默认为10个0 |
MM_Plan_Results[1] ~ MM_Plan_Results[10] |
已抓取的工件总数 |
累计已抓取的工件数量 |
MM_Plan_Results[11] |
本次抓取的工件数量 |
本次抓取的工件数量 |
MM_Plan_Results[12] |
吸盘边角号 |
本次吸盘所使用的边角号 |
MM_Plan_Results[13] |
TCP偏移量 |
工件组中心相对于末端工具中心的XYZ偏移量 |
MM_Plan_Results[14] ~ MM_Plan_Results[16] |
工件组朝向 |
工件组与吸盘长边的朝向关系,0表示平行,1表示垂直 |
MM_Plan_Results[17] |
单个工件朝向 |
单个工件长边与吸盘长边的朝向关系,0表示平行,1表示垂直 |
MM_Plan_Results[18] |
工件组尺寸 |
本次抓取的工件组的长宽高 |
MM_Plan_Results[19] ~ MM_Plan_Results[21] |
示例
-
示例 1
MM_Get_PlanPose(1,4,XP1,MoveType,ToolNum,Pose_Speed)
该示例表示将收到的第一个路径点的 TCP 数据保存到位置变量 XP1 中,将移动类型保存到变量 MoveType 中,将末端工具编号保存到变量 ToolNum 中,将移动速度保存到变量 Pose_Speed 中,将自定义输出数据保存到数组变量 MM_UserData 中,将视觉移动规划数据保存到数组变量 MM_Plan_Results 中。
-
示例 2
MM_Get_PlanJps(1,3,JP1,MoveType,ToolNum,Pose_Speed)
该示例表示将收到的第一个路径点的关节角数据保存到位置变量 P1 中,将移动类型保存到变量 MoveType 中,将末端工具编号保存到变量 ToolNum 中,将移动速度保存到变量 Pose_Speed 中,将自定义输出数据保存到数组变量 MM_UserData 中,将视觉移动规划数据保存到数组变量 MM_Plan_Results 中。
获取 Mech-Vision “路径规划”步骤的结果
在启动 Mech-Vision 工程后,该指令用于获取 Mech-Vision 中“路径规划”步骤输出的免碰撞抓取路径。
在使用该指令时,Mech-Vision “输出”步骤的 端口类型 参数需要设置为“预定义(机器人路径)”。
参数说明
参数 | 描述 |
---|---|
输入参数 |
|
Job |
Mech-Vision 工程编号,可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。 |
Jps_Pos |
指定“路径规划”步骤返回的路径点的位姿类型。
|
输出参数 |
|
Pos_Num |
变量,用于保存该指令返回的路径点个数。 |
VisPos_Num |
变量,用于保存路径规划工具中设置的“视觉移动”路径点在整个路径中的位置。 例如,如果规划路径由以下组成:“定点移动_1”,“定点移动_2”,“视觉移动”,“定点移动_3”,则“视觉移动”位置为 3。 如果路径中无“视觉移动”,则该参数值为 0。 |
MM_Status |
变量,用于保存该指令返回的状态码。 |
读取Mech-Viz步骤参数值
该指令用于读取Mech-Viz工程中指定的步骤参数值。
参数说明
参数 | 描述 |
---|---|
输入参数 |
|
Get_id |
该参数为property_config文件中指定的 配置编号 字段。 |
输出参数 |
|
MM_Status |
整型变量,用于保存该指令返回的状态码。 |
Viz_Prop |
整型变量,用于保存返回的指定步骤的参数值,目前只支持返回INT整型值。 |
在Mech-Vision工具栏的 下,单击 属性配置,即可打开property_config文件。 |
在使用该指令前,用户需提前在property_config文件中指定步骤编号和参数名称对应的key名称,具体格式如下所示。
read, 配置编号, 步骤编号, key名称
read |
指定该行用于读取步骤参数值。 |
配置编号 |
指定一个唯一的编号,为正整数。一个配置编号只能用于读取一个步骤参数值。如果读取多个步骤参数值,请使用不同的配置编号。 |
步骤编号 |
指定将要读取的参数所属步骤的编号。 |
key名称 |
指定将要读取的参数名称对应的key名称。 |
|
property_config文件中可以设置多条read指令,但每条read指令的配置编号必须唯一。 |
设置Mech-Viz步骤参数值
该指令用于设置Mech-Viz工程中指定的步骤参数值。
参数说明
参数 | 描述 |
---|---|
输入参数 |
|
Set_id |
该参数为property_config文件中指定的 配置编号 字段。 |
输出参数 |
|
MM_Status |
整型变量,用于保存该指令返回的状态码。 |
在Mech-Vision工具栏的 下,单击 属性配置,即可打开property_config文件。 |
在使用该指令前,用户需提前在property_config文件中指定步骤编号、参数名称对应的key名称和参数值,具体格式如下所示。
write, 配置编号, 步骤编号, key名称, 参数值
write |
指定该行用于设置步骤参数值。 |
配置编号 |
指定一个编号(非唯一),为正整数。 |
步骤编号 |
指定将要设置的参数所属步骤的编号。 |
key名称 |
指定将要设置的参数名称对应的key名称。 |
参数值 |
指定将要设置的参数值。 |
|
示例
例如,property_config文件内容如下,1表示配置编号,3表示步骤编号,xOffset、yOffset和zOffset表示key名称,10表示xOffset对应的参数值,20表示yOffset对应的参数值,30表示zOffset对应的参数值。
write, 1, 3, xOffset, 10
write, 1, 3, yOffset, 20
write, 1, 3, zOffset, 30
机器人发送如下指令后,Mech-Viz会将xOffset、yOffset和zOffset对应的参数值分别设置为10、20和30。
mm_set_property(1,MM_Status)
该示例表示将xOffset、yOffset和zOffset对应的参数值分别设置为10、20和30,并将返回的状态码保存在MM_Status变量中。