Profinet 指令说明¶
101 指令——启动 Mech-Vision 工程¶
功能介绍¶
该指令启动 Mech-Vision 工程,用于执行相机拍照和视觉识别。
如果工程为 Eye In Hand 模式,该指令将把机器人拍照位姿传入工程。
该指令用于仅使用 Mech-Vision 的场景。
发送的指令参数¶
参数 |
描述 |
Vision_Proj_Num |
Mech-Vision 工程编号 |
Req_Pose_Num |
预期视觉点数量 |
Robot_Pose_Type |
机器人位姿类型 |
Robot_Pose_JPS / Robot_Pose_TCP |
机器人 JPs / 法兰位姿 |
Mech-Vision 工程编号
Mech-Vision 工程编号可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。
预期视觉点数量
期望从 Mech-Vision 得到的视觉点数量。视觉点信息包括视觉位姿及对应点云、标签、缩放等。
0
:从 Mech-Vision 工程取得识别结果中所有的视觉点。
大于 0 的整数
:从 Mech-Vision 工程取得识别结果中指定数量的视觉点。
如果视觉点总数小于该参数值,则取得识别结果中所有视觉点。
如果视觉点总数大于等于该参数值,则取得该参数指定数量的视觉点。
机器人位姿类型 、 机器人 JPs / 法兰位姿
机器人位姿类型 参数指定真实机器人的位姿将以何种形式传入 Mech-Vision,其取值范围为 0~3。
机器人 JPs / 法兰位姿 参数值取决于 机器人位姿类型 参数值。
下表为 Robot_Pose_Type 与 Robot_Pose_JPS 和 Robot_Pose_TCP 参数取值的关系及说明。
Robot_Pose _JPS
Robot_Pose _TCP
说明
适用场景
0
0, 0, 0, 0, 0, 0
0, 0, 0, 0, 0, 0
无需向 Mech-Vision 传入机器人位姿
工程为 Eye To Hand 模式。若 Mech-Vision 工程中使用“路径规划”步骤,则路径规划的起始点为路径规划工具中设置的 Home 点。
1
机器人当前关节角
机器人的当前法兰位姿
需要将机器人的关节角和法兰位姿传入 Mech-Vision
工程为 Eye In Hand 模式,除桁架机器人外的大多数机器人适用该设定。
2
0, 0, 0, 0, 0, 0
机器人的当前法兰位姿
需要将机器人的当前法兰位姿传入 Mech-Vision
工程为 Eye In Hand 模式,机器人无关节角数据,仅有法兰位姿数据(如桁架机器人)。
3
机器人路径规划起始点的关节角
0, 0, 0, 0, 0, 0
需要将机器人路径规划起始点的关节角传入 Mech-Vision
工程为 Eye To Hand 模式,并且 Mech-Vision 工程中存在“路径规划”步骤,且需要从机器人端设置“路径规划”步骤的起始点。
注意
JPs 和法兰位姿的浮点数数据需乘 10000,再设置到 Robot_Pose_JPS 或 Robot_Pose_TCP 模块中。
102 指令——获取视觉目标点¶
该指令用在 101 指令——启动 Mech-Vision 工程 之后,用于获取 Mech-Vision 输出的视觉点,然后自动将视觉点转换为视觉目标点。
具体转换过程如下所示,即将视觉点包含的位姿转换为对应机器人 TCP。
将视觉点包含的位姿绕 X 轴旋转 180°。
识别对应机器人型号的参考坐标系定义是否涉及机器人基座高度,并相应增加垂直方向的偏置。
提示
102 指令单次接收视觉目标点的数量上限默认为 20。如需要获取的视觉目标点的数量大于 20,需多次执行该指令来获取所有所需的视觉目标点。
发送的指令参数¶
参数 |
描述 |
Command |
102 |
Vision_Proj_Num |
Mech-Vision 工程编号 |
Mech-Vision 工程编号
Mech-Vision 工程编号可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。
返回的数据参数¶
参数 |
描述 |
Status Code |
状态码 |
Send_Pose_Num |
视觉目标点数量 |
Send_Pose_Type |
位姿类型 |
Target_Pose |
此次获取的所有 TCP |
Target_Label |
此次获取的所有标签 |
状态码
若指令执行正常,则返回 1100 状态码;否则返回对应的错误码。
调用该指令时,若 Mech-Vision 未返回结果,则默认等待 10 秒。若发生超时,则返回超时错误状态码。
视觉目标点数量
执行该指令获得的视觉目标点数量。
位姿类型
该参数表示将 Mech-Vision 返回的视觉点中的目标物体位姿转换为相应的 TCP。
该参数的值默认为 2,表示位姿类型为 TCP。
此次获取的所有 TCP
单个 TCP 所含信息包括空间坐标 (XYZ)和方向欧拉角 (ABC)。
此次获取的所有标签
位姿对应的整数标签。如果在 Mech-Vision 工程中,标签为字符串,请在输出前用步骤 标签映射 将标签映射为整数。如工程中没有标签,则该参数为默认值 0。
注意
具体收发操作请参考 通信控制流程 。使用 Data_ready、Data_Acknowledge、Command_Complete 信号进行过程控制。
103 指令——切换 Mech-Vision 配方¶
切换 Mech-Vision 工程内的参数配方。
Mech-Vision 中步骤的参数设定可通过切换参数配方调整。
参数配方调整涉及的参数通常包括点云匹配模板、图像匹配模板、感兴趣区域、置信度阈值等。
注意
需要在执行 101 指令——启动 Mech-Vision 工程 之前使用该指令。
发送的指令参数¶
参数 |
描述 |
Command |
103 |
Vision_Proj_Num |
Mech-Vision 工程编号 |
Vision_Recipe_Num |
Mech-Vision 配方编号 |
Mech-Vision 工程编号
Mech-Vision 工程编号可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。
Mech-Vision 配方编号
Mech-Vision 工程中配方模板的编号,为正整数。单击
,进入参数配方编辑器。编号范围:1~99。
105 指令——获取 Mech-Vision “路径规划”步骤的结果¶
在调用 101 指令之后,使用该指令获取 Mech-Vision 中“路径规划”步骤输出的免碰撞抓取路径。
在使用该指令时,Mech-Vision “输出”步骤的 端口类型 参数需要设置为“预定义(机器人路径)”。
提示
在调用 105 指令前,请务必将 101 指令的 预期视觉点数量 设置为 0,以减少调用 105 指令的次数。若 101 指令的 预期视觉点数量 设置为 1,则每次调用 105 指令只会返回一个路径点,只有多次调用 105 指令才能接收全部路径点。
发送的指令参数¶
参数 |
描述 |
Command |
105 |
Vision_Proj_Num |
Mech-Vision 工程编号 |
Req_Pose_Type |
路径点位姿类型 |
Mech-Vision 工程编号
Mech-Vision 工程编号可在 Mech-Vision 工程列表窗口中查看,工程名称前的数字表示工程编号。
路径点位姿类型
该参数用于指定”路径规划“步骤返回的路径点的位姿类型。
1
:路径点的位姿将以机器人关节角(JPs)的形式返回。
2
:路径点的位姿将以机器人工具位姿(TCP)的形式返回。
返回的数据参数¶
参数 |
描述 |
Status Code |
状态码 |
Send_Pose_Num |
路径点数量 |
Send_Pose_Type |
位姿类型 |
Visual_Point_Index |
“视觉移动”位置 |
Target_Pose |
此次发送的所有路径点的位姿 |
Target_Label |
此次发送的所有路径点的标签 |
Target_Speed |
此次发送的所有路径点的速度 |
状态码
若指令执行正常,则返回 1103 状态码;否则返回对应的错误码。
路径点数量
该参数用于表示此次执行该指令返回的路径点个数,取值范围为 0~20。若获取的路径点数多于 20,请多次调用该指令。
位姿类型
与该指令发出的 “Req_Pose_Type” 值相同。
1
: JPs
2
: TCP
“视觉移动”位置
路径规划工具中设置的“视觉移动”路径点在整个路径中的位置。
例如,如果规划路径由以下组成:“移动_1”,“移动_2”,“视觉移动”,“移动_3”,则“视觉移动”位置为 3。
如果路径中无“视觉移动”,则该参数值为 0。
此次发送的所有路径点的位姿
三维坐标及欧拉角,或 JPs 关节角。类型由 105 指令中的路径点位姿类型决定。
此次发送的所有路径点的标签
位姿对应的整数标签。如果在 Mech-Vision 工程中,标签为字符串,请在“输出”步骤前使用 “标签映射” 步骤将标签映射为整数。如果工程中没有标签,则该参数为默认值 0。
此次发送的所有路径点的速度
路径规划工具中设置的速度值。
201 指令——启动 Mech-Viz 工程¶
用于既使用 Mech-Vision 又使用 Mech-Viz 的场景。该指令用于运行 Mech-Viz 工程,启动对应的 Mech-Vision 工程,Mech-Viz 基于 Mech-Vision 的视觉结果规划机器人的运动路径。
请在需要启动 Mech-Viz 工程中勾选 自动加载。
Mech-Center 安装目录 (tool/viz_project) 文件夹内保存有一些典型应用工程模板,用户可以在模板的基础上进行修改。
用于标准接口的 Mech-Viz 样例工程描述请见 标准接口用 Mech-Viz 样例工程。
发送的指令参数¶
参数 |
描述 |
Command |
201 |
Robot_Pose_Type |
机器人位姿类型 |
Robot_Pose_JPS / Robot_Pose_TCP |
机器人 JPs / 法兰位姿 |
机器人位姿类型 、 机器人 JPs / 法兰位姿
机器人位姿类型 参数指定真实机器人的位姿将以何种形式传入 Mech-Viz,其取值范围为 0~2。
机器人 JPs / 法兰位姿 参数值取决于 机器人位姿类型 参数值。
下表为 Robot_Pose_Type 与 Robot_Pose_JPS 和 Robot_Pose_TCP 参数取值的关系及说明。
Robot_Pose_JPS
Robot_Pose_TCP
说明
适用场景
0
0, 0, 0, 0, 0, 0
0, 0, 0, 0, 0, 0
无需向 Mech-Viz 传入机器人位姿,Mech-Viz 中仿真机器人将从初始位姿 JPs = [0, 0, 0, 0, 0, 0] 开始移动到第一个路径点。
工程为 Eye To Hand 模式。不推荐使用该设定。
1
机器人当前关节角
机器人的当前法兰位姿
需要将机器人的当前关节角和法兰位姿传入 Mech-Viz,Mech-Viz 中仿真机器人将从传入的关节角开始移动到第一个路径点。
工程为 Eye In Hand 模式时,推荐使用该设定。
2
机器人端自定义的关节角
0, 0, 0, 0, 0, 0
需要将机器人的一个示教点(非当前关节角)传入 Mech-Viz,用于在机器人处于拍照区域外时,提前触发 Mech-Viz 工程规划下一轮路径(如下图),Mech-Viz 中仿真机器人将从传入的示教点开始运动到第一个路径点。
工程为 Eye To Hand 模式时,推荐使用该设定。
Eye To Hand 模式下应将 Robot_Pose_Type 设为 2 的原因:
Eye To Hand 模式下,相机可在机器人回到拍照及抓取区域之前拍照,用于提前规划下一轮抓取路径,从而缩短节拍。
若此时将 Robot_Pose_Type 设为 1,即将机器人当前位姿发送给 Mech-Viz 仿真机器人,可能导致仿真机器人与真实机器人轨迹不一致,发生未预知的碰撞,造成危险。
即仿真机器人将直接从当前位姿移动至 Mech-Viz 中第一个移动步骤中设置的位姿,而真实机器人可能在移动至其他位姿后才移动至上述位姿。
所以应将 Robot_Pose_Type 参数设为 2。
202 指令——停止 Mech-Viz 工程¶
停止 Mech-Viz 运行。如果 Mech-Viz 工程不是死循环,或可以正常停止,则不需要使用该指令。
发送的指令参数¶
参数 |
描述 |
Command |
202 |
203 指令——选择 Mech-Viz 分支¶
该指令用于指定工程将沿哪个分支运行。分支机制通过 消息分支 步骤建立,该指令则通过指定该步骤的出口来指定分支。
在执行该指令前请先执行 201 指令——启动 Mech-Viz 工程 。
Mech-Viz 工程运行至 消息分支 步骤时,将等待该指令指定出口。
204 指令——设置移动索引¶
该指令用于设定步骤的索引参数值。该类步骤一般用于连续或单独指定的移动或其他操作。
带有索引参数的步骤包括“按序列移动”、“按阵列移动”、“自定义垛型”、“预设垛型”等。
在执行该指令前,请先执行 201 指令——启动 Mech-Viz 工程 。
发送的指令参数¶
参数 |
描述 |
Command |
204 |
Viz_Task_ID |
步骤编号 |
Viz_Task_Value |
索引值 |
步骤编号
该参数指定哪个步骤需要索引参数设定。
该参数值应为正整数,即待索引步骤的步骤编号。步骤编号可在步骤参数中读取。
索引值
下次执行此步骤时应设置的索引值。
发送该指令时,Mech-Viz 中的当前索引值将变为该参数值减 1。
当 Mech-Viz 项目运行到该指令指定的步骤时,Mech-Viz 中的当前索引值将增加 1,成为该参数的值。
205 指令——获取规划路径¶
在执行 201 指令——启动 Mech-Viz 工程 后,该指令用于获取 Mech-Viz 规划的路径。
在使用默认设置时,该指令每次最多只能获取 20 个规划的路径点,因此,若获取的路径点数多于 20,则可以多次调用该指令。
注解
如果工程中某个移动类步骤的路径点不应发送给机器人,请取消勾选该步骤参数中的“发送路径点”选项。
发送的指令参数¶
参数 |
描述 |
Command |
205 |
Req_Pose_Type |
路径点类型 |
路径点类型
该参数用于指定 Mech-Viz 将返回何种形式的路径点。
1
:路径点将以机器人关节角(JPs)的形式返回。
2
:路径点将以机器人工具位姿(TCP)的形式返回。
返回的数据参数¶
参数 |
描述 |
Status Code |
状态码 |
Send_Pose_Num |
路径点数量 |
Send_Pose_Type |
位姿类型 |
Visual_Point_Index |
“视觉移动”位置 |
Target_Pose |
此次发送的所有路径点的位姿 |
Target_Label |
此次发送的所有路径点的标签 |
Target_Speed |
此次发送的所有路径点的速度 |
状态码
若指令执行正常,则返回 2100 状态码;否则返回对应的错误码。
提示
调用该指令时,若 Mech-Viz 结果还未返回(正在运行中),Mech-Center 会等待 Mech-Viz 结果返回后再给机器人返回,默认等待 10s 超时,若发生超时,则给机器人返回超时错误。
路径点数量
该参数表示返回的路径点个数,取值范围为 0~20。 在使用默认设置时,该指令每次最多只能获取 20 个规划的路径点,因此,若获取的路径点数多于 20,则可以多次调用该指令。
位姿类型
与该指令发出的 “Req_Pose_Type” 值相同。
1
: JPs
2
: TCP
“视觉移动”位置
“视觉移动”路径点在整个路径中的位置。
例如,如果规划路径由以下步骤组成:“移动_1”,“移动_2”,“视觉移动”,“移动_3”,则“视觉移动”位置为 3。
如果路径中无“视觉移动”,则该参数值为 0。
此次发送的所有路径点的位姿
三维坐标及欧拉角,或 JPs 关节角。类型由 205 指令中的路径点类型决定。
此次发送的所有路径点的标签
位姿对应的整数标签。如果在 Mech-Vision 工程中,标签为字符串,请在输出前使用步骤 标签映射 将标签映射为整数。如果工程中没有标签,则该参数为默认值 0。
此次发送的所有路径点的速度
移动类步骤参数中的非零速度参数百分数值。
注意
位姿的详细收发操作请参考 通信控制流程 。使用 Data_ready、Data_Acknowledge、Command_Complete 信号进行过程控制。
206 指令——获取 DO 信号列表¶
该指令用于获取规划的 DO 信号列表。DO 信号列表用于控制多个工具或吸盘分区。
执行该指令前,需要先执行 205 指令 获取 Mech-Viz 规划路径。
请根据模板工程来部署 Mech-Viz 工程,并在工程中设置对应的吸盘配置文件。模板工程为 Mech-Center 安装目录 (tool/viz_project) 下的 suction_zone 工程。
在工程的 设置多个 DO 步骤的参数中:
发送的指令参数¶
参数 |
描述 |
Command |
206 |
返回的数据参数¶
参数 |
描述 |
Status code |
状态码 |
DO List |
DO 信号列表 |
状态码
若指令执行正常,则返回 2102 状态码;否则返回对应的错误码。
DO 信号列表
返回的数据参数末尾共有 64 个 DO 信号值,为整数。
DO 信号值范围:0~999。
占位值:-1。
501 指令——向 Mech-Vision 中传入物体尺寸¶
该参数用于往 Mech-Vision 工程中动态传入物体尺寸。启动 Mech-Vision 工程前请先确认物体尺寸。
Mech-Vision 工程中应有 读取物体尺寸 步骤。该步骤参数 从参数读取物体尺寸 应设定为 True
。
502 指令——向 Mech-Viz 中传入 TCP¶
该指令用于往 Mech-Viz 工程中动态传入机器人 TCP。读取机器人 TCP 的步骤为 外部移动。
请基于模板工程部署 Mech-Viz 工程。模板工程路径为 Mech-Center 安装目录下 tool/viz_project/outer_move
。
请将 外部移动 步骤放在工作流程中合适的位置。
该指令需在执行 201 指令——启动 Mech-Viz 工程 之前执行。
901指令——获取软件状态¶
该指令用于检查软件运行状态(Mech-Vision、Mech-Viz、Mech-Center)。
目前该指令只支持检查 Mech-Vision 是否可以开始运行工程。
发送的指令参数¶
参数 |
描述 |
Command |
901 |
返回的数据参数¶
状态码
系统自检状态。 1101 状态码为“Mech-Vision 工程已就绪”;其他状态码为 “Mech-Vision 工程未就绪”。目前该指令只能用于检查 Mech-Vision 工程是否已就绪。