Файл: Мясников, В. А. Программное управление оборудованием.pdf

ВУЗ: Не указан

Категория: Не указан

Дисциплина: Не указана

Добавлен: 15.10.2024

Просмотров: 187

Скачиваний: 0

ВНИМАНИЕ! Если данный файл нарушает Ваши авторские права, то обязательно сообщите нам.

Искусственная рука имеет пять степеней свободы, обеспечи­ вающих возможность фиксации ее положения по трем осям сги­ бания-разгибания п смыкания-размыкания пальцев. Перемеще­ ние по каждому из этих направлений осуществляется независи­ мыми серводвигателями. Измерение перемещений руки по трем осям производится потенциометрами, а измерение реакций (уси­ лий) — резисторными тензодатчиками.

В систему программного управления входят следующие основ­ ные блоки.

1.Логические схемы, служащие для реализации основных пяти операций, выполняемых системой.

2.Селектор логических схем. Он служит для подачи сигнала на устройство выбора логических схем, осуществляющих основ­ ные операции программы.

3.Устройство, контролирующее последовательность операций. Приняв сигнал о завершении основной операции, устройство при­ нимает решение о переходе к следующему этапу программы..

4.Селектор начала отсчета. Чтобы можно было задавать исходное положение, в устройстве АМ-1 предусмотрено по четыре потенциометра для каждой из осей. Селектор представляет собой схему, переводящую (в соответствии с программой) потенцио­ метры в нужное положение и обеспечивающую выбор начала отсчета.

5.Схема принятия решения о включении нужного сервоуси­ лителя и селектора входа сервоусилителя.

Сигналы, отраженные в логических уравнениях, фиксируют состояние выключателей датчиков. Величина сигналов считается равной единице при замкнутых контактах этих выключателей.

Сигнал от датчика 5 С, например, равен единице только тогда, когда палец А согнут примерно под углом 45°. Сигналы Qt, Q2

иQ3 равны единице, если абсолютное значение ошибки позицио­ нирования по направлениям осей R, Q, Z не превышает некоторой величины. Сигналы f 1 и / 2 равны единице, когда абсолютное зна­ чение реакции по направлениям R и Q меньше некоторой вели­

чины. Когда запрограммировано выполнение первой операции, rnj = 1. По окончании основной операции величина каждого из сигналов EDX, ED2, . . ., EDb равна единице (ED1 = 1). При сигнале Gx = 1 срабатывает схема автоподиаладки, управляющая

двигателем, приводящим в движение палец А; при сигнале G2 = 1 срабатывает такая же схема, управляющая двигателем пальцев В и С. При G:i = 1 обе схемы автоподиаладки отключаются, па­ лец А вытягивается под действием пружины, а пальцы В и С

размыкаются и занимают крайнее положение.

Сервосистема, следящая за перемещениями по направлению осей R, Q и Z, может быть переведена (с помощью реле) в следую­

щие режимы:

R 2, Q2, Z — режим контроля положения (позиционный конт­

роль);

366


R з, Qs информация

о реакции, измеряемой резисторными

тензодатчиками (передается по цепи обратной связи);

/?4, Q4i Zg, Z4 и R lt

Qj, Z4 — цепь обратной связи разомкнута

и на входы подается напряжение определенной величины.

Возможно также наличие зависимостей:

 

Ri = RiRaRit

Qi = QiQaQi,

z l — z2z 3zi.

Устройство AM-1 выполняет следующие основные операции.

1. Поиск и захват предмета:

 

 

 

 

Яз = Qs ~ G4 =

т1 (5 4 V 5 2 V

5 3 V

V 5,,);

Я1 —: mi {Si v s2V S3 v

54 v

5 а) S5;

Q4 = /пг (S4 V S2 V 53 V 54 V SB) Sb\

G2 =

tni (5 2 V 5 3 V

G4 V

5 g);

 

 

Z2 = /п4;

 

 

 

 

i

=

//i4 (5 4S4 V

5 2 V

S 3).

При подаче команды

на выполнение этой

операции /?г4 = 1.

Если в этот момент с рукой не контактирует какой-либо предмет,

то

Qi =

1 и рука перемещается по стрелке в направлении /?4

до

тех

пор, пока она не будет остановлена фиксатором. При

S i

= 1

палец начинает сгибаться, и когда угол, образуемый им,

достигает примерно 45°, пальцы В и С начинают сдвигаться в на­ правлении G2. Перемещение руки в направлениях R и Q контро­

лируется так, чтобы реакция со стороны предполагаемого объекта была равна нулю и рука свободно перемещалась в положение, из которого наиболее удобно произвести захват предмета.

2.

Перемещение руки в заданное положение:

 

R 2 — Q3

 

 

Е2 ^ /Н 3 i

 

 

E D з

ni3l3.

3.

Извлечение штифта:

 

 

 

 

 

R 2

Q2

1=1

Z2

ш2 ;

 

 

Е D о

'

 

о / 4/ gZ3,

4.

Поиск отверстия и введение в него штифта:

 

 

Qi =

 

Z з =

m6D ;

 

R3

= Q3

= Z4 = mbD;

 

ED5 =

С4 = тъС3\

 

С 2 =

тъ if 1

V / 2) •

5.

Освобождение штифта:

 

 

 

 

 

 

G.3

=

 

 

 

£D4 =

AW,jS2S3S(i.

367


При

G.,

= 1 срабатывает система автоподналадкп и D = 1;

при

G =

1

схема

автоподналадки отключается и D = 0.

В

устройстве

АМ-1 каждая основная операция выполняется

своей подпрограммой.

Команды записываются в строку в виде двух групп букв, кото­ рым соответствуют семь разрядов цифр: /, т, а, о, р, q, г. В первых трех разрядах (/, т, п) указывается внд.осиовиой операции, а в че­

тырех последних задаются положения потенциометров, определя­ ющие необходимые точки отсчета.

Запись некоторой программы имеет вид:

Н о м е р

/

1т

п

О

р

 

<1

 

Г

 

 

Команда

 

 

 

о п е р а ц и и

 

 

 

 

 

 

 

 

 

1

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

1

0

 

1

0

0

1

 

0

 

1

Перемещение руки к штифту

2

0

J

0

1

 

0 |

 

1 j

Поиск и схватывание штифта

 

 

 

 

 

 

 

 

1

 

 

 

 

 

 

 

 

 

3

0

 

 

 

1

I

0

Извлечение штифта

 

 

 

 

 

1

 

 

 

 

 

 

-

 

 

 

 

 

4

l o l

l

0

1

 

11

 

0 j

Перемещение руки

 

 

5

!

1

 

 

 

0

 

 

Поиск

отверстия

и

введение

1

 

0

1

 

1

 

1

 

 

 

 

 

 

 

 

 

 

в него штифта

 

 

 

'

; 1

 

 

 

 

Освобождение штифта

 

6

 

0

0

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

7

0

 

0

j 0

 

_

 

Коней

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

При выполнении операции 1необходимо заранее перевести руку

в положение,

 

соответствующее

началу

поиска. Например, если

 

 

 

 

 

 

 

 

 

 

поиск

начинается

 

из

поло­

 

 

 

 

 

 

 

 

 

 

жения

G,

то

рука может за­

 

 

 

 

 

 

 

 

 

 

хватить этот

штифт,

исполь­

 

 

 

 

 

 

 

 

 

 

зуя чувство осязания, так

 

 

 

 

 

 

 

 

 

 

как штифт находится в пре­

 

 

 

 

 

 

 

 

 

 

делах

заштрихованной

по­

 

 

 

 

 

 

 

 

 

 

лосы (рис. 193). В интервале

 

 

 

 

 

 

 

 

 

 

от момента захвата до его

 

 

 

 

 

 

 

 

 

 

прекращения в сервосистеме,

 

 

 

 

 

 

 

 

 

 

следящей

за

перемещением

 

 

 

 

 

 

 

 

 

 

по направлениям R и Q, по

 

 

 

 

 

 

 

 

 

 

цепи

обратной связи

пере­

Рис. 193. Схема движения руки АМ-1

под

 

дается информация о реак­

 

действием сигналов

 

 

 

 

ции,

измеряемой

резистор-

368


иыми тензодатчиками. Получив информацию, рука перемещается в такое положение, в котором реакция была бы равна нулю, а по­ ложение руки устанавливается по движению пальцев и положению предмета. То же самое относится и к операции 5. Проведение поиска простыми средствами, т. е. с применением датчиков, сигнализи­ рующих о контактах с посторонним предметом, н датчиков, из­ меряющих прилагаемое усилие, расширяет зону поиска, в которой может находиться объект.

Робот ETL

В 1968 г. отделение исследований по бионике Электротехни­ ческой лаборатории (Япония) начало разработку разумного ро­ бота. В 1969 г. к работе над проектом подключилось отделение автоматического управления той же лаборатории, которое взяло на себя исследование рук и их системы управления. Усилия отде­ ления исследований по бионике сосредоточились на разработке органа зрения.

Цель этого проекта состоит в том, чтобы разработать робот, который можно использовать для выполнения операций сборки и контроля.

Робот снабжен глазами, мозгом, руками и способен осущест­ влять серию связанных разумных движений. В качестве органа зрения робота используется телевизионная камера со светофильт­ рами, а в качестве руки — специально разработанный многосуставный манипулятор. Обработка визуальной информации, вы­ работка решений и управляющих импульсов к руке и обучение производится с помощью ЭВМ NEAC-3100 (оперативная память

32

К слов, память

на магнитных дисках

2x273 000

слов),

для

которой были

разработаны

специальные алгоритмы

обра­

ботки информации и программы.

Блок-схема

робота приведена

на рис. 194.

Манипулятор приводится в движение гидравлическим серво­ двигателем, управляемым шаговыми двигателями. Высота плеч робота 1400 мм, расстояние от плеч до концов пальцев 1000 мм. Манипулятор имеет шесть степеней свободы (три на сгибание и три на вращение). Пальцы руки оснащены тактильными датчи­ ками, определяющими прикосновение к предмету. По числу сте­ пеней свободы и расстояниям между суставами рука робота на­ поминает человеческую.

При конструировании робота особое внимание уделялось его приводным механизмам и форме и характеру движения отдельных звеньев. Пальцы манипулятора сделаны сменными применительно к различным выполняемым задачам. Каждый палец снабжается индивидуальным двигателем, что позволяет контролировать положение и силу нажатия пальцев. По выходному напряжению потенциометров, связанных с двигателями пальцев, могут быть определены размеры захваченного пальцами предмета. Тактильные датчики, представляющие собой по существу контакты реле,

24 Мясников н др.

369


устанавливаются на верхней, нижней, наружной и внутренней сторонах пальцев, на концах пальцев п между пальцами.

Управление рукой осуществляется блоком EHOS, выбираю­ щим из набора основных программ требуемые. В набор основных программ входят программы, определяющие изменение углов поворота суставов, изменение координат пространственного по­ ложения, сжатие и разжимание пальцев. Две из программ изме­ нения координат связаны с изменением положения суставов на

Рис. 194. Блок-схема разум­ ного робота ETL:

1

т е л е к а м е р а ; 2 — у п р а в л е ­

н и е

ц в е т н ы м и ф и л ь т р а м и ; 3

в и д е о с и г н а л ; — п р о е к т о р ; 5— у п р а в л е н и е л у ч о м с в е т а ; 6

л у ч с в е т а ; 7 — а н а л о г о - ц и ф р о ­ в о й п р е о б р а з о в а т е л ь ; 8 — б л о к о п р е д е л е н и я ц в е т а о б ъ е к т а ; 9

б л о к о б н а р у ж е н и я р е б р а п р е д ­ м е т а и с л е ж е н и я ; 10 — б л о к и з м е р е н и я р а с с т о я н и я ; 11

р а с п о з н а в а н и е п р е д м е т а и в ы ­

б о р з н а ч е н и й п а р а м е т р о в ; 1 2 ЭВМ; /«3 — / 4 б л о к и п о д п р о ­

г р а м м а у п р а в л е н и я р у к о й с о о т ­ в е т с т в е н н о ; 15 г и д р а в л и ч е ­ с к и й м а н и п у л я т о р ; 16 — т а к ­

т и л ь н а я и н ф о р м а ц и я

заданные значения и две — с перемещением суставов таким обра­ зом, чтобы обеспечить правильное положение и направление концов пальцев. Основные программы обеспечивают выполнение различных элементарных движений и являются подпрограммами, используемыми блоком EHOS при составлении рабочих программ последовательностей сложных движений.

Требуемое положение руки может быть задано или в абсо­ лютных координатах (в рабочем пространстве манипулятора) или в приращениях относительно положения руки в рассматривае­ мый момент. Введение тактильных датчиков увеличивает возмож­ ности манипулятора (рука начинает активно искать требуемый предмет).

Простейшие подпрограммы системы управления манипулятором подобны инструкциям ЭВМ. Они преобразуют координаты руки робота в углы и вырабатывают сигналы для управления серво­

370