Simulació de pinça

Per controlar les pinces Brooks PreciseFlex IntelliGuide des d'una simulació, inclosa la pinça IntelliGuide s23D (doble), seguiu els passos que es detallen en aquesta secció.

1.Feu clic amb el botó dret al vostre programa i afegiu-hi una instrucció de crida de programa.

2.Introduïu "Gripper(ID de la pinça, valor de la pinça)". Per exemple, "Gripper(2, 50)" per moure la pinça núm. 2 d'una pinça doble a 50 mm.

a.Podeu escurçar la crida a "Gripper(valor de la pinça)" amb una sola pinça.

b.Si hi ha més d'un robot present, utilitzeu "Gripper(ID de la pinça, valor de la pinça, item.ptr)". Per exemple, "Gripper(2, 50, item.ptr)" mourà la pinça núm. 2 d'una pinça doble a 50 mm, garantint que el robot pare estigui vinculat al programa.

3.Afegiu la instrucció Gripper() com a primera instrucció de tots els subprogrames i després de totes les crides a subprogrames. Això és per garantir la compatibilitat amb el postprocessador. S'esperen instruccions Gripper() duplicades.

4.Afegiu un script de Python i renomeneu-lo com a "Gripper".

5.Editeu l'script de Python "Gripper" i enganxeu-hi el següent:

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])

Tingueu en compte que aquest mètode també és compatible amb el postprocessador Brooks.