Устройство для управления движением транспортного средства

 

Изобретение относится к системам автоматического управления движением внутрицеховых транспортных роботов . Цель изобретения - автоматическое формирование кратчайшего маршрута движения и команд его реализации , идентификация станции назначения и точный останов около ее маркера . В блоке адресной памяти по адресам , являющимся конкатенацией кодов станций текущего расположения транспортного средства и его назначения, записываются код следующей станции по кратчайшему маршруту, признак движения над экранированным участком трассы-ориентира и признак останова, которые считываются из него при обнаружении маркера станции первым датчиком маркеров и на основании которых вырабатываются команды подключения передних или задних датчиков слежения , включения привода движения в режим быстрого или медленного движения с пocлeдyюпц м отключением привода движения и вко1ючением привода торможения при обнаружении маркера станции назначения вторым датчиком маркеров. 3 ил. с (Л 00 ч 4: О

СОЮЗ СОВЕТСКИХ

СОЦИАЛИСТИЧЕСНИХ

РЕСПУБЛИН

А1

„„Я0„„1317401

51) 4 С 05 П 1/00

ОПИСАНИЕ ИЗОБРЕТЕНИЯ

Н АBTOPCHOMV СВИДЕТЕЛЬСТВУ

13, "

ГОСУДАРСТВЕННБ1Й НОМИТЕТ СССР

IlO ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТНРЫТИЙ (? 1) 4004207/24-24 (22) 02. 01. 86 (46) 15.06.87. Бюл. Ф 22 (71) Ленинградский институт авиационного приборостроения (72) М.Б. Игнатьев, В.И. Петров и В.E. Сорокин (53) 629.1.075(088.8)

-(56) Патент США N - 3512601, кл.180-98, 1970.

Авторское свидетельство СССР

У 690450, кл. G 05 D 1/00, 1979.

Филлипс Д., Гарсиа-Диас А. Методы анализа сетей. Пер. с англ. M.: Мир, 1984, с. 496, .ил.

Каган Б.М. Электронные вычислительные машины ч системы. Учеб. пособие, М.: Энергия, 1979, с. 528.

Малкович А.P. Автоматическое адресование. Л.: Энергоатомиздат, 1982, с. 168.

Интегральные схемы. Справочник.

Под ред. Б.В. Тарабрина, M. Радио и связь, 1983, с. 528.

Кори Г., Кори Т. Электронные аналоговые и аналого-цифровые вычислительные машины. I. Теория и основные функциональные блоки. M.: Мир, 1967, 462 с. (54) УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ДВИЖЕНИЕМ ТРАНСПОРТНОГО СРЕДСТВА (57) Изобретение относится к системам автоматического управления движением внутрицеховых транспортных роботов. Цель изобретения — автоматическое формирование кратчайшего маршрута движения и команд его реализации, идентификация станции назначения и точный останов около ее маркера. В блоке адресной памяти по адресам, являющимся конкатенацией кодов станций текущего расположения транспортного средства и его назначения, записываются код следующей станции по кратчайшему маршруту, признак движения над экранированным участком трассы-ориентира и признак останова, которые считываются из него при обнаружении маркера станции первым датчиком маркеров и на основании которых вырабатываются команды подключения передних или задних датчиков слежения, включения привода движения в режим быстрого или медленного движения с последующим отключением привода движения и включением привода торможения при обнаружении маркера станции назначения вторым датчиком маркеров. 3 ил.

1 13)74

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

Целью изобретения является расширение функциональных возможностей устройства за счет идентификации 1D станции назначения, повьппения точности останова, а также автоматического формирования кратчайшего маршрута движения..

На фиг. 1 приведено транспортное средство на участке развилки трассыориентира; на фиг. 2 — структурная схема устройства для управления движением транспортного средства; на фиг, 3 — пример участка трассы-ориентира.

Сущность изобретения заключается в организации управления транспорт.— ным средством при выполнении им оче- 25 редного .транспортного задания на основЕ конкатенации (сочленения) начальных управлений некоторой соответствующей последовательности транспортных заданий. Перед внедрением уст- Зо ройства на трассе-ориентире осуществляется сквозное кодирование всех маркеров натуральными числами 1,2,.... . Направление движения по каждому пе— регону (участку. трассы-ориентира между смежными маркерами ) задано.

Любое транспортное задание состоит в указании пары кодов (i j), где код маркера текущего расположения транспортного средства; 1 — код маркера станции назначения. Соответствующее начальное управление определяется тройкой (К, Р, S), где К— код первого встречного маркера по кратчайшему маршруту движения к стан ции назначения; P — признак наличия экрана на указанном перегоне к первому встречному маркеру; S — признак останова. Такие начальные управления легко определяются по графу трассыориентира вручную заранее на этапе внедрения устройства для всех возмож ных транспортных заданий и записыва— ются в ячейки адресной памяти по ад—

;pecy i j (конкатенация). При этом используется тот факт, что путь, полностью принадлежащий какому-либо кратчайшему пути, также является кратчайшим, что позволяет не описыО1 2 вать такие пути, а выбирать их из описанных путей, которым они принадлежат.

Старший разряд отводится под признак останова S, следующий за ним разряд — под признак наличия экрана P а остальные разряды — под код маркера К. Приэнак останова S равен "1" во всех ячейках по адресам i i, что означает достижение станции назначения. Остальные разряды по этим адресам могут быть произвольными, например "О".

При выполнении транспортного задания процесс управления транспортным средством осуществляется на двух уровнях. На верхнем уровне управления обеспечивается выбор маршрута движения, а именно, на каждом перегоне определяется наличие движения над экранированным участком, выбор крейсерской скорости движения или скорости причаливания, идентификация станции назначения и выработка команды останова. Выбор маршрута произво1 дится на основании считываемых из блока адресной памя",и данных. Адрес считываемых данных изменяется каждый раз при фиксировании маркера первым (передним) датчиком маркеров. Старшие разряды адреса считываются из первого регистра — код текущего маркера, а младшие — из второго регистра — код маркера станции назначения.

Из блока адресной памяти считываются признак наличия экрана Р, код первого встречного маркера К, который переписывается в первый регистр при его достижении транспортным. средством, и признак останова Б, служащий для идентификации станции назначения

При считывании признака останова транспортное средство переходит в режим движения со скоростью причаливания, и при обнаружении маркера вторым (задним) датчиком маркеров включается торможение и транспортное средство останавливается. Для точного позиционирования гранспортного средства около стан.sии назначения маркер каждой станции должен быть уста-новлен на трассе-ориентире с учетом останова транспортно|-о средства по второму (заднему ) датчику маркеров.

При считывании признака наличия экрана происходит пеэеключение датчиков слежения — вместо первых (передних) подключаются вт>рые (задние).

13174

Обратное их переключение происходит при обнаружении маркера вторым (задним) датчиком маркеров, что происходит после того, как передние датчики слежения пройдут над экранированным участком. При возникновении сигнала с аварийного датчика (обнаружение . препятствия и т.п.) транспортное средсредство переходит в режим торможения.

На нижнем уровне управления осуществляется реализация маршрута движения и выработанных на верхнем уровне команд, а именно аналоговое управление сервоприводом рулевого ме10

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

30 от первых (передних) или вторых (задних) датчиков слежения, усиливается в третьем усилителе мощности и подается на сервопривод рулевого механизма. Привод движения транспортного средства осуществляет его останов или движение как с крейсерской скоростью, так и со скоростью причаливания. Указанным режимам соответствуют различные сигналы, получаемые

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

45 ром, упраляемым командами Движение— торможение" и Крейсерская скорость .скорость причаливания, поступающими из блока адресной памяти и первого триггера. Команда Движение — тормои

50 жение через второй усилитель мощности подается также на привод торможения, производя останов транспортного средства.

На чертежах приняты следующие

55 обозначения: прямой участок 1 трассы-. ориентира, ответвление 2 трассы-ориентира, транспортное средство 3, экранированный участок 4, маркер 5»

01 4 датчики 6 и 7 маркеров, датчики 8 и

9 слежения, устройство 10 адресования, устройство 11 переключения дви— жений, устройство 12 слежения, формирователи 13 и 14, панель 15 ввода, регистры 16 и 17, блок 18 адресной памяти, триггеры 19 и 20, аварийный датчик 21, элемент И 22, элемент

ИЛИ 23, аналоговый мультиплексор 24, блок 25 задаюших сигналов, усилители 26 и 27 мощности, привод 28 торможения, привод 29 движения, коммутатор 30, блок 31 спежения, сервопривод 32 рулевого механизма, дифференциальный 33 усилитель, усилитель 34 мощности, маркеры 35-44.

Трасса-ориентир выполнена в виде активно излучающей направляющей, например провода с высокочастотным током, или в виде пассивной направляющей, например обесточенной металлической фольги. Развилка трассы-ориентира включает прямой участок 1 и ответвление 2, выполненное с радиусом, соответствующим техническим данным транспортного средства 3. С места ответвления прямой участок содержит экранированный участок 4. При использовании излучающей трассы-ориентира экранированный участок 4 обеспечивается металлической трубой, служащей для гашения излучения, а при пассивной — физическим разрывом направляющей. Около места ответвления устанавливается маркер 5 этой развилки, например постоянный магнит. Такие же маркеры размещаются на трассе-ориентире в местах возможных остановок транспортного средства. На борту транспортного средства размещены первый (передний) 6 и второй (задний) 7 датчики маркеров, первые (передние) 8 и вторые (задние) 9 датчики слежения, устройство 10 адресования, устройство 11 переключения движений и устройство 12 слежения.

Устройство 10 адресования содержит первый 6 и второй 7 датчики маркеров, первый 13 и второй 14 формирователи, панель 15 ввода, первый (кода текущего маркера) 16 и второй (кода станции назначения) 17 регистры, блок 18 адресной памяти, первый 19 и второй 20 триггеры, аварийный датчик 21, элемент И 22 и элемент ИЛИ 23.

Устройство 11 переключения движе- . ний содержит аналоговый мультиплек—

5 131740 сор 24, блок 25 задающих сигналов, первый 26 и второй 27 усилители мощности, привод 28 торможения и привод 29 движения.

Устройство 12 слежения содержит первые 8 и вторые 9 датчики слежения, коммутатор 30, блок 31 слежения и сервопривод 32 рулевого механизма, а блок 31 слежения включает в себя дифференциальный усилитель 33 и тре- 10 тий усилитель 34 мощности, включенные последовательно.

Выходы датчиков 6 и 7 маркеров соединены соответственно через формирователи 13 и 14 с входом записи 15 первого регистра 16 и входом сброса второго триггера 20, который связан также с вторым входом элемента И 22, выход которого подключен к первому входу элемента ИЛИ 23, второй вход 20 которого соединен с выходом аварийного датчика 21, а выход соединен с входом установки первого триггера 19, вход сброса которого подключен к первому выходу панели 15 ввода, второй и третий входы которой соединены соответственно с входами начальной ус1 . тановки первого 16 и второго 7 ре.гистров,выходы которых подключены соответственно к первому и второму 30 входам блока 18 памяти, третий выход которого соединен с информационным входом ° первoгo регистра 16, второй выход соединен с входом установки второго триггера 20, а первый вход соединен с первым входом элемента И 22 и первым управляющим входом аналогового мультиплексора 24, выход которого через первый усилитель 26 мощности подключен к входу привода 29 дви- 40 жения, блок 25 задающих сигналов подключен к информационному входу аналогового мультиплексора 24, второй управляющий вход которого сбединен с выходом первого триггера 19 и через 45 второй усилитель 27 мощности — с входом привода 28 торможения, выходы датчиков 8 и 9 слежения подключены к информационным входам коммутатора 30, управляющий вход которого под- 50 ключен к выходу второго триггера 20, а выход которого через последователь— но соединенные дифференциальный усилитель 33 и третий усилитель 34 мощности связан с входом сервопривода 32 55 рулевого механизма.

В первый регистр 16 в отличие от стандартного регистра данные могут

1 6 записываться по двум различным шинам.

Он может быть выполнен в виде последовательно включенных мультиплексора, подключающего к своему выходу одно из двух входящих слов в зависимости от сигналов регистра 16, например микросхемы К531КП11, и обычного регистра, например микросхемы К589ИР12, включенного в режим постоянной выдачи данных и записи новых данных по сигналу записи.

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

В структуре адресной памяти в качестве триггеров можно использовать Ртриггеры. При использовании в качестве маркеров на трассе-ориентире постоянных магнитов датчики маркеров выполняются на основе герконов. Формирователи построены на основе формирователей сигналов бесконтактных датчиков К1102АЛ1. В качестве аналогового мультиплексора берется аналоговый коммутатор К590КИ1. Блок задающих сигналов представляет собой блок питания на три напряжения, соответствующих останову транспортного средства, его движению с крейсерской скоростью и со скоростью причаливания.

Усилители мощности реализуются на микросхемах К174УН1. Коммутатор получается объединением управляющих входов двух микросхем аналоговых переключателей КР143ТК1. В качестве дифференциального усилителя берется микросхема К118УД1А. Сервопривод рулевого механизма реализуется по известной схеме.

Устройство работает следующим образом.

Первоначально в блок 18 адресной памяти устройства 10 адресования за— писываются тройки на скального управления, соответствующие данной транс— портной сети. Затем панели 15 ввода в первый регистр 16 записывается код маркера текущего расположения транспортного средства, а во второй регистр 17 — код маркера станции назначения. По сигналу запуска с панели 15 ввоца производится сброс первого триггера 19, в результате чего через второй усилителb 27 мощности отключается привод 28 торможения устройства ll переключения движения, и из блока. 25 задающих сигналов через аналоговый мультиплексор 24 и первый усилитель 26 мощности на привод дви1317401 8 на P=l, по которому устанавливается второй триггер 20, выход которого является управляющим входом коммутатора 30, в результате чего вместо первых (передних) датчиков 8 слежения к дифференциальному усилителю 33 подключаются вторые (задние) датчи ки 9 слежения. Поскольку задние датАдрес

Данные Адрес

Данные

Адре с

Данные

36 44 0 О 39 39 39 1 0 39

37 37 1 0 37 39 — 0 0 41

35 35 1 0 35

35 — Π0 36

36 36 1 0 36

О О 38 40 40 1 0 40

38 38

38 39

36 37 0 1 37

36 38 0 1 37

36 39 0 0 39

0 ? ?

41 41 1 0 41

38 40. 0 0 40 4! 42 0 ? ? жения подается сигнал, соответствую щий коду движения, задаваемому признаком останова S из блока 18 адрес ной памяти. Если S = О, то осуществляется движение с крейсерской скоростью, если S = 1, то достигнута ,станция назначения и движение про исходит со скоростью причаливания. Останов производится при установке первого триггера 19, когда 10 отключается привод движения и подключается привод торможения. Это происходит либо в случае сигнала от аварийного датчика 21, либо при получении от второго датчика 7 маркеров 15 сигнала через второй формирователь 14 в случае, когда достигнута станция, назначения, т.е. S = 1. Такая логика работы обеспечивается элементами И 22 и HJIH 23. После-любого останова за- 20 пуск транспортного средства осуществляется с панели 15 ввода сбросом первого триггера 19. Причем, если останов произошел по сигналу от аварийного датчика 21, то возобновление движения транспортного средства 3 произойдет из того состояния, в котором оно было прервано. При движении транспортного средства вдоль направляющей трассы-ориентира, т.е. ее пря- 30 мого участка 1 или ответвления 2, коммутатор 30 подключает первые (передние) датчики 8 слежения устройства 12 слежения к входу дифференциального усилителя 33, с выхода которого разность сигналов от датчиков поступает на усиление в третий уси— литель 34 мощности и оттуда подается на сервопривод 32 рулевого механизма.

При необходимости прямого прохожде- 40 ния развилки, т.е. над экраном 4, для соответствующего участка трассыориентира из блока 18 адресной памяти считывается признак наличия экрачики слежения находятся над прямым участком направляющей, то транспортное средство продолжает двигаться прямо. При обнаружении маркера 5 развилки вторым (задним) датчиком 7 маркеров происходит сброс второго триггера 20 и обратное переключение датчиков слежения. Так как длина экрана 4 меньше расстояния между датчиками 6 и 7 маркеров, то первые (передние) датчики 8 слежения будут находиться уже за зоной экрана 4 и транспортное средство 3 будет продолжать обычное движение. Изменение управляющих признаков S P поступающих из блока 18 адресной памяти, происходит в момент перехода с одного участка трассы-ориентира на другой при считывании маркера первым (передним) датчиком 6 маркеров. При этом через первый формирователь 13 подается сигнал записи в первый регистр 16 кода маркера текущего расположения транспортного средства, равного коду К с третьего выхода блока 18 адресной памяти. После этого из блока 18 памяти по адресу, равному конкатенации содержимого первого 16 и второго 17 регистров, считывается новая управляющая тройка (К, P, S), соответствующая следующему участку трассы-ориентира.

Например, описание участка трассы-ориентира, приведенного на фиг. 3, в блоке 18 адресной памяти имеет вид:

1 0 38 40 — 0 0 42

1317401

36 40 О 37 38 41

О ? ? 41 43 0 1 43

36 41 О О 39 38 42 О О 40 41 44 О О 44

36 42 О 37 38 43 О ? ? 42 42 1 О 42

36 43 ΠΠ39 38 44 ΠΠ40 42 — ΠΠ44

Тире означает безразличный код кроме кода совпадения, так как на.— правление движения однозначно. Знак вопроса означает неопределенность в пределах фиг. 3.

Если транспортное средство находится около маркера 35, а маркер стан ции назначения — 40, то сначала считаются 5 = О, P = О, К = 36. Будет происходить движение с крейсерской скоростью под управлением передних датчиков 8 слежения. При достижении маркера 36 и обнаружении его передним датчиком 6 маркеров в первый регистр 16 записывается код 36 и из блока 18 адресной памяти считывается следующая тройка: S = О, P = 1, К = — 37. По Р=1 взводится второй триггер 20 и переключает датчики слежения. Происходит движение с крейсерской скоростью под управлением задних датчиков 9 слежения. Как только будет пройден экран 4 и задний датчик 7 маркеров обнаружит маркер 36, произойдет сброс второго триггера 20 и обратное переключение датчиков слежения. При считывании передним датчиком 6 маркеров маркера 37 в первый регистр 16 запишется код 37, и из блока 18 адресной памяти считается следующая тройка: S = О, P = О, К = 38. Продолжается движение с крейсерской скоростью под управлением передних датчиков 8 слежения. Затем при достижении маркера 38 тройка будет иметь вид: S = О, P = О., К = 40 и тип движения сохранится. При достижении маркера 40 тройка будет иметь вид. "S = 1, P = О, К =- 40. По

$ = 1 изменится код на управляющих входах аналогового мультиплек.сора 24 и транспортное средство перейдет в режим движения со скоростью причаливания. При считывании маркера 40 задним датчиком 7 маркеров произойдет взвод первого триггера 19 и отключение привода 29 движения и подключение привода 28 торможения, что обеспечивает точное позиционирование в требуемом месте останова. Ввод следующего задания и запуск транспортного средства осуществляется с панели 15 ввода. формула изобретения устройство для управления движением транспортного средства, содержащее трассу;ориентир с ответвлениями, маркерами в местах ответвлений и экранированными участками после ответвлений, первые и вторые датчики слежения, установленные соответственно в передней и задней частях транспортного средства„ выходы которых связаны

3 с информационными входами коммутатора, выход которого соединен с входом блока слежения, выход которого. подключен к входу сервопривода рулевого механизма, первый датчик маркеров, расположенный в перецней части транс30 поРтного средства и выходом связанный с входом первого формирователя, панель ввода, первый усилитель мощнос-. ти и элемент И, о т л и ч а ю щ е ес я тем, что, с целью расширения функциональных воэможностей за счет идентификации станции назначения, повышения точности останова, автоматического формирования кратчайшего маршрута движения, допо.мнительно содер40 жит маркеры на трассе-ориентире в местах возможных остановок транспортного средства, а на «го борту установлены второй датчик маркеров, второй формирователь, элемент ИЛИ, пер4 вый и второй регистры, блок адресной памяти, первый и второй триггеры, аварийный датчик, аналоговый мульти— плексор„ блок эацающих сигналов, второй усилитель мощнос ги, привод тормо 0 жения и привод движения, вход которого соединен с выходом первого уси — . лителя мощности, вход которого подключен к выходу аналогового мультиплексора, информационный вход котороэз го связан с выходом блока задающих сигналов, первый упр;.вляющий вход соединен с первым выходом блока адресной памяти и первым входом элемен—

1317401 фие.2 та И, а второй управляющий вход подключен к выходу первого триггера и входу второго усилителя мощности, соединенного выходом с входом привода торможения, первый выход панели ввода 5 подключен к входу сброса первого триггера, а второй и третий выходы подключены к входам начальной установки первого и второго регистров соответственно, выходы которых соеди- 10 невы соответственно с первым и вторым входами блока адресной памяти, второй выход которого соединен с установленным входом второго триггера, а третий выход подключен к информаци- 5 онному входу первого регистра, вход записи которого соединен с выходом первого формирователя, выход второго датчика маркеров подключен ко входу второго формирователя, выход которо- 20 го соединен с входом сброса второго триггера и вторым входом элемента И, подключе ни о го выходом к перв ому в ходу элемента ИЛИ, к второму входу которого подключен выход аварийного датчика, а выход элемента ИЛИ соединен с установочным входом первого триггера, выход второго триггера подключен к управляющему входу коммутатора, а блок слежения содержит последовательно включенные диффЕренциальный усилитель и третий усилитель мощности, вход дифференциального усилителя является входом блока слежения, а выход третьего усилителя мощности является выходом блока слежения, причем длина экранированных участков не больше длины корпуса транспортного средства, а расстояние между соседними маркерами трассы-ориентира не меньше длины корпуса транспортного средства.

1317401

Составитель Л. Цаллагова

Редактор Т. Парфенова Техред Л.Олийнык Корректор С, Шекмар

Заказ 2422/42 Тираж 863 Подписное

ВНИИПИ Государственного комитета СССР по делам изобретений и открытий

113035, Москва, Ж-35, Раушская наб., д. 4/5

Производственно-полиграфическое предприятие, г. Ужгород, л. Проектная, 4