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

 

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

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

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

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

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

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

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

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

ПРИ ГКНТ СССР (21) 4478120/30-15

1 (22) 30.08.88 (46) 15.11.90. Бюл. № 42 (71) Одесский филиал Научно-производственного объединения по тракторостроению

«НАТИ» (72) Г. М. Лавров, P. А. Гроховский и В.. В. Андрианов (53) 631.311 (088.8) (56) Авторское свидетельство СССР № 625650, кл. А 01 В 69/04, 1977.

БО,» 1605953 д1

2 (54) УСТРОЙСТВО ДЛЯ АВТОМАТИЧЕСКОГО ВОЖДЕНИЯ САМОХОДНОГО АГРЕГАТА (57) Изобретение касается сельского хозяйства, в частности сельскохозяйственного машиностроения, и может быть использовано в системах автоматического управления вождением сельскохозяйственных агрегатов.

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

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

На фиг. 1 представлена функциональная схема устройства; на фиг. 2 — - схема коррекции траектории движения самоходного агрегата, где У, — ордината заданной траектории движения самоходного агрегата; Y — ордината фактической траектории движения кинематического центра агрегата; Л вЂ” траекторное рассогласование кинематического центра агрегата; в — траекторное рассогласование направляющей точки, воспринимаемое чувствительным элементом датчика траекторного рассогласования; U — управ I ляющий сигнал; q> — угловая скорость поворота агрегата; — угол курса агрегата;

fi, f — возмущения, действующие на чувствительные элементы датчиков; в, о — возмущения, действующие на агрегат соответственно в движении поворота и в боковом скольжении.

Устройство для автоматического вождения самоходного агрегата содержит датчики траекторного 1 и курсового 2 рассогласования, соответственно первый 3 и второй 4 усилители, инвертор 5, первый 6 и второй 7 сумматоры, инерционное звено 8, интегратор 9, формирователь 10 выходного сигнала устройства. Модель самоходного агрегата включает также инерционное звено 11 (сервопривод и динамика поворота агрегата), сумматоры 12 — 15, интеграторы 16 и 17, масштабный блок 18.

Датчик траекторного рассогласования измеряет траекторное рассогласование нара 6 через инерционное звено 8. Выход первого сумматора 6 связан с входами второго сумматора 7 непосредственно и через интегратор 9. Выход второго сумматора 7 соединен с входом формирователя 10 выходного сигнала, выход которого является выходом устройства. Сигналы датчиков тракторного 1 и курсового 2 рассогласования через первый сумматор 6 попадают на вход второго сумматора 7. Формирователь

l0 выходного сигнала преобразует и усиливает выходной сигнал второго сумматора 7 для использования его в процессе управления исполнительным механизмом поворота самоходного агрегата. 2 ил. правляющей точки в, датчик курсового 2 рассогласования измеряет курсовое рассогласование ср, что поясняет фиг. 2. Термин

«траекторное рассогласование» относится к

25 величине разности линейных координат требуемой (заданной, программнои) и фактической траекторий; «курсовое рассогласование» вЂ” к величине разности требуемого и фактического углового положения конструктивной, обычно продольной оси объекта, gO в данном случае — звена самоходного агрегата, содержащего датчики траекторного

1 и курсового 2 рассогласования.

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

Сигнал датчика траекторного рассогласования содержит информацию о величине отклонения траектории движения направляющей точки самоходного агрегата от заданной траектории. Эта величина складывается из траекторного рассогласования кинематического центра агрегата и курсовой составляющей, которая определяется продольным смещением направляющей точки, в которой воспринимает информацию чувствительный элемент (например, щуп копирующего устройства) датчика траекторного 1 рассогласования относительно кинематического центра агрегата (точки агрегата, скорость которой при отсутствии возмущений направлена параллельно продольной оси самоходного агрегата). Указанное продольное смещение а обычно не может быть произвольным, а его выбор ограничен компоно50 вочными требованиями и возможностями чувствительного элемента датчика траекторного 1 рассогласования. Сигнал датчика траекторного 1 рассогласования через первый усилитель 3 поступает на первый вход первого сумматора 6. Коэффициент передачи первого усилителя 3 должен быть равен определенному значению ai. Сигнал датчика курсового 2 рассогласования поступает на второй вход первого сумматора 6 через

1605953

10 аз Тр(Тр+ 1), 15

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

40 (1) (2) (3) 45

55 второй усилитель 4 и инвертор 5, а на третий вход первого сумматора 6 — через инерционное звено 8. Коэффициент передачи второго усилителя 4 должен быть равен значениюа|(аз — а2), коэффи циент передачи инерционного звена 8 — величине а1аз. Постоянная времени инерционного звена 8 должна составлять также определенное значение Т.

Сигнал с выхода первого сумматора 6 передается на первый вход второго сумматора 7 непосредственно, а на его второй вход— через интегратор 9. Коэффициент передачи интегратора 9 равен значению 1/T. С выхода второго сумматора 7 сигнал поступает на вход формирователя 10 управляющего-сигнала, выход которого является выходом устройства. Формирователь 10 преобразует- и усиливает выходной сигнал для использования его в исполнительном механизме поворота самоходного агрегата и представляет собой обычно широтно-импульсный модулятор либо пропорциональный усилитель в зависимости от вида исполнительного механизма и механизма поворота агрегата.

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

L скорость поворота ср. Она может быть вызвана и возмущающими силами (от рельефа, почвы), т. е. в. Этот процесс описывается инерционным звеном 1 и сумматором 12.

Коэффициент передачи инерционного звена 11 самоходного агрегата обозначим.К, постоянную времени этого звена Ti, коэффициент передачи интегратора 17 равен скорости движения V агрегата, масштабного блока 18 — а2, коэффициенты передачи остальных звеньев и блоков равны единице. Анализ статической динамики системы показывает; что оптимальные значения параметров устройства находятся в диапазонах

T= (10...20) T i, ate =1(азК1T i., аз(2,5".5) VTi

Изменение угла курса ср агрегата является результатом интегрирования угловой скорости ф, что описывается интегратором 16.

Направление движения агрегата определяется суммированием угла курса rp и угла бокового скольжения или сноса 8, что учитывается сумматором 13. В результате интегрирования боковой составляющей скорости движения агрегата в интеграторе 17 получаем координату У, кинематического центра агрегата. Алгебраически суммируя в сумматоре 14 координату У с координатой У программной траектории, получаем траекторное рассогласование Л кинематического центра 7, а в сумматоре 15 суммируя с величиной а2ср, моделируемой масштабным блоком 18 — траекторное рассогласование е направляющей точки.

При выполнении соотношений (! ), (2), (3) и значений параметров связь, реализуемая масштабным блоком !8, компенсируется в связи с тем, что параметр а> обусловлен конструкцией и не является оптимальным и устройство реализует отрицательную обратную связь по курсу с передаточной функцией реального дифференцирующего звена где P — оператор дифференцирования. Совместно с интегратором 9 указанное звено обеспечивает астатизм устройства и позволяет компенсировать влияние низких частот, преобладающих в возмущениях.

В вариантах выполнения устройство для колесных самоходных агрегатов с поворотными колесами или шарнирной рамой может содержать внутреннюю обратную связь по углу поворота колес, реализуемую датчиком угла поворота колес, сигнал которого через усилитель и инвертор должен подаваться на второй сумматор 7. Датчики траекторного 1 и курсового 2 рассогласования могут иметь различные исполнения: механическое, оптическое, а датчик курсового 2 рассогласования может быть выполнен на основе курсового гироскопа.

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

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

Составитель Л. Пантелеева

Редактор Н. Швыдкая Техред А, Кравчук Корректор Т. Малец

Заказ 3499 Тираж 494 Подписное

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

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

Производственно-издательский комбинат «Патент», r. Ужгород, ул. Гагарина, 101 вого рассогласования и выходом второго интегратора, при этом вход последнего соединен с выходом первого сумматора, а выход — с первым входом второго сумматора, выход которого через третий интегратор связан с первым входом пятого сумматора, причем первый вход первого сумматора подключен к выходу второго инерционного звена, вход которого связан с выходом формирователя выходного сигнала, а выход четвертого сумматора соединен с вторым входом шестого сумматора, выход которого подключен к первому входу второго сумматора, а второй и третий входы соответственно соединены с выходами второго усилителя и первого инерционного звена, 5 при этом выход датчика курсового рассогласования подключен к входу первого инерционного звена и через инвертор — к входу второго усилителя, причем вторые входы третьего, четвертого, и пятого сумматоров связаны соответственно с выходами первого, второго и третьего измерительных блоков.