Система автоматического вождения сельскохозяйственного агрегата по заданной траектории

ООЭ СОВЕТСКИХОЦИАЛИСТИЧГСКИХЕСПУБЛИК 1 о 18 958 А 1)5 А 01 В 69/04 ГОСУДАРСТВЕННОЕ ПАВЕДОМСТВО СССР(ГОспАтент сссР) ТНО АВТОРСКОМ ВИДЕТЕЛЬСТВУ ОПИСАНИЕ ИЗОБР(56) Авторское свйдетельство СССР(54) СИСТЕМА АВТОМАТИЧЕСКОГО ВОЖДЕНИЯ СЕЛЬСКОХОЗЯЙСТВЕННОГО АГРЕГАТА ПО ЗАДАННОЙ ТРАЕКТОРИИ(57) Использование: в сельскохозяйственном машиностроении. Система содержит впередней части агрегата ориентир-водитель, выполненный в виде планки, закрепленной на вертикальной оси с злектооннымдатчиком отклонения, чувствительным элеИзобретение относится к сельскому хозяйству, в частности к системам направления тракторов по ориентирующим линиям,Целью изобретения является повышение точности автоматического вождения.На фиг,1 изображена схема системы автовождения сельскохозяйственного агрегата по заданной траектории; на фиг.2 -графики сигнальных токов основного ивспомогательного контуров парафазногодальномера в зависимости от разности фазизмерительного и сигнального токов и дальности от ориентира,Система автоматического вождениясельскохозяйственного агрегата содержиториентир-водитель 1 в виде корпуса и планки 2, подвешенной на вертикальной оси краме 3 агрегата в передней зоне обзора ментом которого является приемопередатчик дальномера, направленный перпендикулярно продольно оси стрелки и соединенный через схемы обработки сигнала правого и левого отклонений с инвертирующими и неинвертирующими входами пары компараторов, выходы которых соединены с электромагнитами переключающего электрогидрораспределителя, сообщенного гидравлически с гидроцилиндром поворота управляемых колес агрегата через полости поршневого мотор-насоса, шток которого соединен кинематически с приемопередатчиком дальномера через планку ориентир- водителя, что обеспечивает вождение с.х. Я агрегата по равносигнальным линиям электромагнитного поля и повышение точности автоматического вождения, 2 э.п. ф-лы, 2 ил. Ж механизатора и направленной по курсу дви- ф жения. На планке 2 установлен корпус ориентир-водителя 1, в котором размещен сО электронный датчик 4 отклонения - приемо- Яя передатчик дальномера, например пара- (р фазного светодальномера типа КДГ-З, МСДМ и др, Дальномер находится в оптической связи с ориентиром - уголковым отражателем 5, раеположенным на плантации, где осуществляется перемещение агрегата, В таком случае ось оптической системы 6 дальномера датчика 4 расположена перпендикулярно продольной оси планки 2.Датчик 4 имеет генератор 10 масштабной частоты (150, 1549 МГц) и импульсный генератор 11 низкой частоты (80 Гц) манипуляции фазы масштабной частоты, выходы510 15 20 25 30 35 40 45 50 55 которых соединены с входом фазового манипулятора 9, изменяющего форму масштабной частоты на 180 с частотой импульсов генератора 11, Выход фазового манипулятора 9 через усилитель 8 соединен со светодиодом 7, излучающим промодули-. рованный по интенсивности и по фазе световой поток через оптическую систему 6 в сторону уголкового отражателя 5,Кроме того, датчик 4 имеет принимающий отраженный световой поток через ту же оптическую систему 6, фотоприемник 14 - фотоэлектронный умножитель с внешним электродом - диафрагмой 15, к которому электрически подсоединен выход генератора 10 масштабной частоты через фазовращатель 12 и усилитель 13, Анод фотоприемника 14 соединен электрически через усилитель 16 низкой частоты с синхронным детектором 17, вход которого соединен с выходом импульсного генератора 11. На выходе синхронного детектора 17 установлен стрелочный нуль-индикатор 18 с размыкающим контактом (выключателем)19.К нуль-индикатору 18 подключены схемы 20 и 21 обработки сигналов выходных токов 1 и 2 основного и вспомогательного контуров модулятор-демодулятор; 10, 9, 8, 7 - 10, 12, 13, 15, 14, 16, 17 и 11; 10, 9, 8, 7 - 10, 12, 13, 15, 14, 16, 11, 17 соответственно, Каждая из схем 20 и 21 является схемой обработки сигнала соответственно правого и левого отклонений агрегата и имеет по фильтру 23 нижних частот, а одна из них - ливию 22 задержки нв половину периода частоты импульсного генератора 11. Выход схемы 20 обработки сигнала правого отклонения агрегата соединен с инвертирующим входом компаратора 24 сигнала направления агрегата вправо и с неинвертирующим входом компаратора 25 сигнала направления агрегата влево. Выход схемы 21 обработки сигнала левого отклонения агрегата соединен с инвертирующим входом компаратора 25 сигнала направления агрегата влево и с неинвертирующим входом компаратора 24 сигнала направления агрегата вправо,Компараторы 24 и 25 построены, например, нэ операционных усилителях А 2030, выходные параметры которых по напряжению и току согласуются с электрическими . параметрами электрогидрораспределителя 26, например, типа ЗСУс катушками электромагнитов 27 и 28 его включения. Выход компаратора 24 соединен с катушкой электромагнита 27, а выход компаратора 25 - с катушкой электромагнита 28. Схемы 20 и 21 обработки сигналов левого и правого отклонений агрегата, компараторы 24 и 25, электромагниты 27 и 28, а также соединительные провода 30 образуют каналы сигналов соответственно правого и левого направлений агрегата, Электросхема запитана от аккумулятора 29 агрегата,Планка 2 ориентир-водителя 1 соединена кинематически со штоком поршневого мотор-насоса 45, На штоке тандемом установлены два поршня, образующие в цилиндре мотор-насоса 45 с перегородкой между ними четыре полости 46 - 49, Полости 48 и 49 сообщены маслопроводами 33 и 35 с управляющими каналами электрогидрораспределителя 26 и являются переменными полостями гидромотора, Полости 46 и 47 являются переменными полостями насоса и сообщены маслопроводами 34, 41 и 36, 42 с поршневой и штоковой полостями гидроцилиндра 44 исполнительного механизма направления агрегата, выполненного, например, в виде управляемого колеса 43. Объем каждой из полостей мотор-насоса 45 в несколько раз меньше объема полостей гидроцилиндрэ 44, С гидроцилиндром 44 маслопроводами 39 и 40 сообщен и узел 50 дистанционного корректирования статизма вождения и рулевого управления. Узел 50 дистанционного корректирования статизма вождения и рулевого управления сообщен с баком 60 через напорный маслопровод 32 и насос 52, а также по сливному маслопроводу 38 и через фильтр 56 или перепускной клапан 58. Напорный и сливной соответственно маслопроводы 32 и 38 соединены через предохранительный клапан 54.Злектрогидрораспределитель 26 сообщен с баком 59 через напорный маслопровод 31 и насос 51, э также по сливному маслопроводу 37 и через фильтр 55 или перепускной клапан 57, Напорный и сливной маслопроводы 31 и 37 соответственно соединены через предохранительный клапан 53.Ориентиры-уголковые отражатели 5 размещены нэ плантации, например, сахарной свеклы в двух пунк 1 ах, расстояние между которыми равно половине ширины захвата агрегата и так, что величины углов оптических секторов приемоизлучения составляют 180 О, но направлены противоположно друг другу.Механизатор при ручном вождении устанавливает (например, посевной) агрегат в исходное положение и включает контактом 19 стрелочный нуль-индикатор 18. При этом высокочастотный генератор 10 масштабной частоты и низкочастотный импульсный генератор 11 подают свои напряжения в фазовый манипулятор 9, в котором фазамасштабной частоты скачком изменяется на 1800 с частотой следования импульсов генератора 11 и после усиления в усилителе 8 подается на светодиод 7, излучающий поэтому промодулированный по интенсивно сти и фазе световой поток через оптическую систему 6 в сторону уголкового отражателя 5. Отраженный луч оптическая система 6 направляет на катод фотоэлектронного умножителя - фотоприемник 14, который де модулирует световой поток, т,к. к его внешнему электроду 15 приложено измерительное напряжение, поступающее через усилитель 13 и фазовращатель 12 от генератора 10 масштабной частоты. В результате 15 взаимодействия фототока, образованного отраженным лучом с модулирующим напряжением, поданным на электрод 15, в анодной цепи фотоэлектронного умножителя - фотоприемника 14 возникают "сигнальные" 20 токи 1 и 2, чередующиеся счастотой импульсного генератора 11. После усиления в усилителе 16 они подаются на синхронный детектор 17, накоторый подается и напряжение с импульсного генератора 11. Под 25 действием сигналов импульсного генератора 11 в детекторе 17 происходит синхронно с работой фазового манипулятора 9 изменение направления тока, протекающего через нуль-индикатор 18. Из-за инерционности 30 нуль-индикатора 18 его показания равны разности противоположно направленных чередующих токови 2.Известно, что35 1 = А + Всоз( Р 1 - ф 2 +а) и 2 = А - Всоз (р - а +а),где А - коэффициент, зависящий от напряжения питания; 40В - коэффициент, зависящий от прозрачности атмосферы;А)1 - фаза модуляции светового потока на выходе из светодиода 7;щ - фаза модуляции светового пото ка на входе в фотоприемник 14 после пробега до уголкового отражателя 5 и обратно зависит от величины пробега;а - разница фаз между р и фазой измерительного напряжения (массштабной 50 частоты), приложенного к внешнему электроду 15, т,е. разность фаз работы модулятора и демодулятора, которую механизатор подрегулировал рукояткой фазовращателя 12, 55Откуда 11 = 2 при 0 - с 2 + а= 90 О (или 270).Поэтому в исходном положении агрегата механизатор вращением рукоятки фазовНращателя 12 изменяет параметра до совмещения стрелки нуль-индикатора 18 с нулем, Этим он уравнивает по модулю токии 2 за счет различия их фаз на 90 О, когда движение стрелки к нулю совпадает с направлением вращения ручки фазовращателя 12 (при встречном движении рукоятки и стрелки - 270 О),После этого механизатор размыкает контакт 19 и включает рабочую скорость движения агрегата. При отклонении агрегата влево (вправо) от дуги окружности с центром в оптическом центре уголкового отражателя 5 радиус движения агрегата и оптического центра дальномера - датчика 4, а также фаза у:2 увеличивается (уменьшается), Поэтому аргумент косинуса ( 0 - р 2 + а) становится меньше(больше) 90 и пульсирующий в схеме 21 обработки1 сигнала левого отклонения агрегата токбудет больше (меньше) тока 2, пульсирующего в схеме 20 обработки сигнала правого отклонения агрегата на величину , (2 ), показанную на графике(фиг,2). Поэтому после совмещения пульсаций токови 6 во времени линией 22 задержки и сглаживания фильтрами 23 нижних частот, их потенциалы на неинвертирующем входе компаратора 24 сигнала направления агрегата вправо и на инвертирующем входе компаратора 25 сигнала направления агрегата влево будут больше(меньше), чем на неинвертирующем входе компаратора 25 и инвертирующем входе компаратора 24, В результате на выходе компаратора 24 (25) появляется напряжение, близкое к напряжению аккумуляторной батареи 29, и ток, определяемый сопротивлением катушки электромагнита 27 (28) электрогидрораспределителя 26, а на выходе компаратора 25 (24) они равны нулю, Электромагнит 27 (28) смещает плунжер электрогидрораспределителя 26 на подачу масла от насоса 51 через маслопровод 33 (35) в полость 48 (49) поршневого мотор-насоса 45. В результате шток мотор-насоса 45 смещается и поворачивает планку 2 ориентир-водителя 1 вместе с оптическим центром датчика 4 вправо (влево) до восстановления начального значения фазы щ,1и равенства токов 1 и 2, При этом электрическиепотенциалы на входах компараторов 24,25 уравниваются, напряжение и ток на выходах компараторов 24, 25 исчезают и плунжер электрогидрораспределителя 26 устанавливается пружинами в нейтральное положение, запирая маслопроводы 33 и 35. Так осуществляется прямая и обратная связи в системе,Одновременно с изменением обьемов полостей 48 и 49 мотор-насоса 45 изменяются и объемы полостей 46 и 47, При отклонении ориентир - водителя 1 вправовлево) и увеличении объема полости 4849) уменьша ется объем полости 47 (46), Масло из полости 47 (46) по маслопроводам 36 и 42 34 и 41) вытесняется в штоковую поршневую) полость гидроцилиндра 44, втягивая (выталкивая) его шток, который поворачивает уп равляемое колесо 43 вправо (влево) пропорционально отклонению ориентир- водителя 1 и задает тем самым соответствующее направление перемещения сельскохозяйственного агрегата. 15При вращении рулевого колеса узла 50 дистанционного корректирования статизма вождения и ручного управления, например, вправо влево) порция масла, пропорциональная углу поворота рулевого колеса, по ступает от насоса 52 по маслопроводам 32, 39, 42 (32, 40, 41) в штоковую (поршневую) полость гидроцилиндрв 44 и суммируется с порцией масла от мотор-насоса 45. Но каждая из полостей мотор-насоса 45 в несколь ко раз меньше соответствующих полостей гидроцилиндра 44, т,к, при автовождении колебания колеса 43 от заданного направления невелико(1 - 3 ), а полное отклонение при ручном вождении до 40. Поэтому меха низатор без дополнительных манипуляций простым вращением рулевого колеса может при необходимости направить агрегат по нужному направлению и без отключения системы автовождения, 35При междурядных обработках механизатор устанавливает культиваторный агрегат в исходное положение, как и на посеве, а затем на самой малой скорости и при ручном вождении асторакно заводит рабочие 40 органы культиватора в междурядья симметрично относительно рядков и останавливает агрегат. Затем замыкает контакт 19, выставляет стрелку нуль-индикатора 18 на нуль, размыкет контакт 19 и включает рабочую 45 скорость. Агрегат движется в автоматическом режиме, как и при посеве, воспроизведя ту же траекторию. При обнаружении статического смещения от рядков при любой причине механизатор чуть доворачива ет руль в необходимом направлении, подавая соответствующую порцию масла в гидроцилиндр 44 и доворачивая колесо 43 до устранения статизма, При дальнейшем автоматическом вождении система откло няет колесо 43 в ту или иную сторону от его нового исходного положения.Точное направление пропашного культиватора на плантации сахарной свеклы позволяет уменьшить ширину защитной зоны со 180-200 мм до 80-40 мм и количество сорняков в 2-5 раз, Поданным Всесоюзного научно-исследовательского института сахарнойй свекл ы (В Н И С) средняя засоренность плантаций сахарной свеклы (115 шт, сорняков на 1 м ) приводит к потере урожая2на 12,4 т/га, Поэтому уменьшение количества сорняков в 3,5 раза за счет соответствующего уменьшения защитной зоны увеличивает урожай на 10,5 т/га.Формула изобретения 1, Система автоматического вождения сельскохозяйственного агрегата по заданной траектории, содержащая переключающий электрогидрораспределитель, гидроцилиндр исполнительного механизма направления движения агрегата, гидравлически сообщенный с узлом дистанционного корректирования статизма и ручного управления, ориентир-водитель с датчиком отклонения и блок связи датчика отклонения с переключающим злектрогидрораспределителем, о тл и ч а ю щ а я с я тем, что, с целью повышения точности автоматического вождения, она снабжена дозирующим поршневым мотор-насосом, правая и левая полости которого гидравлически связаны соответственно с линиями переключающего электрогидрораспределителя и полостями гидроцилиндра исполнительного механизма направления движения агрегата, при этом ориентир-водитель выполнен в виде корпуса, в котором размещен датчик отклонения и планки, один конец которой жестко соединен с корпусом;средняя часть кинематически связана со штоком дозирующего поршневого мотор-насоса, а на противоположном конце установлен шарнир для закрепления планки на раме агрегата, причем блок связи датчика отклонения с переключающим электрогидрораспределителем включает компараторы сигналов левого и правого направления движения агрегата и схемы обработки сигнала правого и левого отклонения агрегата, выход каждой из которых соединен с инвертирующим входом компаратора сигнала одноименного направления движения агрегата и с неинвертирующим входом компаратора сигнала противоположного направления движения агрегата, а выход каждого компаратора подключен к катушке электомагнита включения электрогидрораспределителя на подачу масла для одноименного направления движения агрегата, при этом датчик отклонения выполнен в виде приемопередтчика дальномера, выходы которого связаны с входами схем обработки сигнала левого и правогоотклонения агрегата, а оптическая ось перпендикулярна продольной оси планки ориентир-вбдителя.2. Система по п.1, о т л и ч а ю щ а я с я тем, что на входе одной из схем обработки сигнала отклонения агрегата включена линия задержки,3, Система по пп.1 и 2, о т л и ч а ю щ а яс я тем, что на выходе каждой схемы обра ботки сигнала отклонения агрегата включенсглаживающий фильтр.