Устройство для автоматического вождения мобильного агрегата

 

Изобретение относится к сельскохозяйственному машиностроению. Цель изобретения - повышение качества выполнения технологического процесса системой автовождения. В устройстве предусмотрено введение в фотооптический датчик и в электронный блок управления второго канала 25 формирования управляющего сигнала, сканирующей поверхности на определенном расстоянии по ходу движения агрегата от пер (Л со со О5 СО О) сд

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

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

РЕСПУБЛИН (19) (11) 95 А1

В) 4 А 01 В 69/04

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

ГОСУДАРСТВЕННЫЙ КОМИТЕТ СССР

ПО ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТКРЫТИЙ

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 3996397/30-!5 (22) 17.12.85 (46) 15.09.87. Бюл. Ф 34 (71) Одесский филиал Научно-производственного объединения по тракторостроению "НАТИ"и Сибирское отделение

Научно-производственного объединения по тракторостроению (72) Э.С. Литвак, В.В. Андрианов и Г.M. Лавров (53) 631.311(088.8) (56) Авторское свидетельство СССР

N - 103303! кл. А 01 В 69/04, 1981. (54) УСТРОЙСТВО ДЛЯ АВТОМАТИЧЕСКОГО

ВОЖДЕНИЯ МОБИЛЬНОГО АГРЕГАТА (57) Изобретение относится к сельскохозяйственному машиностроению. Цель изобретения — повышение качества выполнения технологического процесса системой автовождения. В устройстве предусмотрено введение в фотооптический датчик и в электронный блок управления второго канала 25 формирования управляющего сигнала, сканирующей поверхности на определенном расетоянии по ходу движения агрегата от пер1336965 .С вого канала 13 формирования управля- ческого датчика 2.„а также изменять ющего сигнала. Это позволяет логичес- курс движения агрегата в случае налики обрабатывать сигналы рассогласова- чия сигналов рассогласования в обоих ния обоих каналов формирования управ- каналах формирования управляющих сигляющих сигналов в электронном блоке 4 налов. Изменением времени задержки управления и избегать ложных срабаты- логической обработкой сигналов двух ваний исполнительного механизма сис- каналов формирования управляющих сигтемы автовождения при пересечении све- налов возможно регулировать размеры токонтрастной помехи последовательно светоконтрастных помех, на которые каждым из сканируемых лучей фотоопти- система автовождения не реагирует.4 ил.

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

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

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

Устройство для автоматического вождения мобильного агрегата содержит

25 источник 1 электропитания, подключенный к фотооптическому датчику 2, исполнительному механизму 3 и электронному блоку 4 управления. Фотооптический датчик 2, содержащий сканирующий узел 5, связанный с двумя преобразователями 6 и 7 фотоимпульсов в электрические сигналы, и генератор 8 маркерных импульсов, первый и второй выходы которого подключены соответствен но к раздельным входам первого пле- З5 ча 9 и второго плеча 1О схемы. совпадения, соединенной через каналы 11 и 12 с входами исполнительного механизма 3. Выход первого преобразовате—

2 ля 6 фотоимпульсов в электрические сигналы соединен с первым каналом 13 формирования управляющего сигнала и подключен непосредственно к усилителю-формирователю 14. С первым выходом генератора 8 маркерных импульсов соединены входы первого 15 и второго 16 формирователей временных интервалов, выходы которых связаны соответственно с первым входом первой схемы 17 селекции и с первым входом схемы 18 запрета, выход которой соединен с первым входом второй схемы 19 селекции. Вторые входы схем 17 и 19 селекции подключены к выходу усилителя-формирователя 14, а их выходы через первый 20 и второй 21 формирователи импульсов подсоединены к входам схемы ИЛИ 22, первый из входов которой связан, кроме того, через интегрирующую цепочку 23 и электронный ключ 24 с вторым входом схемы 18 запрета. Выход второго преобразователя 7 фотоимпульсов в электрические сигналы соединен с вторым каналом 25 формирования управляющего сигнала, который полностью аналогичен первому каналу 13, и подключен непосредст- . венно к усилителю-формирователю 26.

С первым выходом генератора 8 маркерных импульсов соединены входы третьего 27 и четвертого 28 формирователей временных интервалов, выходы которых связаны соответственно с первым входом третьей схемы 29 селекции и с первым входом схемы 30 запрета, выход которой соединен с первым входом схемы 30 запрета, выход которой со;единен с первым входом четвертой схе1336965 мы 31 селекции. Вторые входы 29 и

31 селекции подключены к выходу усилителя-формирователя 26, а их выходы через третий 32 и четвертый 33 формирователю импульсов и подсоединены к входам схемы ИЛИ 34, первый из входов которой связан, кроме того, через интегрирующую цепочку 35 и электронный ключ 36 с вторым входом схемы 30 запрета. Выходы .первого 13 и второго 25 каналов одновременно соединены с первыми входами соответствующих схем 37 и 38 запрета управляющих сигналов и с входами схемы 39 совпадения управляющих сигналов, выход которой через первую интегрирующую цепочку 40 управляющих сигналов и первый электронный ключ 41 связан с вторым входом схемы 38 запрета, выход которой через вторую интегрирующую цепочку 42 управляющих сигналов, схему 43 временной задержки и второй электронный ключ 44 соединен с вторым входом схемы 37 запрета управляющих сигналов, выходы схем 37 и 38 запрета и схемы 39 совпадения управляющих сигналов подключены к входам трехвходовой схемы ИЛИ 45, выход которой соединен с общими входами первого 9 и второго 10 плеча двухплечевой схемы совпадения.

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

В исходном состоянии (до начала движения) мобильный агрегат устанавливается относительно светоконтрастной программы, как показано на фиг.2.

По дугам АВ и СД происходит двухстрочная электрическая развертка сканируемой поверхности. Для повышения помехоустойчивости устройства от далеко отстоящих от базовой линии светоконтрастных помех из электрической развертки, сканируемой поверхности, вырезаются участки AM, NB, CR, РД и в связи с этим воспринимаются и обрабатываются лишь те сигналы, которые поступают внутри дуг MN u RP разрешенной зоны обзора по углу т.

При работе в режиме "Поиск" воспринимаемая зона расширяется по дугам Kh u ES по углу р до возвращения мобильного агрегата в требуемое поло— жение относительно светоконтрастной программы. На фиг. 2 х — х — естес5 твенные светоконтрастные образования (помехи), à — светоконтрастная граница. му ИЛИ 45 подаются на плечи 9 и 10 схемы совпадения.

С выходов преобразователей 6 и 7 фотоимпульсов электрические сигналы, соответствующие развертке сканируемой поверхности по дугам АВ и СД, поступают на усилители-формирователи 14 и 26 и далее на первые входы соответствующих схем 17 и 19 селекции, а также 29 и 31. На вторые входы схем 17 и 29 селекции от формирователей 15 и 27 временных интервалов поступают прямоугольные импул -сы разрешенной зоны обзора", совпадающие по времени поступления и длительности с участками MN u RP электрической сканируемой поверхности. Схемы 18 и 29 селекции производят стробирование, т.е. пропускают на входы формирователей 20 и 32 временных интервалов только участки MN и ВР, в которых находится сигнал от светоконтрастной границы.

С выходов формирователей 20 и 32 сигналы поступают на первые входы схем

ИЛИ 22 и 34 и на входы интегрирующих элементов 23 и 35, которые при этом вырабатывают напряжение, достаточное для постоянного включения электронных ключей 24 и 36, запрещающих прохождение прямоугольных импульсов, совпадающих по времени поступления и длительности с участками KL u ES электрической развертки сканируемой поверхности с выходов других формирователей 16 и 28 временных интервалов зоны "Поиск" через схемы ИЛИ 18 и 30 на вторые входы схем 19 и 31 селекции. Таким образом, на вторые входы сх м ИЛИ 22 и

34 импульсы из участков KL u ES не проходят. С выходов схем ИЛИ 22 и 34 обоих каналов 13 и 25 формирования управляющих сигналов импульсы поступают на схему 39 совпадения и через схеДлительность паузы между первым и вторым маркерными импульсами равна длительности управляющего импульса.

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

Если же управляющий импульс совпадает по времени поступления на входы плеч 9 и 10 с первым либо с вторым маркерным импульсом, то это свидетель ствует о наличии рассогласования, и на соответствующем плече 9 или 1О схемы совпадения появляются электрические импульсы — команды на поворот, которые через канал 11 или 12 поступают на исполнительный механизм 3, корректирующий курс движения агрегата.

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

В приведенных диаграммах первые два периода сканирования соответствуют движению агрегата без отклонений от светоконтрастной программы, последующие два периода соответствуют появлению рассогласования во времени формирования светоконтрастного перепада по дуге АВ (фиг. 2) относительно опорного времени, при отсутствии этого рассогласования при сканировании по дуге СД (фиг. 2), при этом на вы— ходе только первого преобразователя 6 фотоимпульсов электрический сигнал смещается.

Последующие три периода свидетельствуют о наличии рассогласования во времени появления светоконтрастного перепада в обоих преобразователях 6 и 7 фотоимпульсов и постепенном устранении этого рассогласования за счет поворота агрегата в сторону .устранения возникшего рассогласования. Последний период соответствует возвра— щению агрегата на светоконтрастную программу.

При появлении рассогласования (тре тий период фиг. 4) импульс на выходе первого усилителя-формирователя 14 смещается во времени (диаграмма 6, фиг. 4) и в соответствии с наличием разрешений на выходах формирователей 15 и 16 временных интервалов (диа граммы д, е, фиг. 4) переводит первый информационный канал 13 в режим "Поиск, при этом на выходе информационного канала 13 (диаграмма >к, фиг. 4) импульсы могут совсем пропасть (от третьего до пятого периода диаграммы фиг. 4) либо при прохождении в режиме

"11оис к появляя>тся смещения во времени (шестой и седl мой периоды) о гноси— тельно опорного времени между первым

55 и вторым маркерными импульсами.

Одновременно с этим на выходе второго информационного канала 25 (диаграмма з, фиг. 4) импульсы первые четыре периода сканирования не смещаются. Г1оявление рассогласования во времени образования импульсов с выхода первого канала 13 приводит к отсутствию импульсов на выходе схемы 39 совпадения и прохождению импульсов с второго канала 25 через схему 38 запрета и схему ИЛИ 45, образуя управляющий импульс (диаграмма л, фиг. 4) на входах плеч 9 и 1О схем совпадения.

В дальнейшем при смещении импульса, сформированного вторым каналом 25 (периоды от пятого до седьмого) он совпадает во времени формирования с одним из маркерных импульсов на выходах интегратора 8 (диаграммы м, к, фиг. 4).

При этом на выходе одного из плеч 9 и 10 схемы совпадения появляется электрический импульс — команда на поворот агрегата.

В приведенной диаграмме на фиг. 4 первые четыре периода сканирования импульсы на выходе схемы ИЛИ 45 поступают точно в интервале времени между первым и вторым маркерными импульсами, затем последующие три периода импульсы на выходе схемы ИЛИ 45 совпадают полностью или частично с вторым маркерным импульсом и последний на диаграмме период импульса вновь поступает в интервале времени между маркерными импульсами. Порядок отработки исполнительными механизмами отклонений от заданного направления движения заключается в том, что при появлении импульсов-команд на поворот агрегата в соответствии с описанным выше порядком импульсы с выходов плеч 9 или 10 схемы совпадения воздействуют через канальные формирователи 11 либо 12 на исполнительный механизм 3, в качестве которого, в частности, может использоваться электрогидравлический исполнительный механизм, в результате чего срабатывает один из электромагнитов, осуществляя воздействие на рулевое управление, в результате чего происходит поворот агрегата в направлении устранения возникшего рассогласования.

l33696

В случае воздействия на агрегат какого †ли случайного фактора (например, наезд на какую-либо неровность) может произойти быстрое смещение по5 ложения агрегата относительно светоконтрастной программы таким образом, что светоконтрастная граница выпадает из разрешенных зон обзора NN H RP.

При этом в электрической развертке lð не содержится сигнального импульса и с выходов схем 17 и 29 селекции формирователя 20 и 32 временных интервалов на первые входы схем ИЛИ 22 и

34 и входы интегрирующих элементов 23 и 35 перестанут поступать управляющие импульсы, что ведет к выключению электронных ключей 24 и 36 и подаче на вторые входы схем 18 и 30 запрета уровней напряжения, разрешающего прохождение импульсов с выходов формирователей 16 и 28 временных интервалов зоны "Поиск" через схемы 18 и 30 запрета на вторые входы схем 19 и 31 селекции. Так как в этом случае све- 25 ! токонтрастная граница находится внутри участка KL и ES, то сигнальные импульсы будут выделены схемами 19 и

31 селекции и через формирователи 21 и 33 временных интервалов и схемы gp

ИЛИ 22 и 34 поступят через схему 39 совпадения и схему ИЛИ 45 на общие входы плеч 9 и 10 схемы совпадения, которая через канальные формирователи 11 и 12 воздействует на исполни— тельный механизм. Как только агрегат повернется настолько, что светоконтрастная граница окажется внутри участков KL и ES, на выходе схем 17 и 29 селекции появятся сигнальные импуль- 4р сы, которые через формирователи 20 и

32 поступают на входы схем ИЛИ 22 и

34, а также на интегрирующие элемен— ты 23 и 35, которые включают электронные ключи 24 и 36, подавая напря- 45 жение на входы схем 18 и 30 запрета, и тем самым запрещается прохождение импульсов с выходов формирователей 16 и 28 временных интервалов зоны "По50 — Таким образом, участок сканируемой поверхности сужается с зоны "IIoиск" KL u ES до "разрешенной зоны обзора" MN u RP.

При появлении помехи х (фиг. 2) на самой светоконтрастной границе и перемещении агрегата до пересечения контрастной помехи сканирующей разверткой по дуге АВ управляющий им5

8 пульс с выхода первого канала 13 формирования смещается во времени, либо вообще исчезает (t, на фиг. 3), а временное положение управляющего импульса с выхода второго канала 25 формирования остается неизменным (фиг. Зб). Это приводит к отсутствию управляющих импульсов на выходе схемы 39 совпадения (фиг, Зв), в результате чего интегрирующая цепочка 40 уменьшает выходное напряжение до от— ключения электронного ключа 41, разрешающего в этом состоянии прохождение управляющих импульсов с выхода второго канала 25 формирования через схему 38 запрета (фиг. Зг) и трехвходовую схему ИЛИ 45 (фиг. 3c) на общие входы первого 9 и второго 10 плеча схемы совпадения в период времени между первым и вторым маркерными импульсами (фиг. Зж), продолжая тем самым движение агрегата без изменения курса. Управляющие импульсы с выхода схемы 38 запрета через интегрирующую цепочку 42 поддерживают на выходе схемы 43 временной задержки напряжение, достаточное для отключения второго электронного ключа 44, запрещающего на заданное время прохождение управляющих импульсов с первого канала 13 формирования через схему 37 запрета. Дальнейшее движение агрегата приводит к тому, что контрастная помеха х (фиг. 2) пересекается сканирующей разверткой не по дуге АВ, а по дуге СД. При этом управляющие импульсы на выходе второго канала 25 формирования (t на фиг. Зб) исчезают. Отсутствие в это время управляющих имгульсов со схемы 38 запрета (фиг. Зг) приводит к уменьшению напряжения на выходе интегрирующей цепочки 42. Некоторое время, определяемое схемой 43 временной задержки, напряжение на выходе электронного ключа 44 поддерживает его отключенным, благодаря чему вновь появившиеся управляющие импульсы с выхода первого канала 13 формирования проходят через схему 37 saпрета (фиг. Зд) и трехвходовую схему ИЛИ 45 (фиг. 3e) на общие входы плеч 9 и 10 двухплечевой схемы совпадения, также сохраняя неизменным курс движения агрегата. Затем вследствие продолжающегося движения агрегата на обоих строках электронной развертки исчезает помеха и на выхо40

Формула изобретения

Устройство для автоматического вождения мобильного агрегата, содержащее источник электропитания, испол- 45 нительный механизм, фотооптический датчик, включающий сканирующий узел, преобразователь фотоимпульсов в электрические сигналы и генератор маркерных импульсов, и электронный блок управления, включающий двухплечевую схему совпадения, раздельные входы которой соединены с выходBMH генера— тора маркерных импульсов, а выходы через канальные преобразователи свя-заны с исполнительным механизмом, и первый канал формирования управляющего сигнала, состоящий из усилителя— формирователя, вход которого связан

9 !

33б9 дах обоих каналов 13 и 25 формирова-, ния управляющих сигналов появляются импульсы (t на фиг, За), которые через схему 39 совпадения поступают на трехвходовую схему ИЛИ 45, при этом через время, определяемое схемой 43 временной задержки, на ее выходе напряжение изменяется, приводя к включению электронного ключа 44, запрещающего прохождение управляющих импульсов с выхода первого канала 33 формирования через схему 37 запрета.

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

Таким образом, система автовождения не изменяла курс движения мобильного агрегата, несмотря на светоконтрастную помеху (фиг . 2), расположенную непосредственно на базовой линии светоконтрастной программы.

Пространственные размеры помех, на которые система автовождения ложно не срабатывает, могут регулировать-25 ся изменением времени задержки сигналов схемой 43.

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

ИЛИ, первый из входов которой соединен, кроме того, через интегрирующую цепочку и электронный ключ с вторым входом схемь| запрета, î т л и ч а ющ е е с я тем, что, с целью повышения качества выполнения технологического процесса устройством автовождения, в фотооптический датчик введен второй преобразователь фотоимпульсов в электрические сигналы, а электронный блок управления дополнительно снабжен вторым каналом формирования управляющих сигналов, пространственно разнесенным с первой, второй и первой интегрирующей цепочкой управляющих сигналов, первым и вторым электронными ключами, схемой временной задержки и трехвходовой схемой

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

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

Г!

0)

4Ью. дня 7 г) дух.

У)

u) к)

Составитель B. Кузьмич

Редактор Н. Слободяник Техред M.Ходанич Корректор В. Бутяга

Заказ 4061/1 Тираж 627 Подписное

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

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

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