Способ автоматического вождения колесного трактора и устройство для его осуществления

 

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

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

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

РЕСПУБЛИК (19) (11) (594 А01 В6904

I т

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

К ABTOPCHOMV СВИДЕТЕЛЬСТВУ

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

ПО ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТКРЫТИЙ (21) 3826589/30-15 (22) 12.12.84 (46) 23.05.87. Бюл. № 19 (71) Одесский филиал Государственного союзного научно-исследовательского тракторного института (72) Л. Д. Стоянов, В. В. Андрианов и P. А. Гроховский (53) 631.31(088.8) (56) Авторское свидетельство СССР № 312559, кл. А 01 В 69/06, 1971. (54) СПОСОБ АВТОМАТИЧЕСКОГО ВОЖДЕНИЯ КОЛЕСНОГО ТРАКТОРА И УСТPOACTBO ДЛЯ ЕГО ОСУЩЕСТВЛЕНИЯ (57) Изобретение относится к сельскому хозяйству и может быть использовано при работе на склонах. Цель изобретения упрощение устройства и расширение области его применения. Способ автоматического вождения колесного трактора включает поворот направляющих колес (НК), осуществляемый управляющим воздействием. Управляющий сигнал формируется из информ ационных сигналов траекторного рассогласования и угла поворота НК. Дополнительно выделяют сигнал текущего среднего значения угла поворота НК. Если этот сигнал за определенный промежуток времени не был меньше значения, соответствующего зоне нечувствительности системы автоматического вождения по данному каналу коррекции, то его используют для формирования результирующего управляющего воздействия.

Устройство автоматического вождения колесного трактора содержит датчик 1 траекторного рассогласования, датчик 1 угла поворота НК трактора, сумматоры 3 и 4, вычислитель 5 текущего среднего значения угла поворота, компараторы 6 и 7, задающий генератор 8, элемент ИЛИ 9, счетчик

10 импульсов, фильтр 11, ключи 12 — 15 и регулятор 16 с исполнительными усилителями механизма поворота трактора. Вождение Я осуществляется по траектории, определяемой равенством нулю управляющего сигнала.

При наличии уклона появляется сигнал на выходе датчика 2 угла поворота НК трактора, и логическая система коррекции вступает в действие. Осуществляется регулиро- Я вание направления движения трактора. 2 с.п. ф-лы, 2 ил.

СО ввю

1311641 где U, U„,—

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

Цель изобретения — упрощение устройства и расширение его области применения.

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

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

=t; ti — /; (i=1,2,...), на котором соблюдается условие IU„I)

> U„,; заданный промежуток времени, который отсчитывается от момента времени, при котором выполняется условие IU„I=

= U„,.

Исходя из изложенного, для случая

IUI == U, tI = tz — ti(to сигнал коррекции по крену отсутствует, а результирующий управляющий сигнал формируется с использованием сигналов датчиков тракторного рассогласования и угла поворота направляющих колес трактора.

Для случая IЫ ) U „6 = (ti — 4) ) 4 сигнал коррекции выделяется и результирующий управляющий сигнал формируется с использованием не только сигналов датчиков траекторного рассогласования и угла поворота направляющих колес трактора, но и устройства по крену трактора.

Устройство автоматического вождения колесного трактора содержит датчик 1 траекторного рассогласования, датчик 2 угла поворота направляющих колес трактора, сумматоры 3 и 4, вычислитель 5 текущего среднего значения угла поворота (ВТС), компараторы 6 и 7, задающий генератор 8, элемент ИЛИ 9, счетчик 10 импульсов, фильтр ll, ключи 12 — 15 и регулятор 16 с исполнительными усилителями механизма поворота трактора. Выходы датчиков 1 и 2 соединены с входами сумматора 3, выход которого через сумматор 4 соединен с регулятором 16 с исполнительными усилителями механизма поворота трактора. Выход дат5

2S

55 чика 2 угла поворота направляющих колес соединен также с ВТС 5, выход которого через компараторы 6 и 7, элемент ИЛИ 9 соединен с входом сброса счетчика 10 импульсов. Выход ВТС 5 через ключ 15 и фильтр 11 соединен с сумматором 4.

Задающий генератор 8 соединен с сигнальными входами ключей 12 и 13, выходы которых соединены с сигнальными входами ключа 14. Выход последнего соединен со счетным входом счетчика 10 импульсов, выход которого соединен с входами управления ключей 14 и 15. Выходы компараторов 6 и 7 соединены с входами управления ключей 12 и 13.

Автоматическое вождение трактора осуществляется по траектории, определяемой равенством нулю управляющего сигнала, т. е. сигнала на выходе сумматора 4. Исходные состояния логических элементов устройства при сигнале датчика 2 угла поворота направляющих колес трактора, равном нулю, следующие: компараторы 6 и 7 не задействованы, счетчик 0 находится в исходном состоянии, ключи 12, 13 и 15 закрыты, а ключ

14 открыт.

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

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

При движении трактора сигнал датчика 2 угла поворота направляющих колес через ВТС 5 поступает на компараторы

6 и 7. Причем последние настроены так, что один из них (например, компаратор 7) срабатывает при положительном значении сигнала ВТС 5, а другой (компаратор 6)— при отрицательном значении этого сигнала.

Если сигнал датчика 2 угла поворота направляющих колес трактора положительный и больше порога срабатывания компаратора, то срабатывает компаратор 7. Это приводит к тому, что элемент ИЛИ 9 вырабатывает сигнал, поступающий на вход сброса счетчика 10. Этот сигнал устанавливает счетчик 10 в исходное состояние. Срабатывание компаратора 7 открывает ключ 13 и импульсы задающего генератора 8 через открытые ключи 13 и 14 поступают на счетный вход счетчика 10. Появление сигнала на выходе датчика 2 угла поворота направляющих колес трактора в данном

1311641 случае вызвано действием управляющего сигнала системы автоматического вождения трактора, в котором отсутствуют возмущения, вызванные уклоном поля, т. е. условие (1) не выполняется за счет того, что t, (4.

Это приводит к тому, что сигнал на выходе датчика 2 угла поворота направляющих колес трактора становится меньше порога срабатывания компаратора 7 раньше, чем происходит заполнение счетчика 10 им- 10 пульсами задающего генератора 8.

Таким образом, ключ 15 не открыт и сигнал коррекции в данном случае не вырабатывается.

При движении трактора по полю с уклоном устройство работает аналогично опи- 15 санному за исключением того, что в данном случае условие (1) выполняется, т. е. t; ) tp, (4 — 3 ) 1 0.

Соблюдение условия (1) приводит к тому, что объем счетчика 10 заполняется импульсами задающего генератора 8. Заполнение объема счетчика 10 приводит к тому, что ключ 14 закрывается, а ключ 15 открывается. Открывание последнего приводит к тому, что сигнал с выхода ВТС 5 через фильтр 11 поступает на вход сумматора 4, 25 где, суммируясь с сигналами датчика 1 траекторного рассогласования и датчика 2 угла поворота направляющих колес трактора, поступает на регулятор 16 с исполнительными усилителями механизма поворота трактора.

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

Таким образом, начиная с момента времени 4 + 4 система автоматического вождения осуществляет коррекцию движения трактора по крену.

С целью сглаживания скачков сигнала коррекции в момент 4 + to включения канала коррекции на выходе ключа 15 установлен фильтр 11, постоянная времени которого определяется допустимым скачком сигнала коррекции, который отрабатывает система 45 автоматического вождения без перерегулирования.

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

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

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

1311641

Составитель А. Сапиженков

Редактор Н. Бобкова Техред И. Верее Корректор А. Тяско

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

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

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

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