SCARA机械手培训手册

Size: px

Start display at page:

Download "SCARA机械手培训手册"

有黄
3 years ago
Views:

1 TURIN ROBOTICS SCARA 机械手培训手册江苏图灵智能机器人有限公司版本 V1.0

2 目录一. 关于机械手的基础知识机械手主要机构机械手坐标系机械手的手臂姿势机械手的负载... 5 二. 关于机械手的指令说明运动指令变量操作... 6 三. 工艺介绍码垛工艺跟踪工艺四. 关于后台后台使用网络脚本设计五. 网络命令模块 TCP/IP 通讯设计命令包格式命令介绍六. TURIN SCARA 机械手视觉应用程序案例项目案例

3 一. 关于机械手的基础知识 1. 机械手主要机构 2. 机械手坐标系 2.1 世界坐标 ( 直角坐标 ) 图 1-1 1: 前臂 2: 末端法兰 3: 后臂 4: 底座 5: 航插 6: 电缆图 1-1 XY 方向图 1-2 Z 方向世界坐标系是系统默认的坐标系, 其坐标原点和坐标轴的指向在出厂时已经设置好, 示教器界面当前位置显示的是丝杆末端的平面中心 2.2 关节坐标图 1-5 当前坐标系设定为关节坐标系时, 按下 J1-J4 操作按键, 示教器操作机器人的 4 个轴正向负向运动 3

图 1-6 表 1-1 SCARA 机械手各轴转动范围各轴转动范围型号 J1 轴 J2 轴 J3 轴 J4 轴 SCARA ±140 ±140 150mm ±360 2.3 用户坐标用户坐标系的设定 (3 点法 ) 1. 确定需要的用户坐标系 2. 将带有操作工具的机器人移动到坐标系的原点, 并记录该点 3.

4 图 1-6 表 1-1 SCARA 机械手各轴转动范围各轴转动范围型号 J1 轴 J2 轴 J3 轴 J4 轴 SCARA ±140 ± mm ± 用户坐标用户坐标系的设定 (3 点法 ) 1. 确定需要的用户坐标系 2. 将带有操作工具的机器人移动到坐标系的原点, 并记录该点 3. 将带有操作工具的机器人移动到坐标系 X 轴上任意一点, 并记录该点 4. 将带有操作工具的机器人移动到 XY 平面内属于第一象限的任意一点, 并记录该点 5. 保存计算结果 2.4 工具坐标坐标系定义在工具上, 由用户自己定义, 一般将工具的有效方向定义为工具坐标系的 Z 轴方向,X 轴 Y 轴方向按右手定则定义图 1-7 工具示意图 4

5 TCP 标定方式 : 1. 检查机器人零位 DH 减速比这些参数的准确性直接影响 TCP 的精度 2. 移出 2 轴零位, 避开奇异点, 将 RZ 调整至 0 弧度后工具尖端对准顶针尖端 ( 从这时起顶针便不可移动 ), 记录下此时机器人直角坐标 (X1,Y1) 3. 在直角运动模式下, 将 RZ 调整至 3.14 弧度后, 再次对准顶针尖端, 记录下此时机器人直角坐标 (X2,Y2) 4. 计算 = X2 X1 2 x,y 即工具坐标参数, 填入工具坐标系 3. 机械手的手臂姿势 = Y2 Y1 2 图 1-8 左手姿态和右手姿态机械手分为左手姿态和右手姿态作业时, 其在某位置的姿态应尽可能跟示教时的姿态一致否则, 会产生位置上的轻微偏移或者在意想不到的路径上运动 4. 机械手的负载图 1-9 机械手的负载曲线 SCARA 机器人加载的负载必须符合 SCARA 机器人负载图, 负载的质量和自身惯量在各种情况下都要确认超载将会使电机减速机过载, 缩短机器人使用寿命, 严重情况可能损坏机器人 5

6 二. 关于机械手的指令说明 1. 运动指令通常运动指令记录了位置数据运动类型和运动速度运动类型指定了在执行时示教点之间的运动轨迹机器人一般支持 3 种运动类型 : 关节运动 (MOVJ) 直线运动(MOVL) 圆弧运动(MOVC) 添加运动指令需要按使能开关将驱动器使能注意 : 除非特殊需要, 否则加速度需要跟速度设一样的百分比值! 1.1 关节运动类型关节运动类型的特点是速度最快路径不可知, 因此, 一般此运动类型运用在空间点上, 并且在自动运行程序之前, 必须低速检查一遍, 观察机器人实际运动轨迹是否与周围设备有干涉 1.2 直线运动类型当机器人需要通过直线路径运动到当前示教点时, 采用直线运动类型 1.3 圆弧运动类型当机器人需要通过圆弧路径运动到当前示教点时, 采用圆弧运动类型圆弧运动类型对应的运动指令为圆弧运动 ( 英文指令为 MOVC) 圆弧运动时需要三个运动点, 从当前点, 经过第一点 ( 辅助点 ), 到达第二点 ( 终点 ) 2. 变量操作 2.1 变量说明 1. 变量类型控制系统中有三种类型变量可以使用, 分别为数字变量 ( 浮点数 ), 字符变量 (1024 字节 ), 和坐标点变量 ( 分别保存空间和关节, 即两者间可以不存在运动学关系 ) 2. 变量作用域准确的说, 系统中有三种作用域变量, 分别为系统变量, 全局变量和文件变量系统变量 : 系统变量生存周期随系统启 / 停而被创建和销毁系统变量是整个系统内的共用变量, 即运动脚本与后台脚本程序可以同时使用的变量系统变量不会因为哪个程序的启停而被系统初始化即除非脚本或网络 ( 如 tcp server) 刻意修改, 否则系统变量永远都不会被系统更改全局变量 : 全局变量的生存周期是随本次脚本程序的启停而创建和销毁全局变量在本次启动的脚本内共用即子文件与主文件之间共用其他地方 ( 如前后台之间, 网络等都 ) 无法访问该变量文件变量 : 也叫局部变量, 它的生存周期与全局变量一致, 不同在于, 它无法在主文件与各子文件之间共用 3. 变量的定义预定义的系统变量 : 1)V0~V999:1000 个系统数字变量, 需要注意的是, 为了书写方便,V0 V00,V000 表示同一个变量, 再如 V011 与 V11 也是同一个变量, 所有系统预设变量都如此, 不过为了 6

看起来舒服, 手动编程时候请尽可能使用 V000 的格式 2)S0~S999:1000 个系统字符变量 3)P0~P999:1000 个系统坐标点变量预定义的文件变量 : 1)FV0~FV999:1000 个文件数字变量 2)FS0~FS999:1000 个文件字符变量 3)FP0~FP999:1000 个文件坐标点变量注 : 之前有说过, 文件变量的作用域是单个文件, 即使名字相同,

7 看起来舒服, 手动编程时候请尽可能使用 V000 的格式 2)S0~S999:1000 个系统字符变量 3)P0~P999:1000 个系统坐标点变量预定义的文件变量 : 1)FV0~FV999:1000 个文件数字变量 2)FS0~FS999:1000 个文件字符变量 3)FP0~FP999:1000 个文件坐标点变量注 : 之前有说过, 文件变量的作用域是单个文件, 即使名字相同, 即每主文件与每个子文件都有 FV,FS,FP 等各 1 千个 ( 共 3 千变量 ), 但它们之间也是无法共用的相同变量使用各自的内存 4. 变量监视可以实时监控系统中变量内容的变化当相应变量自动存储为开时, 系统时刻监视脚本中已经使用变量, 待其值发生变化时, 会立刻存储到文件以便下次启动该脚本时使用已经变化的值注 : 因为目前硬件系统并没有断电保护措施, 因此当程序运行时, 异常断电行为 ( 如拧电源 ) 有可能会出现刚刚更改的值未能即使存储到文件的现象这点需要特别注意 7

8 2.2 关于数字 V 变量和使用 V 变量存储数字, 无论当做坐标来执行运动, 或者进行逻辑判断均可, 使用十分简单, 与 C 基本一致, 下面举出几个案例 1. 赋值 2. 自增 2.3 关于坐标点 P 变量使用坐标点读取修改在一些场合非常实用, 下面举出一些案例供参考 1. 获取当前位置后修改为常量 2. 获取当前位置后修改为变量 3. 读取出当前坐标点变量 4. 典型反面教材注释 :1. 修改的 P 变量存储的 P 变量执行运动的 P 变量之间变量名要一致 2. 修改了直角坐标要用直线指令来执行运动, 反之亦然 8

9 3. 逻辑指令 3.1 跳转若需跳转到标记 0, 那么程序中必须有且只能有一个标记 0 与其对应 3.2IF 条件语句与 C 语言中 If 语句用法一致, 为嵌套结构使用 If 语句时, 必须有 EndIf 做结尾,EndIf 和 ElseIf 不可单独使用 9

10 3.3WHILE 循环语句本例中 (V950 < V951) 为循环条件表达式,While 与 ENDWHILE 之间语句为循环体只要满足 V950 < V951, 循环体语句便进行循环 3.4 关于 IO 的操作行扩展标准状态下有 12 组输入输出, 可供外部使用的有 6 组输入 10 组输出, 如需增加可进程序中可按照类似此种方式使用, 用来控制继电器电磁阀等吸合或进行一些简单的信号交互非常方便 10

11 三. 工艺介绍 1. 码垛工艺 1. 工艺设置在工艺 -> 码垛工艺 -> 码垛设置里设置码垛参数 a. 先设置正确的行数, 列数和层数 b. 设置放件原点坐标, 示教到上图 a 点位置, 然后点击从当前位置复制记录放件原点坐标 c. 依次记录上图 b, c, d 三点的坐标 ( 视情况不是三个点的坐标都要记录, 比如只有一行, 则 c 点无需记录 ; 如果只有一层, 则 d 点无需记录 ) 2. 程序编写 1) 一个码垛 # 先运动到任一码垛上方点, 获取该点坐标 ( 主要是得到夹具姿态 ) MJ( ,11.798,2.627,-1.249,60.112,69.218,0.000,0.000,0.000,50,50,0,00,00)## 关节运动速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 GETCURPOINT(P1)## 获取当前位置到 P1 V0 = 0 ##V0 等于 0( 如果要从中间开始码垛, 把 0 修改为中间的值 ) 11

12 L0## 标记 0 PALLETINIT(01)## 码垛初始化参数 01 PALLETGETCURPOS(V0,V1,V2,V3)## 计算码垛放件点坐标当前执行垛数 V0 X 给 V1 Y 给 V2 Z 给 V3( 计算当前码垛放件点的 X,Y,Z 坐标 ) V4 = V ##V4 等于 V3 加 100 POINTSET(P1,2,1,V1)## 坐标点 P1 直角 X 改为 V1 POINTSET(P1,2,2,V2)## 坐标点 P1 直角 Y 改为 V2 POINTSET(P1,2,3,V4)## 坐标点 P1 直角 Z 改为 V4(P1 为放件准备点, 在放件点上方 100mm) MLPC(P1,50,50,0,00,00)## 直线 PC 运动 P1 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 POINTSET(P1,2,3,V3)## 坐标点 P1 直角 Z 改为 V3( 此时 P1 为放件点 ) MLPC(P1,50,50,0,00,00)## 直线 PC 运动 P1 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 SLEEP(1000)## 延时 1000 毫秒 POINTSET(P1,2,3,V4)## 坐标点 P1 直角 Z 改为 V4( 再运动到放件点上方 ) MLPC(P1,50,50,0,00,00)## 直线 PC 运动 P1 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 V0 += 1 ##V0 加等于 1( 码垛计数加 1, 准备处理下一个码垛点 ) IF(V0 > 49) ## 总垛数为 49 RETURN ## 当前码垛处理完毕程序结束 ELSE GOTO L0## 跳转到 L0 ENDIF 2) 两个码垛 # 先运动到任一码垛上方点, 获取该点坐标 ( 主要是得到夹具姿态 ) MJ( ,11.798,2.627,-1.249,60.112,69.218,0.000,0.000,0.000,50,50,0,00,00)## 关节运动速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 GETCURPOINT(P1)## 获取当前位置到 P1 MJ(18.996,11.798,2.627,-1.249,60.112,69.218,0.000,0.000,0.000,50,50,0,00,00)## 关节运动速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 GETCURPOINT(P2)## 获取当前位置到 P2 V0 = 0 ##V0 等于 0 V0 为码垛 1 计数 V10 = 0 ##V10 等于 0 V10 为码垛 2 计数 L0## 标记 0 PALLETINIT(01)## 码垛初始化参数 01 PALLETGETCURPOS(V0,V1,V2,V3)## 计算码垛放件点坐标当前执行垛数 V0 X 给 V1 Y 给 V2 Z 给 V3( 计算当前码垛放件点的 X,Y,Z 坐标 ) V4 = V ##V4 等于 V3 加 100 POINTSET(P1,2,1,V1)## 坐标点 P1 直角 X 改为 V1 POINTSET(P1,2,2,V2)## 坐标点 P1 直角 Y 改为 V2 POINTSET(P1,2,3,V4)## 坐标点 P1 直角 Z 改为 V4(P1 改为放件准备点上方 100mm) MLPC(P1,50,50,0,00,00)## 直线 PC 运动 P1 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 12

13 POINTSET(P1,2,3,V3)## 坐标点 P1 直角 Z 改为 V3( 此时 P1 为放件点 ) MLPC(P1,50,50,0,00,00)## 直线 PC 运动 P1 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 SLEEP(1000)## 延时 1000 毫秒 POINTSET(P1,2,3,V4)## 坐标点 P1 直角 Z 改为 V4( 再运动到放件点上方 ) MLPC(P1,50,50,0,00,00)## 直线 PC 运动 P1 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 V0 += 1 ##V0 加等于 1( 码垛计数加 1, 准备处理下一个码垛点 ) IF(V0 > 49) ## 总垛数为 49 RETURN ## 当前码垛处理完毕程序结束 ELSE GOTO L1## 跳转到 L1 执行码垛 2 ENDIF L1## 标记 1 PALLETINIT(02)## 码垛初始化参数 02 PALLETGETCURPOS(V10,V11,V12,V13)## 计算码垛放件点坐标当前执行垛数 V10 X 给 V11 Y 给 V12 Z 给 V13( 计算当前码垛放件点的 X,Y,Z 坐标 ) V14 = V ##V14 等于 V13 加 100 POINTSET(P2,2,1,V11)## 坐标点 P2 直角 X 改为 V11 POINTSET(P2,2,2,V12)## 坐标点 P2 直角 Y 改为 V12 POINTSET(P2,2,3,V14)## 坐标点 P2 直角 Z 改为 V14(P2 为放件准备点, 在放件点上方 100mm) MLPC(P2,50,50,0,00,00)## 直线 PC 运动 P2 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 POINTSET(P2,2,3,V3)## 坐标点 P2 直角 Z 改为 V13( 此时 P2 为放件点 ) MLPC(P2,50,50,0,00,00)## 直线 PC 运动 P2 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 SLEEP(1000)## 延时 1000 毫秒 POINTSET(P2,2,3,V4)## 坐标点 P2 直角 Z 改为 V4( 再运动到放件点上方 ) MLPC(P2,50,50,0,00,00)## 直线 PC 运动 P2 速度 =50 加速度 =50 平滑 =0 工具 =00 用户 =00 V10 += 1 ##V10 加等于 1( 码垛计数加 1, 准备处理下一个码垛点 ) IF(V10 > 49) ## 码垛 2 总垛数为 49 RETURN ## 当前码垛处理完毕程序结束 ELSE GOTO L0## 跳转到 L0 执行码垛 1 ENDIF 13

14 2. 跟踪工艺 1. 硬件连接下图为图灵编码器采集卡板间接线图 PWR: V100 型号电源 5VDC V200 型号电源 24VDC XP1,XP2: 增量型编码器接口定义如上图注意 : 因为编码器采用增量型, 所以要保证采集进来的信号保持增大, 若为减小可将 A 和 B 两根线互换位置将网线从伺服驱动器第六轴 (SCARA 第四轴 )EtherCAT OUT 接到采集卡 T1, 将采集卡作为最后一个从站当使用 1 个编码器时, 使用 XP1 视觉工控机网口与机器人的网口相连,( 若网口数量不够, 可通过交换机相连 ) 2. 跟踪工艺参数设置 14

说明 : 1 工作区开始位置: 当被检测物移动到该位置时, 机器人才开始动作 2 工作区结束位置: 当被检测物移动出该位置时, 机器人放弃当前跟踪物 3 光电开关位置: 检测开关的位置以上位置均以跟踪原点坐标为零, 传送带运动方向为正 4 传送带移动比: 在启动文件夹 bin/ 目录下敲代码 : sudo./control halcmd show pin motmod.

15 说明 : 1 工作区开始位置: 当被检测物移动到该位置时, 机器人才开始动作 2 工作区结束位置: 当被检测物移动出该位置时, 机器人放弃当前跟踪物 3 光电开关位置: 检测开关的位置以上位置均以跟踪原点坐标为零, 传送带运动方向为正 4 传送带移动比: 在启动文件夹 bin/ 目录下敲代码 : sudo./control halcmd show pin motmod.convey* 终端中会显示 <==SERVO_CONVEY_POS1 即为硬件 XP1 的当前脉冲数将传送带移动一段距离, 实际测量出距离长度, 在敲一次该命令, 得到第二个脉冲数两次脉冲数的差除以距离即为该比例注意单位为脉冲数 / 毫米 5 光电触发输入: 光电开关接入的 DI 号 6 同时工作工件: 当需要触发两次有效时, 填写 2. 7 跟踪原点坐标: 可将机器人移动到合适位置可从当前位置复制过来 8 跟踪方向向量: 在传送带运动方向上去两个点, 以确定传送带运动方向如上图所示, 可以现将机器人示教到 A 点, 点击方向点 1 在移动到 B 点, 点击方向点 2 再点计算即可 3. 指令说明 CONVEYTRACKSTART(X1) 传送带跟踪开始 X10,1 启动第几条传送带, 目前最多 2 条 CONVEYTRACKENABLE(X1,X2,X3) 传送带后台运行使能, 一旦停止下来会全部清除 X1 0,1 启动第几条传送带后台运行, 目前最多 2 条 X2 把几号 IO 映射给这条传送带 X3 这条传送带每次输入几个触发 CONVEYTRACKEND() 传送带跟踪结束, 会等待减速至停下来才执行下条指令 CONVEYTRACKWAIT (X1) 传送带等待有物料进入拾取区 X10,1 启动第几条传送带, 目前最多 2 条 CONVEYTRACKSET (X1,X2) 传送带设置指令, 需要在启动跟踪之前设置, 让传送带知道自己如何运行 X1 当前传送带设定为第几号传送带保存的参数 (X1-1 对应界面工艺号 ) X2 当前传送带加速度的百分比 15

16 4. 程序案例 ML(25.991,80.909, ,-1.735,0.000,0.000,0.000,0.000,0.000,100,100,0,02,00)## 直线运动速度 =100 加速度 =100 平滑 =0 工具 =02 用户 =00 L0## 标记 0 CONVEYTRACKENABLE(0,7,1)## 跟踪使能 (0,7,1) CONVEYTRACKSET(0,5)## 跟踪设置 (0,5) CONVEYTRACKWAIT(0)## 跟踪等待 (0) CONVEYTRACKSTART(0)## 传送带跟踪开始参数 00 ML(18.164,90.364, , ,0.000,0.000,0.000,0.000,0.000,100,100,0,02,00)## 直线运动速度 =100 加速度 =100 平滑 =0 工具 =02 用户 =00 IOOUT(02,1)##I/O 输出 02=ON ML(18.164,90.364, , ,0.000,0.000,0.000,0.000,0.000,100,100,0,02,00)## 直线运动速度 =100 加速度 =100 平滑 =0 工具 =02 用户 =00 ML(18.164,90.364, , ,0.000,0.000,0.000,0.000,0.000,100,100,0,02,00)## 直线运动速度 =100 加速度 =100 平滑 =0 工具 =02 用户 =00 CONVEYTRACKEND()## 传送带跟踪结束 MJ( ,69.025, , ,0.000,0.000,0.000,0.000,0.000,100,100,0,02,00)## 关节运动速度 =100 加速度 =100 平滑 =0 工具 =02 用户 =00 IOOUT(02,0)##I/O 输出 02=OFF SLEEP(200)## 延时 200 毫秒 MJ( ,69.023, , ,0.000,0.000,0.000,0.000,0.000,100,100,100,02,00)## 关节运动速度 =100 加速度 =100 平滑 =100 工具 =02 用户 =00 GOTO L0## 跳转到标记 0 16

17 四. 关于后台 1. 后台使用 1.1. 后台程序编辑新系统设计与开发还在进行中其中后台程序的编辑器需要使用外部编辑工具编辑.txt 文件编辑好以后拷贝到 /home/thinkrob/.turin/backprogram 文件夹下拷贝方式有两种,1 是使用 cp( 命令 ),2 是使用文件管理器 1.2. 后台程序配置监视 / 控制 -> 后台程序 -> 启停配置下可以配置 16 组后台程序开关 : 开关是总开关, 即是否启用本后台程序线程运动程序 : 运动程序可以控制后台程序的启停状态当后台程序线程设定了运动程序时, 系统会在运动程序运行时启动后台程序而当运动程序停止时停止后台程序, 即后台程序与运动程序同步启停当未设置运行程序时, 后台程序会随系统启停而启停后台程序 : 指明本后台程序线程运行的主后台程序 1.3. 后台程序编写后台程序与运动程序在执行时有所不同后台程序会被系统反复调用的如有一条自增指令 V0++ 该指令在作为运动程序执行时仅自增一次而在后台程序中会不断被调用, 也就是不断自增因此后台程序运行 V0++ 与运动程序执行 WHILE(1):V0++:ENDWHILE 效果一致当然在后台程序中执行 WHILE(1):V0++:ENDWHILE 也是允许的 17

18 2. 网络脚本设计 2.1 网络通讯函数介绍 1. int SocketServerInit(int) 功能 : 初始化网络服务器, 参数 1: 端口号返回值 : 执行成功返回服务器监听 socket id, 即套接字失败返回 int SocketServerAccept(int) 功能 : 监听客户端连接参数 1:socket id 返回值 : 执行成功返回客户端 socket id, 失败返回 int SocketClientInit(string,int) 功能 : 连接到服务器参数 1:ip 地址参数 2: 端口号返回值 : 成功返回客户端 socket id, 失败返回 voidsocketclose(int) 功能 : 关闭套接字参数 1:socket id 返回值 : 无 5. int SocketWrite(int,string) 功能 : 发送数据参数 1:socket id 参数 2: 字符串, 发送长度为字符串长度, 注意不带 \0 返回值 : 成功返回发送长度, 失败返回负数 6. int SocketWrite(int,string,int) 与 5 不同, 可以指定发送的长度, 在参数 3 7. int SocketRead(int,string,int) 功能 : 接收数据参数 1:socket id 参数 2: 存储缓冲区 ( 字符串变量 ) 参数 3: 读取长度, 目前最大 1024, 给更大值也无济于事返回值 : 成功返回读取长度, 失败返回 0 或负数注意, 这是一个阻塞函数, 除非出错, 否则会一直等待适合接收握手报文 8. int SocketReadLine(int,string,int) 功能 : 读取一行字符串参数 1:socket id 参数 2: 存储缓冲区 ( 字符串变量 ) 参数 3: 超时时间返回值 : 成功返回读取长度, 失败, 超时返回 0, 网络异常返回负数设计细节 : 所有网络接口均使用非阻塞套接字实现, 如 SocketRead 与 SocketReadLine 也是如此, 所有的阻塞现象都是脚本模拟出来的因此并不会影响其他脚本执行网络收发缓冲区暂时设定为 4M 大小 18

19 2.2 其他相关函数 1 即使对于脚本来说, 网络通讯也总是作为一个基础功能来用最终功能还是需要一些数据处理函数来完成控制器中支持的数据 ( 主要就是字符串 ) 处理函数还很少先介绍几个 1 格式化类型函数 : 1)Sprintf: 不多说了, 与 C 基本一致 2)StrToDig: 将字符串变量转为数字变量 3)DigToStr: 将数字变量转为字符串变量 4)Replace: 字符串切割并重组函数其使用了正则表达式, 对于不熟悉正则表达式来讲是一个比较烧脑的函数, 有两个原型 void Replace(string,string,string,string) void Replace(string,string,string,digital) 功能, 将一个输入字符串根据正则表达式来分割, 并根据新的格式生成新的字符串参数 1: 输入字符串, 即要分割的字符串参数 2: 正则表达式, 即分割规则参数 3: 重组表达式 : 即重组规则参数 4: 存储处理结果, 可以是字符串或数字变量, 以后计划加入坐标点变量返回值 : 无, 处理失败参数 4 得不到结果简单介绍一下这个函数的使用假如有字符串 , 想给它改成 X=4.5 Y=-5.98 Z=+7.69,Replace 就能做到写法是 Replace( , (.*) (.*) (.*), X=\\1 Y=-\\2 Z=\\3,S1) 解释一下, 参数 2 中的任意一个 (.*) 可以截取任意长度的任意字符, 多说点, 提取浮点数的话这样写是不严谨的写成 ([+-]?(\\d.\\d \\d)) 会更严谨点既然是例子就写的简单点吧我们的目的是使用 3 个 (.*) 来截取参数一中的每一个浮点数参数 1 中每一个浮点数之间使用空格隔开因此我们使用 (.*) (.*) (.*) 这样的表达式来切割参数 1 参数 3 的 \\+ 数字的写法是表示引用参数 2 的哪一组括号 ( 切割结果 ) 括号的顺序是从左往右查找先出现的左括号 ( 如 ((a)b), 那么括号 2 是 ab, 括号 2 是 a ) 注意例子中引用括号时是从 1 开始的不过 \\0 也是有意义的, 它表示整个参数 1, 即输入字符串如果匹配成功, 结果会存储在变量 S1 中值得一提的是, 这个函数也可以在运动文件中使用, 稳定性有待长期运行测试 2, 切割函数 :RegScanfD 与 RegScanfS, 末尾字符 D 代表切割成数字, 末尾字符 S 代表切割成字符串, 定义如下 : int RegScanfD(string,string...) int RegScanfS(string,string...) 这是一个变长函数参数 1: 输入字符串参数 2: 正则表达式参数 3~n: 存储括号 0~n 的结果返回值 : 执行成功返回 0, 错误返回 -1 与网络参数一样, 该函数只能在后台中使用举例 : 继续沿用 Replace 的字符串, 这次目的是把中的三个浮点数放到变量 V1,V2,V3 中 19

20 写法是 :RegScanfD( , (.*) (.*) (.*),0,V1,V2,V3) 参数 1 与参数 2 前面已经解释过了, 我们知道括号 1~3 存储了三个浮点数我们还知道括号 0 存存储整个参数 1 那么 RegScanf 的变长参数部分就可以存储错号 0~3 的结果但是, 括号 0 的结果我们一般不需要用, 因此参数 3 可以给个 0,RegScanfS 的话需要给运行结果 :V1=4.5,V2=-5.98,V3= 其他相关函数 2 再列举两组函数吧 : 1. 获取关节位置 digital J1(), digital J1 digital J2(), digital J2 digital J3(), digital J3 digital J4(), digital J4 digital J5(), digital J5 digital J6(), digital J6 digital J7(), digital J7 digital J8(), digital J8 digital J9(), digital J9 2. 获取空间位置, 注意是世界坐标系 digital X(), digital X digital Y(), digital Y digital Z(), digital Z digital RX(), digital RX digital RY(),digital RY digital RZ(), digital RZ 每一行的两个函数作用一致, 注意后面的函数没有括号了, 很像变量, 以后这样的函数会更多 20

21 2.4 网络脚本用例 1. 机器人客户端程序 DEFINE ERR 1 # DEFINE WARN 2 # DEFINE INFO 3 # DEFINE DBG 4 # # 假设这是控制器接收视觉识别信息模块 WHILE(1) SLEEP(2000) DIGITAL ClientFD = 0 ClientFD = SocketClientInit(" ",8000) # 连接视觉服务器 IF(0 > ClientFD) PrintMsg(ERR,"SocketClientInit 执行失败 %d\n",clientfd) RETURN ENDIF PrintMsg(INFO," 已连接到服务器 %d\n",clientfd) WHILE(1) SLEEP(1000) # 2 秒触发一次 STRING Buf DIGITAL Size = 0 Size = SocketWrite(ClientFD,"GetPos") IF(0 > Size) PrintMsg(ERR,"SocketWrite 执行失败 %d\n",size) BREAK ENDIF DIGITAL Index = 0 WHILE(1) Size = SocketReadLine(ClientFD,Buf,1000) IF(0 > Size) PrintMsg(ERR,"SocketRead 执行失败 %d\n",size) BREAK ELSEIF(0 == Size) PrintMsg(INFO,"SocketRead 读取 %d 长度 \n",size) BREAK ENDIF DIGITAL RETVAL = 0 RETVAL = RegScanfD(Buf,"(.*) (.*) (.*)\\n?",0,v12,v13,v14) IF(0 > RETVAL) PrintMsg(ERR,"RegScanfD 执行失败 %d\n",retval) CONTINUE ENDIF PrintMsg(INFO,"Line %d: %.3f %.3f %.3f \n",++index,v12,v13,v14) ENDWHILE 21

22 ENDWHILE SocketClose(ClientFD) ENDWHILE 2. 机器人服务器程序 DEFINE ERR 1 # DEFINE WARN 2 # DEFINE INFO 3 # DEFINE DBG 4 # # 假设这是视觉服务器 DIGITAL ServerFD = 0 ServerFD = SocketServerInit(8988) IF(0 > ServerFD) PrintMsg(ERR,"SocketServerInit 执行失败 %d\n",serverfd) RETURN ENDIF PrintMsg(INFO," 视觉服务端已建立 %d\n",serverfd) WHILE(1) DIGITAL ClientFD = 0 PrintMsg(INFO," 等待客户端连接 \n") ClientFD = SocketServerAccept(ServerFD) IF(0 > ClientFD) PrintMsg(ERR,"SocketServerAccept 执行失败 %d\n",serverfd) RETURN ENDIF PrintMsg(INFO," 客户端已链接 %d\n",clientfd) WHILE(1) SLEEP(1) STRING Buf DIGITAL Size = 0 Buf = "" Size = SocketRead(ClientFD,Buf,0) # 等待客户端发送任意长度命令 IF(0 > Size) # 小于 0 一般表示连接断了 PrintMsg(ERR,"Server: SocketRead 执行失败 %d\n",size) BREAK ENDIF PrintMsg(INFO," 收到命令 %s\n",buf) IF(Buf!= "GetPos") # 只接受客户端发来的这个命令 Size = SocketWrite(ClientFD,"CmdErr") IF(0 > Size) PrintMsg(ERR,"SocketWrite 执行失败 %d\n",size) BREAK ENDIF CONTINUE # 返回等待下一个命令 22

$3f %.3f %.3f %.3f %.3f\n%.3f %.3f %.3f %.3f %.3f %.3f",X,Y,Z,RX,R Y,RZ,J1,J2,J3,J4,J5,J6) # 空间和关节都发过去了, 注意中间有个换行符, 这类似与视觉一起发两组坐标 Size = SocketWrite(ClientFD,Buf) IF(0 > Size)$

23 ENDIF Sprintf(Buf,"%.3f %.3f %.3f %.3f %.3f %.3f\n%.3f %.3f %.3f %.3f %.3f %.3f",X,Y,Z,RX,R Y,RZ,J1,J2,J3,J4,J5,J6) # 空间和关节都发过去了, 注意中间有个换行符, 这类似与视觉一起发两组坐标 Size = SocketWrite(ClientFD,Buf) IF(0 > Size) PrintMsg(ERR,"SocketWrite 执行失败 %d\n",size) BREAK ENDIF # 这个命令处理完了 ENDWHILE SocketClose(ClientFD) #BREAK 到这里, 应该关闭一下 ENDWHILE SocketClose(ServerFD) 3.TCP/IP 机器人做客户端, 前台脚本的写法变量解读 : V99 一旦与服务器通讯成功便会跳出循环 V101=1 会发送拍照指令该指令可在后台文件中修改, 改成想要发送的字符串 V12 先置为 -2 收到数据之后会置 1, 然后跳出循环 V100=1 发送机器人当前位置 23

24 五. 网络命令模块 1.TCP/IP 通讯设计本模块作为运动控制器的 TCP/IP 网络服务器端等待客户端连接本控制器支持多客户端连接同时接入连接数量为 Linux 允许的单进程最大网络连接数 ( 目前 256 个 ) 所有连接的网络客户端可以同时与运动控制器收发数据 TCP 服务器端端口号为 8527 高版本中在网络服务器界面设置 : 低版本中 2. 命令包格式在介绍命令格式之前, 有一点需要明确运动控制器是在 Linux 下开发使用的是 UTF-8 字符集 ( 如果需要支持中文的话 ) Linux 下换行不是 \r\n, 只是 \n, 这点需要特别注意控制器命令服务器命令包格式为 XML: <Cmd Name= XXX Status= Send /> 24

25 3. 命令介绍本模块暂时支持以下命令, 具体介绍如下 : 1) Login 命令, 后续的很多命令都要求先登录 <Cmd Name="Login" Status="Send"><Param UserName = "administrator" Password=" "/> 控制器返回 : <Cmd Name="Login" Status="Recv"> <Param Password=" " UserName="administrator"/> <Data>OK</Data> 2) Logout 命令 <Cmd Name="Logout" Status="Send"/> 控制器返回 : <Cmd Name="Logout" Status="Recv"> <Data>OK</Data> 3) GetCurPos 命令, 返回机器人当前的世界坐标值 <Cmd Name="GetCurPos" Status="Send"/> 控制器返回 : <Cmd Name="GetCurPos" Status="Recv"> <Data> ,0.0000, ,0.0000,0.0000,0.0000, , , </Data> 4) GetMotionStatus 命令, 获取机器人运行状态 25

26 <Cmd Name="GetMotionStatus" Status="Send"/> 控制器返回 : <Cmd Name="GetMotionStatus" Status="Recv"> <Data>motion status = stoped motion exec line = 1 </Data> Motion status 可能为 running,stopping,stopped,error Motion exec line 为脚本当前运行的行号 5) MotionBegin 命令, 用于启动运动机器人需在自动模式下才能启动运动 <Cmd Name="MotionBegin" Status="Send">  <Param FileName = "Main.txt" StartLine = "0"/> <Data>MoveL(xxxx)</Data>  控制器返回 : <Cmd Name="MotionBegin" Status="Recv"> <Param FileName="Main.txt" StartLine="0"/> <Data>OK</Data> 6) MotionEnd 命令, 停止运动 <Cmd Name="MotionEnd" Status="Send"/> 控制器返回 : <Cmd Name="MotionEnd" Status="Recv"> <Data>OK</Data> 26

27 7) LoadFile 命令, 让控制器加载 ( 打开 ) 某个脚本文件 <Cmd Name="LoadFile" Status="Send"> <Param FileName="Main.txt"/> 控制器返回 : <Cmd Name="LoadFile" Status="Recv"> <Param FileName="Main.txt"/> <Data>OK</Data> 8) ReadDir 命令, 读取控制器工作目录下某个目录下所有的文件列表 <Cmd Name="ReadDir" Status="Send"> <Param Filter="*.txt" Dir="./motion"/> 控制器返回 : <Cmd Name="ReadDir" Status="Recv"> <Param Filter="*.txt" Dir="./motion"/> <Data>0306.txt 0_welding.txt txt Program11.txt</Data> 9) ReadConfigFile 命令, 读取某个配置文件的某个键值 <Cmd Name="ReadConfigFile" Status="Send"> <Param FileName="joint.ini" Sec="JOINT1" Key="red" /> 控制器返回 : <Cmd Name="ReadConfigFile" Status="Recv"> 27

28 <Param FileName="joint.ini" Key="red" Sec="JOINT1"/> <Data>120</Data> 10) WriteConfigFile 命令, 写入某个配置文件的某个键值 <Cmd Name="WriteConfigFile" Status="Send"> <Param FileName="joint.ini" Sec="JOINT1" Key="red" Value="240" /> 控制器返回 : <Cmd Name="WriteConfigFile" Status="Recv"> <Param FileName="joint.ini" Key="red" Sec="JOINT1" Value="240"/> <Data>OK</Data> 11) LoadConfigFile 命令, 加载所有的配置文件 <Cmd Name="LoadConfigFile" Status="Send"/> 控制器返回 : <Cmd Name="LoadConfigFile" Status="Recv"> <Data>OK</Data> 12) ReadFile 命令, 读取某个文件的内容 <Cmd Name="ReadFile" Status="Send"> <Param FileName="./motion/Main.txt" /> 控制器返回 : <Cmd Name="ReadFile" Status="Recv"> <Param FileName="./motion/Main.txt"/> <Data>Sleep(8000)</Data> 28

29 13) WritFile 命令, 写入某个文件 <Cmd Name="WriteFile" Status="Send"> <Param FileName="./motion/Main.txt" /> <Data>Sleep(18000)</Data> 控制器返回 : <Cmd Name="WriteFile" Status="Recv"> <Param FileName="./motion/Main.txt"/> <Data>OK</Data> 14) RemoveFile 命令, 删除某个文件 <Cmd Name="RemoveFile" Status="Send"> <Param FileName="./motion/Main.txt" /> 控制器返回 : <Cmd Name="RemoveFile" Status="Recv"> <Param FileName="./motion/Main.txt"/> <Data>OK</Data> 15) Variable 命令, 读写变量 <Cmd Name="Variable" Status="Send"> <Data>V1-V10</Data> 控制器返回 : <Cmd Name="Variable" Status="Recv"> 29

30 <Data>V001 = V002 = V003 = V004 = V005 = V006 = V007 = V008 = V009 = V010 = </Data> 该命令支持其他的操作如下 :  <Cmd Name="Variable" Status="Send"> <Data>  S6:V2:S7  S0-S7:V9-V0  V101=-1.1:V100 =  S6 = " 157" : S8 = ""  V0-V100 = 0 S100-S1 = "no value"  <Cmd Name="Output" Status="Send"> <Data>DO0-DO11</Data> </Data> 30

31 六.TURIN SCARA 机械手视觉应用 1. 程序案例 1.1 单视觉定点抓取 (1) 后台配置 (2) 前台脚本 31

(3) 后台脚本 (4) 解析本例为定点抓取, 机器人做客户端, 视觉做服务器案例中后台脚本只展示了接收数据的部分, 可根据实际需求进行修改 IP 地址与端口号设置好后, 保存后台程序, 便会与视觉服务器建立连接实际使用中用到了 4 位数据, 分别存储在 V20,V21,V22,V23 中第一位 V20 代表视觉识别的结果, 数字 0 代表视觉识别失败,1 代表成功识别

32 (3) 后台脚本 (4) 解析本例为定点抓取, 机器人做客户端, 视觉做服务器案例中后台脚本只展示了接收数据的部分, 可根据实际需求进行修改 IP 地址与端口号设置好后, 保存后台程序, 便会与视觉服务器建立连接实际使用中用到了 4 位数据, 分别存储在 V20,V21,V22,V23 中第一位 V20 代表视觉识别的结果, 数字 0 代表视觉识别失败,1 代表成功识别这样一来如果视觉 NG, 便可自动重新索取数据根据实际需求, 还可以在程序中增加计数程序, 这样当重新索取一定次数之后, 视觉仍然 NG 时, 便可控制机械手输出一个报警信号, 此时再进行人为干预, 会大大省去人工操作的精力 V21,V22,V23 这三个变量中存储被识别物体的 X,Y,U 使用这三个变量进行 P 点运动的指令, 便可使机械手以正确的姿态运动到物品上方, 然后即可进行需要的动作 32

存储位置在跟踪使能指令 CONVEYTRACKWAIT(0,V1,V2,V3) 中体现, 该指令中的变量地址不可修改, 并且第一位数为 1 的时候才会存储以上文案例程序进行总结在流水线始终开启的状态下,

33 1.2 单视觉跟随抓取 ( 硬触发拍照 ) (1) 工艺设置 (2) 前台脚本 (3) 解析跟踪工艺的设置参考之前的说明视觉工艺与跟踪一同应用时, 不使用后台, 在工艺界面设置好服务器的 IP 地址和端口号如果设置无误, 在前台界面运行视觉初始化便会与服务器建立连接, 反之运行视觉退出便会断开连接带视觉的跟踪是由视觉发送的信息进行触发一般情况下, 机械手需要接收 4 位数据, 跟上一个案例有些相似存储位置在跟踪使能指令 CONVEYTRACKWAIT(0,V1,V2,V3) 中体现, 该指令中的变量地址不可修改, 并且第一位数为 1 的时候才会存储以上文案例程序进行总结在流水线始终开启的状态下, 从程序第一行开始自动运行后, 程序会停留在第七行跟踪使能的位置, 这时候机械手等待视觉识别的信息发送过来假设物品位置信息为 X=100,Y=200,U=30, 那么视觉需发送 1,100,200,30 且机械手能成功接收, 这时跟踪便会开始, 程序自动顺序执行 33

机械手的在线跟踪工艺可以完成对于产品的同步跟随, 同时通过 TCP/IP 通信的方式与视觉进行信息交互, 实现对产品角度位置的校准, 这样抓取的位置便可准确与基于 PLC 控制的料盘流水线, 通过 IO 信号配合运转, 当机械手内部计数程序判定当下料盘已经摆满后,PLC

34 2. 项目案例 1. 单视觉双机械手流水线协同下料简介 : 大型冲压机对工件进行冲压作业, 产品随机散落在流水线上, 角度随机间距大致相等, 两台机械手分别对奇数号产品和偶数号产品进行精准抓取与定位摆放配合料盘自动化装置完成自动下料工序该项目难点在于要在运动过程中进行随机抓取, 机械手的在线跟踪工艺可以完成对于产品的同步跟随, 同时通过 TCP/IP 通信的方式与视觉进行信息交互, 实现对产品角度位置的校准, 这样抓取的位置便可准确与基于 PLC 控制的料盘流水线, 通过 IO 信号配合运转, 当机械手内部计数程序判定当下料盘已经摆满后,PLC 便会控制流水线动作来更换料盘 2. 基于自动上下料机械手的灯壳自动涂胶系统简介 : 两台 SCARA 机械手, 配合 PLC 进行上料涂胶下料协同作业两台机械手中间是有八个工位的分割器灯壳由自动送料机构无规则地送至上料流水线, 上料机器人需通过视觉进行引导, 从流水线抓取至分割器固定工位中涂胶完成后, 再由下料机器人进行下料该项目信号比较繁杂, 输入信号有分割器动作两个工位物料检查流水线物料检查等的信号, 一旦动作完成测得次品视觉 NG 系统报警等机械手也会给出相应的输出信号最终, 就算过程中有人为干预, 机械手也不会出现误抓漏抓的情况 34

双视觉流水线跟随键盘贴片简介 : 自动送料装置将键盘外壳送至流水线上, 机械手去一侧取贴片材料, 至下相机处拍照后调整贴片材料姿态, 进入到等待位键盘壳进入工作区间后, 上相机拍照,

35 3. 单视觉 SCARA 机械手 LCD 屏定位抓取简介 : 上料机构将 LCD 屏随机摆放于流水线上, 机械手需根据屏幕种类, 分类并准确的抓取并摆放到自动下料装置中流水线在线跟踪加视觉由于项目中屏幕种类较多, 在机械手中需添加种类分辨程序, 根据视觉识别信息准确抓取产品后, 放入相应的位置 4. 双视觉流水线跟随键盘贴片简介 : 自动送料装置将键盘外壳送至流水线上, 机械手去一侧取贴片材料, 至下相机处拍照后调整贴片材料姿态, 进入到等待位键盘壳进入工作区间后, 上相机拍照, 识别贴片位置, 机械手随后完成贴片动作一台机器人配合两个视觉进行在线跟踪下相机校准贴片姿态的只是常规的抓取, 上相机识别键盘壳, 还要将识别信息作为跟随开始的触发信号机械手中建立两个端口, 分别用来接收两个视觉发送的信息再通过工艺设定, 将其中一个用来触发跟踪 35

C++ 程序设计告别 OJ1 - 参考答案 MASTER 2019 年 5 月 3 日 1

C++ 程序设计告别 OJ1 - 参考答案 MASTER 2019 年 5 月 3 日 1 C++ 程序设计告别 OJ1 - 参考答案 MASTER 2019 年月 3 日 1 1 INPUTOUTPUT 1 InputOutput 题目描述用 cin 输入你的姓名 ( 没有空格 ) 和年龄 ( 整数 ), 并用 cout 输出输入输出符合以下范例输入 master 999 输出 I am master, 999 years old. 注意 "," 后面有一个空格,"." 结束,

SCARA机械手 培训手册

SCARA机械手培训手册