11. 传动带

11.1. 传动带启动、停止

原型

ConveyorStartEnd(status)

描述

传动带启动、停止

必选参数

status: 状态,1-启动,0-停止

默认参数

返回值

错误码 成功-0 失败- errcode

11.1.1. 代码示例

 1from fairino import Robot
 2# 与机器人控制器建立连接,连接成功返回一个机器人对象
 3robot = Robot.RPC('192.168.58.2')
 4#传送带运动,1-运动,0-停止
 5status = 1
 6robot.ConveyorStartEnd(status)
 7#点记录
 8ret = robot.ConveyorPointIORecord()
 9print("记录IO检测点",ret)
10ret = robot.ConveyorPointARecord()
11print("记录A点",ret)
12ret = robot.ConveyorRefPointRecord()
13print("记录参考点",ret)
14ret = robot.ConveyorPointBRecord()
15print("记录B点",ret)

11.2. 记录IO检测点

原型

ConveyorPointIORecord()

描述

记录IO检测点

必选参数

默认参数

返回值

错误码 成功-0 失败- errcode

11.3. 记录A点

原型

ConveyorPointARecord()

描述

记录A点

必选参数

默认参数

返回值

错误码 成功-0 失败- errcode

11.4. 记录参考点

原型

ConveyorRefPointRecord()

描述

记录参考点

必选参数

默认参数

返回值

错误码 成功-0 失败- errcode

11.4.1. 代码示例

1from fairino import Robot
2# 与机器人控制器建立连接。 成功连接返回机器人对象
3robot = Robot.RPC('192.168.58.2')
4ret = robot. ConveyorRefPointRecord()
5print("Convey record reference point ",ret)

11.5. 记录B点

原型

ConveyorPointBRecord()

描述

记录B点

必选参数

默认参数

返回值

错误码 成功-0 失败- errcode

11.5.1. 代码示例

1from fairino import Robot
2# 与机器人控制器建立连接。 成功连接返回机器人对象
3robot = Robot.RPC('192.168.58.2')
4ret = robot.ConveyorPointBRecord()
5print("Convey record B point ",ret)

11.6. 传动带参数配置

原型

ConveyorSetParam(param)

描述

传动带参数配置

必选参数

`` param``: = [encChannel,resolution,lead,wpAxis,vision,speedRadio]
  • encChannel: 编码器通道 1-2

  • resolution: 编码器分辨率 编码器旋转一圈脉冲个数

  • lead: 机械传动比 编码器旋转一圈传送带移动距离

  • wpAxis: 工件坐标系编号 针对跟踪运动功能选择工件坐标系编号,跟踪抓取、TPD跟踪设为0

  • vision: 是否配视觉 0-不配 1-配,

  • speedRadio: 速度比 针对传送带跟踪抓取速度范围为(1-100) 跟踪运动、TPD跟踪设置为1

默认参数

返回值

错误码 成功-0 失败- errcode

11.6.1. 代码示例

1from fairino import Robot
2import time
3# 与机器人控制器建立连接。 成功连接返回机器人对象
4robot = Robot.RPC('192.168.58.2')
5param=[1,10000,200,0,0,20]
6ret = robot.ConveyorSetParam(param)
7print("Set Conveyor Param",ret)

11.7. 传动带抓取点补偿

原型

ConveyorCatchPointComp(cmp)

描述

传动带抓取点补偿

必选参数

cmp: 补偿位置 [x,y,z]

默认参数

返回值

错误码 成功-0 失败- errcode

11.8. 传送带工件IO检测

原型

ConveyorIODetect(max_t)

描述

传送带工件IO检测

必选参数

max_t: 最大检测时间,单位ms

默认参数

返回值

错误码 成功-0 失败- errcode

11.8.1. 代码示例

 1from fairino import Robot
 2# 与机器人控制器建立连接,连接成功返回一个机器人对象
 3robot = Robot.RPC('192.168.58.2')
 4#传送带跟踪抓取
 5while(1):
 6    robot.MoveL([-333.597, 60.354, 404.341, -179.143, -0.778, 91.275],0,0)
 7    error =robot.ConveyorIODetect(1000)
 8    print("传送带工件IO检测错误码",error)
 9    error =robot.ConveyorGetTrackData(1)
10    print("获取物体当前位置错误码",error)
11    error =robot.ConveyorTrackStart(1)
12    print("传动带跟踪开始错误码",error)
13    error =robot.ConveyorTrackMoveL("cvrCatchPoint",0,0,vel = 60.0)
14    print("直线运动错误码",error)
15    error =robot.MoveGripper(1,55,20,20,30000,0)
16    print("夹爪控制错误码",error)
17    error =robot.ConveyorTrackMoveL("cvrRaisePoint",0,0,vel = 60.0)
18    print("直线运动错误码",error)
19    error = robot.ConveyorTrackEnd()
20    print("传动带跟踪结束错误码错误码",error)
21    error = robot.MoveL([-333.625, -229.039, 404.340, -179.141, -0.778, 91.276], 0, 0,vel =30)
22    error = robot.MoveL([-333.564, 332.204, 342.217, -179.145, -0.780, 91.268], 0, 0,vel =30)
23    error = robot.MoveGripper(1,100,10,21,30000,0)
24    print("夹爪控制错误码",error)

11.9. 获取物体当前位置

原型

ConveyorGetTrackData(mode)

描述

获取物体当前位置

必选参数

`` mode``: 1-跟踪抓取 2-跟踪运动 3-TPD跟踪

默认参数

返回值

错误码 成功-0 失败- errcode

11.10. 传动带跟踪开始

原型

ConveyorTrackStart(status)

描述

传动带跟踪开始

必选参数

`` status``: 状态,1-启动,0-停止

默认参数

返回值

错误码 成功-0 失败- errcode

11.11. 传动带跟踪停止

原型

ConveyorTrackEnd()

描述

传动带跟踪停止

必选参数

默认参数

返回值

错误码 成功-0 失败- errcode

11.12. 直线运动

原型

ConveyorTrackMoveL(name,tool,wobj,vel=20,acc=100,ovl=100,blendR=-1.0)

描述

直线运动

必选参数

  • `` name cvrCatchPoint 或cvrRaisePoint``

  • tool: 工具号

  • wobj: 工件号

默认参数

  • vel: 速度 默认20

  • acc: 加速度 默认100

  • ovl: 速度缩放因子 默认100

  • blendR: [-1.0]-运动到位 (阻塞),[0~1000]-平滑半径 (非阻塞),单位 [mm] 默认-1.0

返回值

错误码 成功-0 失败- errcode

11.12.1. 代码示例

 1from fairino import Robot
 2import time
 3# 与机器人控制器建立连接,连接成功返回一个机器人对象
 4robot = Robot.RPC('192.168.58.2')
 5#参数配置
 6param=[1,10000,200,0,0,20]
 7ret = robot.ConveyorSetParam(param)
 8print("传送带参数配置错误码",ret)
 9time.sleep(1)
10#抓取点补偿
11comp = [0.00, 0.00, 0.00]
12ret1 = robot.ConveyorCatchPointComp(comp)
13print("传动带抓取点补偿错误码",ret1)