第 1 步:机器人与工控机建立 Socket 连接。此处的 IP 地址为工控机的 IP 地址,需与机器人 IP 位于同一网段。
第 2 步:获取机器人当前关节角,并保存至 current_jps 变量。
第 3 步:获取机器人当前法兰位姿,并保存至 current_fpose 变量。
第 4 步:发送运行 Mech-Vision 工程的指令,具体参数设置可参考 101 指令 。
第 5 步:接收 101 指令返回的状态码,并保存至 res 变量。
第 6 步:发送获取 Mech-Vision 规划路径的指令,具体参数设置可参考 105 指令 。
第 7 步:接收 105 指令返回的数据,并保存至 res 变量。
第 8 步:将第 7 步接收到的数据由字符串形式转换为数组形式,并保存至 vis_recv 变量。
第 9 步:打印日志。
第 10 步:判断 vis_recv 下标为 1 的值是否为 1103。1103 表示成功获取 Mech-Vision 规划路径。
第 11 步:直线运动到第一个路径点。
节卡直线运动需要传入工具位姿值,关节运动需要传入关节值。