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

 

Изобретение относится к сельскохозяйственному машиностроению, в частности к устройствам автовождения гусеничных тракторов. Цель изобретения - повышение качества работы контура управления угловым ускорением. Устройство содержит основной контур управления и контур управления угловым ускорением. Основной контур управления содержит соединенные последовательно чувствительный элемент 1, датчик 2, элемент 3 формирования алгоритма управления, сервопривод 4 и трактор 5. Контур управления угловым ускорением содержит соединенные последовательно датчик 11 положения, реле 12 времени, привод 13 возврата, трехпозиционный анализатор 9 и реверсивный привод 10. Выход реверсивного привода 10 соединен с вторым входом сервопривода 4. Вход датчика 11 положения соединен с выходом сервопривода 4. Второй выход реле 12 времени соединен с вторым входом трехпозиционного анализатора. Положительный эффект достигается за счет того, что устройство снабжено звеном 7 двойного дифференцирования. Звено 7 двойного дифференцирования соединено выходом с третьим входом трехпозиционного анализатора 9 через исполнительный элемент 8. Вход звена 7 соединен через управляемый ключ 6 с выходами датчика 2 и элемента 3 формирования алгоритма управления. Повышение качества работы контура управления угловым ускорением достигается за счет повышения помехозащищенности устройства. Помехозащищенность обеспечивается введением в схему устройства звена 7 двойного дифференцирования и управляемого ключа 6. Последний осуществляет подачу сигнала на трехпозиционный анализатор 9 только в момент подачи управляющего сигнала на сервопривод 4. 2 ил.

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

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

РЕСПУБЛИК . (51)5 А 01 В 69/04

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

ПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМ

ПРИ ГКНТ СССР

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

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 4182225/30-15 (22) 19.01.87 (46) 07.11.90. Бюл. М 41 (71) Всероссийский научно-исследовательский институт сои (72) А.А.Черпак (53) 631.17(088.8) (56) Авторское свидетельство СССР

М 1521318, кл. А 01 В 69/04. 1987. (54) УСТРОЙСТВО УПРАВЛЕНИЯ УГЛОВЫМ УСКОРЕНИЕМ В СИСТЕМЕ АВТОВОЖДЕНИЯ (57) Изобретение относится к сельскохозяйственному машиностроению, в частности к устройствам автовождения гусеничных тракторов. Цел ь изобретения — по вы шен ие качества работы контура управления угловым ускорением, Устройство содержит основной контур управления и контур управления угловым ускорением. Основной контур управления содержит соединенные последовательно чувствительный элемент

1, датчик 2, элемент 3 формирования алгоритма управления, сервопривод 4 и трактор

5. Контур управления угловым ускорением содержит соединенные последовательно датчик 11 положения реле 12 времени при„„5U „„1604182 A 1 вод 13 возврата, трехпозиционный анализатор 9 и реверсивный привод 10. Выход реверсивного привода 10 соединен с вторым входом сервопривода 4. Вход датчика 11 положения соединен с выходом сервопривода 4. Второй выход реле 12 времени соединен с вторым входом трехпоцизионного анализатора. Положительный эффект достигается за счет того, что устройство снабжено звеном 7 двойного дифференцирования. Звено 7 двойного дифференцирования соединено выходом с третьим входом трехпозиционного анализатора 9 через исполнительный элемент 8. Вход звеча 7 соединен через управляемый ключ 6 с выходами датчика 2 и элемента 3 формирования алгоритма управления. Повышение качества работы контура управления угловым ускорением достигается за счет повышения помехоустойчивости устройства, Помехозащищенность обеспечивается введением в схему устройства звена 7 двойного дифференцирования и управляемого ключа 6. Последний осуществляет подачу сигнала на трехпозиционный анализатор 9 только в момент подачи управляющего сигнала на сервопривод 4. 2 ил, 1604182

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

На фиг, 1 приведена структурная схема устройства, на фиг. 2 — конструктивная схема трехпозиционного анализатора с исполнительным элементом и приводом возврата.

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

ОсноВНОГО контура $ ïpÿÂëeHèÿ и контурауправления угловым ускорением. Основной контур управления состоит из чувствительного элемента 1, датчика 2, элемента 3 формирования алгоритма управления, сервопривода 4 и трактора 5. Контур управ. ления угловым ускорением Состоит из управляемОГО ключа 6, зВена 7 двОЙнОГО дифференцирОВания, испОлнительнОГО элемента 8, трехпозиционного анализатора 9, реверсивного привода 10, датчика 11 положения сервопривода 4, реле 12 времени, привода 13 возврата, Трехпозиционный анализатор 9 содержит неподвижный контакт 14, изоляционную вставку 15„второй

КоНТ8КТ 16 N подвижный кОнтакт 17, 3Jl8менты 1 — 5 соединены последовательно и охвачены обратной связью между трактором 5 и входом чувствительного элемента 1.

Элементы 6-10 соединены последовательно, Входом элемента 6 является выход элемента 2, вторьм входом элемента 6 является выход элемента 3. Выход элемента

10 соединен с вторым входом элемента 4, Элементы 11 — 13 соединены последовательно. Вход элемента 11 соединен с выходом элемента 4. Выход элемента 13 соединен с вторым входом элемента 9. Второй выход элемейта 12 соединен с третьим входом элемента 9.

Элемент 1 выполнен в виде чувствительного элемента любой конструкции: копира, индукционного, фотооптического и т.д. его назначение — регистрировать отклонения трактора 5 от базовой линии борозды, рядка растений, провода с током и т.д. Элемент 2 выполнен в виде датчика любой конструкции и предназначен для подачи команды на элемент 3 формирования алгоритма управления. Элемент 3 предназначен для преобразования сигнала датчика 2 во временной импульс х . В качестве его может быть применено импульсное устройство любой конструкции, Сервопривод 4 состоит из.гидрозлектрозолотникоВОГО устрОйства и Гидроцилиндра. Выходом сервопривода 4 является ход штока гидроцилиндра, который связан с ме5 ханизмом поворота трактора 5, При помощи дросселя регулируемого сечения, установленного в сливном трубопроводе сервопривода 4, осуществляют регулирование скорости перемещения штока

10 сервопривода 4 при возврате. При увеличении сечения дросселя скорость увеличивается, а при уменьшении сечения уменьшается, В ыход сервоп ривода 4 соединен с рыча15 гом управления направлением движения трактора 5. При увеличении скорости возврата штока сервоп ри вода 4 (увеличение сечения дросселя) угловое ускорение трактора при завершении поворота увеличивается, а

20 при уменьшении скорости возврата штока умен ьшается.

Управляемый ключ 6 выполнен, например, в виде электромагнитного реле, с задержкой времени тз на отключение, 25 обмотка которого представляет второй вход и соединяется с выходом элемента 3. Первым входом элемента 6 является сигнал, поступающий с элемента 2 на неподвижный нормально разомкнутый контакт реле, а вы30 ходом элемента 6 является сигнал, снимаемый с подвижного нормально разомкнутого контакта реле. Во время поступления управляюшего сигнала т с элемента 3 на сервопривод 4 происходит замыкание нормально

35 разомкнутых его контактов и сигнал от элемента 2 поступает на вход элемента 7. После окончания сигнала тц элемента 3 и окончания времени тэ задержки элемента 6 нормально разомкнутые контакты элемента 6

40 размыкаются и сигнал от элемента 2 не проходит на элемент 7, Элемент 6 может быть выполнен и в виде полупроводникового реле. Время задержки s3 элемента 6 при отключении принимается равным времени окончания реакции трактора 5 на управляющий сигнал

Элемент 7 выполнен в виде двух последовательно соединенных электрических дифференцирующих звеньев. Он обеспечивает на выходе сигнал ти с учетом времени задержки r3 ключа 6, функционально зависящий от углового ускорения трактора 5 за счет того, что в указанный период изменение сигнала на выходе элемента 1 зависит в основном от переходного процесса трактора 5, Выходной сигнал элемента 1 преобразуется элементом 2 в электрический пропорциональный сигнал и дважды дифференцируется элементом 7.

1604182

Исполнительный элемент 8 выполнен в виде электромагнита с подпружиненным сердечником. Перемещение сердечника пропорционально величине сигнала на выходе элемента 7„т,е. пропорционально ускорению трактора 5.

Трехпозиционный анализатор 9 выполнен в виде направляющей и подвижного контакта f7. Направляющая содержит неподвижный контакт 14, изоляционную вставку 15 и второй контакт 16. Подвижный контакт 17 может перемещаться вдоль направляющей и оставаться в фиксированном положении. Анализатор 9 обеспечивает трехпозиционную характеристику, аналогичную характеристике реле с зоной нечувствительности со значениями + 1, О, -1.

Перемещение контакта 17 по направляющей обеспечивается исполнительным элементом 8 и приводом 13 возврата.

Реверсивный привод 10 представляет собой привод с характеристикой, соответствующей характеристике тягового двигателя, Выходной орган реверсивного привода 10 связан с регулирующим органом дросселя сервопривода 4. Датчик 11 положения сервопривода выполнен в виде концевого выключателя, контакт которого замыкается, когда шток сервопривода 4 занимает исходное положение, и размыкается при начале рабочего хода сервопривода 4.

Реле 12 времени выполнено на основе реле времени любой конструкции. Оно вырабатывает импульс опроса r<>, который через второй выход элемента 12 поступает на третий вход элемента 9. Кроме того реле 12 времени после окончания имульса опроса

r<> вырабатывает импульс сброса тс, который через первый выход реле 12 поступает на вход привода 13 возврата. Привод 13 возврата выполнен в виде электромагнита с подпружиненным сердечником. Перемещение его сердечника является выходом элемента 13, Исполнительный элемент 8 и привод 13 возврата установлены таким образом, что их сердечники могут перемещать подвижный контакт 17 (фиг. 2).

Все элементы схемы могут быть выполнены по аналогии на основе бесконтактных электронных устройств.

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

Основной контур управления трактором 5 производит его автовождение. При этом элемент 1 регистрирует отклонение от базы, элемент 2 преобразует сигнал элемента 1 в электрический сигнал и подает команду на элемент 3. Последний преобразует сигнал в управляющий импульс т, ние нормально разомкнутых контактов элемента 6 на время, равное r., + т,. В течение этого времени сигнал от элемента 2 через элемент 6 поступает на элемент 7, где он

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

55 длительность которого определяется алгоритмом управления, заложенного в элемент

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

После прекращения сигнала т„шток сервопривода 4 возвращается в исходное положение. Поворот трактора 5 прекращается.

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

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

При каждом управляющем сигнале t< за счет сигнала элемента 3 происходит включеэлемента 8 возвращается в исходное положение, а подвижный контакт 17 остается в положении, соответствующем максимальному угловому ускорению трактора 5. Подвижный контакт 17 может занимать положения над элементами 14, 15 или 16.

Если контакт 17 находится в зоне элемента

14, ускорение мало. Если контакт 17 находится в зоне элемента 15, то ускорение в норме. Если контакт 17 находится в зоне элемента 16, то ускорение больше нормы, После возврата сервопривода 4 в исходное положение срабатывает датчик 11 положения, который подает сигнал на реле 12 л времени. Оно вырабатывает импульс опроса г, который подается на третий вход трехпозицианного анализатора 9, Импульс опроса т поступает на реверсивный привод

10, который изменяет сечение регулируемого дросселя, изменяя тем самым величину скорости возврата штока сервопривода 4, т.е. изменяя угловое ускорение трактора 5 при следующих управляющих импульсах и с элемента 3. Если контакт 17 находится над элементом 15, то си нал t> не проходит на элемент 10 и угловое ускорение трактора 5 не изменится.

После окончания импульса ro реле 12 вырабатывает импульс гс, который поступа1604182

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

Составитель С,Заруцкий

Техред M.Mîðãåíòàë Корректор Т.Палий

Редактор Л.Зайцева

Заказ 3401 Тираж 492 Подписное

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

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

Производственно-издательский комбинат "Патент", г. Ужгород, ул.Гагарина, 101 ет на элемент 13 и сердечник последнего возвращает контакт 17 в исходное положение, находящееся в зоне элемента 14. Происходит управление угловым ускорением.

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

Устройство управления угловым ускорением в системе автовождения. содержащее основной контур управления с соединенными последовательно чувстви- 15 тельным элементом, датчиком, элементом формирования алгоритма управления, сервоприводом и объектом управления, обратной связью соединенным с чувствительным элементом, и контур управления угловым 20 ускорением с соединенными последовательно датчиком положения, реле времени с реверсивным приводом, трехпозиционным анализатором и реверсивным приводом, при этом датчик положения связан с выходом сервопривода, реле времени вторым выходом соединено с трехпозиционным анализатором, а реверсивный привод соединен с вторым входом сервопривода, о тличающееся тем,что,сцельюповышения качества работы контура управления угловым ускорением, последний снабжен последовательно соединенными управляемым ключом, звеном двойного дифференцирования и исполнительным элементом, выход которого подключен к третьему входу трехпозиционного анализатора, при этом первый вход управляемого ключа соединен с выходом датчика, а второй-с выходом элемента формирования алгоритма управления.