RoboDK 支持使用 GPL(Guidance Programming Language,引导编程语言)的 Brooks PreciseFlex 机器人。用户可以从 Brooks 提供的一系列机器人手臂、夹爪和直线导轨中进行选择,生成高级实验室自动化程序。
要从仿真中控制 Brooks PreciseFlex IntelliGuide 夹爪(包括 IntelliGuide s23D 双夹爪),请按照本节所述步骤操作。
1.右键单击程序。点击:添加指令,再选择:程序调用指令。
2.添加程序调用指令的时候需要先命名,命名方法:Gripper(夹爪ID,夹爪值)。那么就是:Gripper(2, 50) ,意思是将双夹爪中的 2 号夹爪移动到 50 毫米处。
a.对于单夹爪,您可以将调用简化为“Gripper(夹爪值)”。
b.如果存在多个机器人,请使用“Gripper(夹爪ID, 夹爪值, item.ptr)”。例如,“Gripper(2, 50, item.ptr)”将把双夹爪中的 2 号夹爪移动到 50 毫米处,并确保父机器人与程序相关联。
3.在所有子程序的起始处以及所有子程序调用之后添加Gripper()指令。这是为了确保与后处理器的兼容性。预计会出现重复的Gripper()指令。
4.添加Python 脚本,命名为:Gripper。
5.编辑Python 脚本:Gripper,并粘贴以下内容:
from robodk import robolink
import sys
if len(sys.argv) < 2:
quit()
def get_item(ptr_item, RDK):
item = robolink.Item(RDK, str(ptr_item), robolink.ITEM_TYPE_PROGRAM)
if not item.Valid(True):
return None
return item
RDK = robolink.Robolink()
gripper_id = -1
gripper_value = 0
prog_item = None
# Get the gripper ID, value, possibly the caller
if len(sys.argv) == 2:
gripper_value = float(sys.argv[1])
elif len(sys.argv) >= 4:
gripper_id = int(sys.argv[1])
gripper_value = float(sys.argv[2])
prog_item = get_item(int(sys.argv[3]), RDK)
elif len(sys.argv) == 3:
prog_item = get_item(int(sys.argv[2]), RDK)
if prog_item:
gripper_value = float(sys.argv[1])
else:
gripper_id = int(sys.argv[1])
gripper_value = float(sys.argv[2])
# Get candidates
grippers = [x for x in RDK.ItemList(robolink.ITEM_TYPE_ROBOT_AXES) if 'intelliguide' in x.Name().lower() and len(x.Joints().tolist()) == 1]
if len(grippers) > 1 and prog_item:
robot_item = prog_item.getLink(robolink.ITEM_TYPE_ROBOT)
if not robot_item.Valid():
robot_item = RDK.ItemUserPick("Select the linked robot", robolink.ITEM_TYPE_ROBOT)
prog_item.setRobot(robot_item)
def get_flat_childs(item):
childs = item.Childs()
for child in item.Childs():
childs.extend(get_flat_childs(child))
return childs
childs = get_flat_childs(robot_item)
grippers = [x for x in childs if x.Type() == robolink.ITEM_TYPE_ROBOT and len(x.Joints().tolist()) == 1]
if not grippers:
RDK.ShowMessage('Unable to find a gripper!', False)
# Try to find the right gripper id (i.e. Dual Gripper 1)
gripper = grippers[0]
if gripper_id > 0:
gripper_ids = [g for g in grippers if g.Name().endswith(str(gripper_id))]
if gripper_ids:
gripper = gripper_ids[0]
gripper.MoveJ([gripper_value])
这种方法也兼容Brooks后处理器。
由于PreciseFlex机器人的基座坐标系并非位于机器人物理基座处,因此需要在PreciseFlex机器人与PreciseFlex直线导轨之间设置特定偏移量。
Brooks PreciseFlex 直线导轨0度配置:
a.Brooks PreciseFlex 400:[118,0,45.6,0,0,0]
b.Brooks PreciseFlex 3400: [118,0,62.6,0,0,0]
Brooks PreciseFlex 直线导轨 -90 度配置:
a.Brooks PreciseFlex 400:[101.6, 0, 45.6, 0, 0, 0]
b.Brooks PreciseFlex 3400:[101.6,0,62.6,0,0,0]
必须同步直线导轨,后处理器才能考虑该轴的位置。具体方法信息参考https://robodk.com/doc/cn/General.html#SyncAxes章节。
为正确保存机器人世界参考坐标系中的目标点,并确保这些目标点可在后处理器生成的GPL项目中调用,用户需新建一个参考坐标系。该坐标系需基于工作站参考坐标系定义,且必须采用前文所述的机器人基座与直线导轨间相同偏移量(即上述数据)。所有目标点均需相对于该参考坐标系进行定义。
下图展示了0度配置下搭载于1米直线导轨的PreciseFlex 400机器人,以及被定义为机器人世界参考坐标系的参考坐标系示意图。

生成GPL项目后,使用任意文本编辑器打开Main.gpl文件,并注释掉定义机器人基座参考坐标系的那一行代码:

由于Brooks PreciseFlex c8A机器人独特的运动学结构,其模型在RoboDK中是通过组合两个机器人的模型开发而成,以处理该机械臂3+3自由度的运动。

这种开发方式导致Brooks PreciseFlex c8A机器人的模型无法与Brooks后处理器配合使用。
Brooks PreciseFlex c8A机器人与任何Brooks PreciseFlex IntelliGuide夹爪均不兼容。
如果需要添加工具中心点(TCP),必须相对于机器人腕部机构的法兰进行定义。请参阅"工具中心点 (TCP)"一节中的信息,以设置与机器人控制器中配置一致的TCP位姿。
与Brooks PreciseFlex c8A机器人类似,Brooks PreciseFlex 100 XZTS机器人也是通过组合两个机器人的模型并加入夹爪而开发的。这使其能够处理机械臂的3个自由度(沿X轴和Z轴的直线运动,以及绕Z轴的Theta旋转)以及夹爪的自由度。
下图展示了X轴运动范围为685毫米的Brooks PreciseFlex 100 XZTS。

与Brooks PreciseFlex c8A机器人一样,Brooks PreciseFlex 100 XZTS机器人也不兼容后处理器。
如果需要添加工具中心点(TCP),必须相对于机器人Theta机构(绕Z轴旋转)的法兰进行定义。

请参阅"工具中心点 (TCP)"一节中的信息,以设置与机器人控制器中配置一致的TCP位姿。
本节介绍与生成Brooks机器人程序相关的一些技巧。
RoboDK中的工具中心点(TCP)必须与机器人控制器中定义的TCP保持一致。若使用夹爪机构,需通过"添加工具(TCP)"功能添加一个位于预期位置的TCP。新建工具TCP应与夹爪机构TCP完全匹配。Brooks PreciseFlex机器人的TCP参数可通过网页界面按以下路径查询:
1.Admin
2.Setup – Parameter Database
3.Robot
4.Joint/Cartesian control
5.Dynamic Parameters
6.DataID 16051
关于如何正确定义与后处理器兼容的夹爪指令,请参阅前一个章节:夹爪仿真。该方法能准确定义GPL项目中的位置数据,避免夹爪轴系意外移动。
现有Brooks PreciseFlex IntelliGuide夹爪型号包括:
1.Brooks PreciseFlex IntelliGuide s23
2.Brooks PreciseFlex IntelliGuide s60
3.Brooks PreciseFlex IntelliGuide s23D
4.Brooks PreciseFlex IntelliGuide v23
5.Brooks PreciseFlex IntelliGuide v60
各型号夹爪的基座参考坐标系定义均不相同。为正确安装夹爪至机器人法兰参考坐标系,需使用以下参考位置数据:
| IntelliGuide s23 | IntelliGuide s60 | IntelliGuide s23D | IntelliGuide v23 | IntelliGuide v60 |
| |
PreciseFlex 400 | [0.603,0,0,0,0,0] | N/A | N/A | [0,0,0,0,0,0] | N/A | ||
PreciseFlex 3400 | [0.033,0,0,0,0,0] | [0.033,0,0,0,0,0] | [0.033,0,0,0,0,0] | [-0.57,0,0,0,0,0] | [0,0,0,0,0,0] | ||
PreciseFlex DD 4-axis | [-70.5,0,0,0,180,180] | [-70.5,0,0,0,180,180] | [-70.5,0,0,0,180,180] | [-71.1,0,0,0,180,180] | [-71.5,0,0,0,180,180] | ||
PreciseFlex c10 | [-82.5,0,0,0,180,180] | [-82.5,0,0,0,180,180] | [-82.5,0,0,0,180,180] | [-82.5,0,0,0,180,180] | [-82.5,0,0,0,180,180] | ||
PreciseFlex c3 | [0.313,0,0,0,0,0] | [0.313,0,0,0,0,0] | [0.313,0,0,0,0,0] | [-0.291,0,0,0,0,0] | [0.279,0,0,0,0,0] | ||
PreciseFlex c3x | [-14.655,0,0,0,0,0] | [-14.655,0,0,0,0,0] | [-14.655,0,0,0,0,0] | [-15.258,0,0,0,0,0] | [-14.688,0,0,0,0,0] | ||
PreciseFlex c5 | [113,0,0,0,0,0] | [113,0,0,0,0,0] | [113,0,0,0,0,0] | [112.4,0,0,0,0,0] | [113,0,0,0,0,0] |

对于Brooks PreciseFlex DD 4轴和c10机型,需从机器人资源库加载IntelliGuide ISO法兰模型并添加至机器人用于可视化(DD 4轴机器人的IntelliGuide ISO法兰几何体需上移9mm)。

输入值大于 0 时,机器人不会在运动结束时停止,并将执行平滑过渡运动(GPL 代码:prof1.InRange = -1)。
输入值为 0 时,机器人将在运动结束时停止,但会应用一个较小的位置误差约束(GPL 代码:prof1.InRange = 10)。
输入值-1表示机器人将在运动终点完全停止并启用严格位置误差约束(对应GPL代码:prof1.InRange = 100)。
输入值0表示机器人将在运动终点停止但采用宽松位置误差约束(对应GPL代码:prof1.InRange = 10)。
输入正值表示机器人将执行平滑过渡运动而不完全停止(对应GPL代码:prof1.InRange = -1)。
Brooks PreciseFlex机器人的最大线速度、角速度及关节速度/加速度相关信息,可通过网页界面按以下步骤查询:
1.管理员
2.Admin
3.Setup – Parameter Database
4.Robot
5.Joint/Cartesian control
6.Dynamic Parameters
7.DataIDs 2700, 2701, 2702, and 2703
用户可参照上述DataID的值设置RoboDK速度/加速度指令的输入参数。随后,Precise后处理器将使用这些值,按照GPL Profile类的要求,将速度/加速度计算为各机器人最大速度/加速度的百分比。要更改后处理器使用的限值,您可以根据所使用的具体机器人修改后处理器。默认情况下,后处理器使用PreciseFlex 400和PreciseFlex 3400机器人的限值。修改后处理器的方法请参阅帮助文档的 https://robodk.com/doc/en/Post-Processors.html#PPEditor 章节。
当线加速度/角加速度指令输入值小于1时,该值将被视为达到峰值加速度/减速度所需的斜坡时间(秒)(对应GPL代码:prof1.AccelRamp/prof1.DecelRamp = 输入值)。
下图进一步介绍了上述概念的相关信息,以及控制器如何规划机器人必须遵循的轨迹。

输入大于0的值将生成一条GPL命令,使程序暂停由输入值定义的时长。输入负值将在网页界面操作控制面板上弹出对话框,程序将保持暂停,直到用户点击对话框上的“Continue”按钮。要查看该对话框,用户需点击操作控制面板上的“Dialog Active”按钮。
通过FTP从RoboDK向Brooks机器人传输程序的步骤:
1.在 RoboDK 中右击机器人
2.点击:连接机器人...
3.输入机器人IP和端口(默认IP 192.168.0.1,端口21)
4.输入远程 FTP 路径(通常为 /flash/projects)
一旦 RoboDK 程序准备就绪,就可以发送给机器人:
1.在RoboDK中右键点击程序
2.选择:发送程序到机器人(Ctrl+F6)
系统将自动生成程序并尝试传输至机器人控制器,弹出窗口显示FTP传输状态。
必须使用机器人的 Web 界面来加载和启动 GPL 项目(使用任何浏览器搜索机器人的 IP 地址,即可访问机器人的 Web 界面)。下面是 Web 界面首页的图片。
1.打开浏览器
2.输入机器人 IP 地址
从 Web 界面启动程序:
1.选择:Admin -> Control Panels -> Operator Control Panel -> Load
2.选择: the GPL project created using RoboDK
3.点击:Select
4.点击:Start
此时,机器人将执行程序。下图显示了操作员控制面板界面,以及允许用户选择和加载所需 GPL 项目的窗口。