Файл: Системы очувствления и адаптивные промышленные роботы..pdf
ВУЗ: Не указан
Категория: Не указан
Дисциплина: Не указана
Добавлен: 29.02.2024
Просмотров: 238
Скачиваний: 0
Рис. 5.21. Схема логической сети, уп равляющей поведением РТК
2-й детали и собранного |
узла |
со |
||||||
ответственно. |
В ы ходн ой |
а л ф а ви т : |
||||||
v t , v f, Выходной |
сигнал |
v t |
свиде |
|||||
тельствует |
о |
нормальном |
течении |
|||||
процесса |
сборки, |
a |
v f — об |
от |
||||
клонении от нормы (деталь от |
||||||||
сутствует |
в |
месте |
сборки |
или |
||||
установлена |
неправильно). |
Граф |
||||||
рис. |
5.20, в. |
|
|
обеспечивают |
||||
Пресс (Р). В ходн ой а л ф а в и т : и, d . Символы |
входного алфавита |
|||||||
перемещение подвижного элемента пресса вверх |
н вниз соответственно. В ы ходной |
а л ф а ви т : р и , p d . Появление на выходе этих символов свидетельствует о нахождении
пуансона в требуемом положении. |
Граф конечного автомата Р представлен на |
рис. 5.20, г . |
а л ф а в и т ; о). Появление символа ш приводит |
Поворотный стол ( R ) . В ходн ой |
к тому, что стол повернется на одну позицию. В ы ходн ой а л ф а в и т ; rt. Появление сим вола r t свидетельствует об окончании процесса поворота стола. Соответствующий граф приведен на рис. 5.20, д .
Таким образом, перечисленные выше конечные автоматы описывают поведение каждого из активных элементов адаптивного РТК. Построим управляющую струк туру (логическую сеть) которая реализует адаптивный способ поведения сборочного
РТК.
На рис. 5.21 приведена схема логической сети, компоненты которой являются конечными автоматами. Регуляторы R x и R 2 управляют манипуляторами и их за хватами на основании полученной от них информации, а также команд монитора
M N , |
который осуществляет |
согласованное управление всем комплексом |
в целом. |
|
Опишем теперь кратко работу некоторых из автоматов, входящих в состав |
||||
логической сети. |
а л ф а в и т : g lt g g lt s tl7 o k l7 f l v Смысл |
символов^, ggj |
||
Регулятор (#i). В ходн ой |
||||
описан выше: они являются |
выходными символами автоматов А г |
и |
Символы |
|
s/i, |
f l ± поступают на вход R t от монитора M N и означают следующее: s t1 — ко |
|||
манда |
запуска регулятора; о/г* — СТЗ подтвердила правильность |
протекания сбо |
рочного процесса; f l x — первый этап сборки завершен неудачно. В ы ходн ой а л ф а ви т :
Р ъ Р ъ Рз> Pi* Рь> Р%у eui- Символы p lt ..., р6 обеспечивают перевод манипулятора в со ответствующие точки позиционирования (см. автомат А г). Символ еиг передается монитору, чтобы проинформировать его о том, что, начиная с этого момента, можно инициировать работу СТЗ с целью проведения визуальной инспекции рабочей сцены, поскольку деталь А установлена в сборочное приспособление и поле зрения видео датчика не заслонено захватом манипулятора.
На рис. 5.22, а представлен граф регулятора. Входной символ, получаемый в состоянии х9у определяет поведение манипулятора: если деталь верно установлена в месте сборки, то цикл сборки продолжается, в противном случае манипулятор за бирает деталь и укладывает ее в тару брака.
Монитор (iWV). В ход н ой а л ф а в и т : s t0, e v lt v t , v f, .... Символ s t0 — это команда, источником которой является человек-оператор и который инициирует исполнение всего сборочного процесса. Все остальные символы принадлежат выходным алфави там соответствующих автоматов. В ы ходн ой а л ф ави т : $ tlt w lt s/2, ok1% со, ... Команды st-± и s^2 запускают исполнение сборки первым и вторым манипуляторами. Заметим, что, попав в состояние х4, монитор выдает сразу два управляющих символа, которые обеспечивают параллельное исполнение сборки двумя манипуляторами.
Фрагмент графа перехода монитора представлен на рис. 5.22, б . Монитор по существу управляет сборкой, обеспечивая запуск соответствующих активных эле ментов в зависимости от состояния сборочного процесса, т. е. придавая всему комп лексу в целом адаптивные свойства.
Реализация логического управления. Способы реализации логи ческого управления могут быть различными. Как известно, все
158
Рис. 5.22. Управляющие элементы логиче ской сети:
а — регулятор манипулятора; б — мо нитор
уровни иерархии управления (возможно, исключая нижние) реали зуются на базе ЭВМ, т. е. в виде некоторых программ. Логическое управление осуществляется сетью автоматов, которые обмениваются между собой элементами алфавитов. При этом естественно интерпре тировать каждый автомат как процесс (или задачу), развитие кото рого определяется поступающими на его вход данными от других процессов. Конкретная реализация этих процессов зависит от мощ ности располагаемых вычислительных средств. Один из лучших способов реализации заключается в использовании мультимикропроцессорной сети, в которой каждый микропроцессор выполняет программно функции конечного автомата. В этом смысле использова ние теории конечных автоматов при разработке управления адап-
1 5 9
тивньши роботами стимулирует распараллеливание процесса испол нения и является конструктивным. Для управляющих систем, имеющих небольшое число процессоров, необходимо реализовать мультизадаточный режим, что сопряжено с дополнительными рас ходами в связи с перераспределением ресурсов между задачами.
Вытекающая из теории конечных автоматов реализация конечного автомата в виде набора специальным образом соединенных простых логических элементов не является приемлемой для робототехнических систем, поскольку одним из отличительных качеств робота является его универсальность (т. е. возможность выполнять разнообразные операции), достигаемая путем его перепрограммирования. С точки зрения логического управления это означает перестройку связей, входящих в состав управляющей структуры автоматов, и тогда аппаратная реализация такой структуры (на базе логических элемен
тов) |
теряет |
все свои |
пре- |
------------------------------------------------------- |
||||||||
имущества. |
|
|
|
|
|
/ш-------------- |
зтр.н |
|
шу |
|||
Типичная программа \ |
УЖ------------------- |
|
|
т у |
||||||||
STRUCT |
POINT |
|
|
|
||||||||
реализующая |
работу |
ко |
ill |
|
|
|
|
|||||
нечного |
автомата, |
пред |
STRUCT POINT |
«NEXT; |
|
|||||||
ставлена |
на |
рис. |
5.23. |
STRUCT |
. IN . |
|
|
|||||
|
ill |
|
|
|
||||||||
Она написана на языке С |
|
STRUCT |
«IN |
«NEXT1; |
|
|||||||
и обеспечивает |
выполне |
|
STRUCT |
.OUT. |
|
|
||||||
ние |
всех требуемых функ |
|
ill |
|
.OUT. |
|
||||||
|
STRUCT |
*NEXT2; |
||||||||||
ций |
автомата, |
если |
соот |
|
LONG |
INT |
OUT-СИ; |
|||||
ветствующим образом ини |
|
I NT |
. |
MOM.AT; |
|
|||||||
циализирована |
структура |
|
ill*T0.0UT; |
|
|
|||||||
LONG |
INT |
IN.CH; |
|
|||||||||
данных (рис. 5.23, а). Про |
INT |
|
*PNT.NX; |
|
|
|||||||
грамма |
является |
универ |
ill*T0.IN; |
|
|
|
||||||
сальной |
в том смысле, что |
INT |
3TAT; |
|
|
|
||||||
INT |
TIK; |
|
|
|
||||||||
обеспечивает программную |
INT |
NUMBER; |
|
|
|
|||||||
реализацию |
почти |
|
всех |
ill; |
|
|
|
|
||||
автоматов (структура дан- |
STRUCT |
BLOCK |
|
|
|
|||||||
ных |
у каждого |
автомата |
ill |
|
|
|
|
|||||
инициализируется |
инди |
INT |
|
3I2 E .3 ; |
|
|
||||||
видуально); |
|
исключение |
INT |
|
*PNT_rR; |
|
|
|||||
|
INT |
|
*PNT_ENDJ |
|
||||||||
составляют |
лишь |
некото- |
INT |
|
BOBVC ]; |
|
|
|||||
|
|
|
|
|
|
|
|
ill; |
|
|
|
|
непосредственно с ными элементам и, т.
управляющей структуры (см. рис. 5.1< принимают
ется А. А. Дмитриев
Рис. 5.23. Программа, моделирую щая работу конечного автомата:
EXTERN |
STRUCT |
POINT |
«DATA01C ]; |
EXTERN |
STRUCT |
BLOCK |
DATA32) |
EXTERN |
STRUCT |
BLOCK |
DATA33; |
EXTERN |
STRUCT |
BLOCK |
ВАТАЭ4; |
EXTERN |
LONG |
INT |
ВАТАЭЭСЗ! 3: |
EXTERN |
INT |
DATATMC 31 J; |
|
EXTERN |
INT |
BATASTC311) |
|
#BErINE |
GRPNUM |
32 |
|
#DErINE |
NULL |
9 |
|
SM.___ _ |
|
|
|
а — структура данных; |
б — ин |
струкции |
о) |
160
— ■*./
# INCLUDE |
“3TR.И" |
|
«DEFINE |
NUM.SU |
1 |
MAIN О
ID
REGISTER |
STRUCT |
POINT |
*A; |
REGISTER STRUCT _IN. |
*3; |
||
REGISTER |
STRUCT |
-OUT. |
*C; |
INT |
|
STATE; |
|
|
|
^ |
|
A = DAT Ad К |
NUN .3U 3; |
|
|
|
|||
В = A - >T 0 _ IN; |
|
|
|
|
|||
F 0 R < J ;> |
|
|
|
|
|
|
|
Ш |
|
|
|
|
|
|
|
WT3E< |
GPPNUN |
+ N U M - S U ) ; |
|
|
|||
C L E F < |
GRPNUM + NUM_SU>; |
|
|
||||
lr<( STATE - REC-IN<3>> |
!- NULL |
> |
|||||
Ш |
|
|
|
|
|
|
|
D A T A 00 CN UM . S U3 |
3->IN_CH; |
|
|||||
A |
■= STATE; |
|
|
|
|
||
DATAS'TC NUM.SU 3 * |
A->3TAT; |
|
|||||
DATATML NUM.SWJ - |
А->Т1Ю |
|
|||||
B |
■= A - >TO-IN; |
|
|
|
|||
ill |
|
|
|
|
|
|
|
ai |
|
|
|
|
|
|
|
Щ |
|
|
|
|
|
|
|
R E C -O U K O . |
|
|
|
|
|||
REGISTER |
STRUCT |
.OUT. |
*C; |
|
|||
ID |
|
|
|
|
|
|
|
REGISTER |
INT |
*DEU; |
|
|
|
||
REGISTER |
INT |
BODV; |
|
|
|
||
WHILE* C !- NULL) |
|
|
|
||||
Ш |
|
|
|
|
|
|
|
IF*C->N0M-AT < 0> |
|
|
|
||||
ID |
|
|
|
|
|
|
|
DEU - C->NOM.AT |
|
|
|
||||
30DV |
= C- >0UT_CH.i |
|
|
|
|||
*DE'J |
- |
BOD7; |
|
|
|
||
ID |
|
|
|
|
|
|
|
ELSE |
|
|
|
|
|
|
|
ID |
|
|
|
|
|
|
|
DATA00C |
C->NOM-AT ] |
C->OUT_CH; |
|||||
3ETF< C->NOM_AT + GRPNUM); |
|
||||||
111 |
|
|
|
|
|
|
|
C = C->NEXT2; |
|
|
|
|
|||
31 |
|
|
|
|
|
|
|
m |
|
|
|
|
|
|
*/ |
/ш-------------------------------------------------------------- |
|
|
|
|
|
|
|
RECwIN<B> |
|
|
|
|
|
||
REGISTER |
STRUCT |
_ IN - |
*B> |
|
|||
Hi |
|
|
|
|
|
|
|
WHILE* |
3->NEXTl »- 0> |
|
|
||||
ID |
|
|
|
|
|
|
|
IF< < |
DATA00CNUM.3W3 |
A 3->IH_CH> |
« 3->IN_CH> |
■> ID
[ REC-OUT < 3 - >TO_OUT> s
RETURN<3->PNT.NX>;
HI
HI
RETURN<0)j |
|
|
31 |
. |
ж/ |
/*------------------------------ |
||
|
6) |
|
^ П'р I£. П. Попова. В- В. Клюева |
\Сл\ |
От регуляторов и соответствующим образом управляют активными элементами. Такое свойство программного обеспечения логического управления является чрезвычайно большим преимуществом конечноавтоматного подхода к управлению адаптивными робототехническими системами, поскольку позволяет строить логический уровень управ ления из однотипных, заранее разработанных модулей, оставляя программисту лишь задачу соответствующего заполнения структур данных, описывающих каждый автомат.
Таким образом, выше мы рассмотрели ряд вопросов, связанных с логическим управлением адаптивными робототехническими ком плексами, касаясь при этом только формулировки основных идей, связанных с использованием аппарата теории конечных автоматов для решения этой проблемы. При этом не были затронуты очень важные вопросы: формальный анализ поведения адаптивного робото технического комплекса; способ описания логической сети на язы ковом уровне; формальное доказательство правильности работы ло гической сети; формализация синтеза управляющих структур ис ходя из заданной цели и возможностей активных элементов.
Описанный в этом параграфе подход выполнен на неформальном уровне, хотя и в этом случае он позволяет получать некоторые ре зультаты для несложных робототехнических систем.
5.4. Инструментальные средства для разработки
иисследования алгоритмического
ипрограммного обеспечения адаптивных роботов
Программное обеспечение адаптивного робота — это одна из самых сложных и дорогостоящих его компонент. Она определяет уровень адаптации робота, способ его функционирования в недетер минированной среде, а также ту простоту и легкость, с которой че ловек-оператор может обращаться с роботом, формируя ему задания с одной стороны и получая от него информацию о состоянии робота и исполняемого им задания с другой стороны. Поэтому проектирова ние программного обеспечения адаптивного робота представляет собой трудоемкую процедуру, требующую не только больших интел лектуальных и временных затрат разработчика, но и соответству ющих вычислительных средств, мощность которых (аппаратная и программная) должна, как правило, быть больше вычислительной мощности адаптивного робота. С этой целью используют инструмен тальные вычислительные комплексы, оснащенные не только широким набором периферийных устройств, но и развитыми операционными системами, как универсальными, так и проблемно-ориентирован ными.
Функции, которые выполняют эти инструментальные комплексы, разнообразны: исследование алгоритмов управления движением и методов обработки информации в робототехнических системах, ими тационное моделирование различных подсистем робота (включая исполнительный механизм), подготовка данных для рабочих робото технических комплексов и т. д.
1 6 2