Моделирование захватов

Для управления захватами Brooks PreciseFlex IntelliGuide в режиме моделирования, включая захват IntelliGuide s23D (двойной), выполните действия, описанные в данном разделе.

1.Щелкните правой кнопкой мыши по вашей программе и добавьте инструкцию вызова программы.

2.Введите «Gripper(gripper ID, gripper value)». Например, «Gripper(2, 50)» для перемещения захвата № 2 двойного захвата в положение 50 мм.

a.При использовании одного захвата вы можете сократить вызов до «Gripper(gripper value)».

b.Если в системе присутствует более одного робота, используйте «Gripper(gripper ID, gripper value, 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.