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

1111 843802 ОП ИСАЙ И Е ИЗОБРЕТЕНИЯ К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ Союз Советских Социалистических Республик(088.8) юллетень25 по Мелам изобретеии и открытий(45) Дата опубликования описания 07.07,81 2) Авторыиковой Революции . ехническое В. Н. Енин, С. С. Нсковское ордена Ленина, орди ордена Трудового Красного 3училище им, Н. виВ,Ф.Ре на Октябр амени высш Э, Баумана икола(54) УСТРОЙСТВО ДЛЯ АВТОМАТИЧЕСКОГО ВОЖДЕ СЕЛЬ СКОХОЗЯ ЯСТВ ЕН Н ЫХ АГРЕГАТОВ Изобретение относится к области сельскохозяйственного машиностроения, в частности к устройствам для автоматического вождения сельскохозяйственных агрегатов.Известно устройство для автоматического вождения тракторных агрегатов, содержащее индукционные датчики, взаимодействующие с магнитным полем ориентирующих проводников, схему обработки сигналов датчиков с выходом на исполнительный механизм 11,Недостатком устройства является сравнительно низкая экономичность, обусловленная необходимостью затрат на закладку системы механических проводников, а также на выполнение регламентных работ, обеспечивающих поддержание в рабочем состоянии такой системы проводников.Наиболее близким по технической сущности к предлагаемому является устройство для автоматического вождения сельскохозяйственных агрегатов, содержащее два емкостных датчика, состоящих избалансируемых мостовых схем и чувствительных элементов, выполненных в виде вертикально расположенных пластин, генератор синусоидальных колебаний, блок обработки сигналов, блок управления по линейному отклонению, преобразователь и исполнительный механизм 2. Данное устройство имеет недостаточнуюустойчивость и недостаточно высокое качество вождения, обусловленные управлением лишь по положению и невозможностью уп равления по курсу, кроме того, невозможноавтоматически управлять агрегатом при отсутствии направляющего рядка растений.Целью изобретения является повышениеточности и устойчивости вождения, расши рение функциональных возможностей устройства,Цель достигается тем, что устройствоснабжено электронным блоком управления по углу, компаратором, ключом и суммато ром, при этом чувствительные элементырасположены один за другим на базовом расстоянии агрегата вдоль оси, параллельной продольной оси агрегата, и включены в плечи балансируемых мостовых схем, а бло ки управления по углу и по линейному отклонению выполнены в виде последовательно включенных реверсивных счетчиков, регистров памяти и цифроаналоговых преобразователей, блок обработки сигналов вы полнен в виде двух преобразователей разности фаз с сигнальным и квантующим входами и сигнальным и знаковым выходами, генератора квантующих импульсов со схемой задержки, распределителя импуль сов с первой и второй парами сигнального3и знакового входов и двумя парами выходов, причем первая пара выходов распределителя через блок управления по линейному отклонению связана с первым входом сумматора непосредственно и через компаратор - с управляющим входом ключа, вторая пара выходов распределителя через последовательно соединенные блок управления по углу и ключ связана со вторым входом сумматора, выход которого связан с входом преобразователя и каждая пара сигнального и знакового входов распределителя через соответствующие выходы преобразователей разности фаз связана с выходами емкостных датчиков, а генератор квантующих импульсов с квантующим входом одного преобразователя разности фаз связан непосредственно, а с другим - через схему задержки, Кроме того, распределитель импульсов выполнен по крайней мере в виде четырех логических схем И и четырех схем ИЛИ, причем входы первой и второй схем И связаны с первой парой сйгнального и знакового входов распределителя, входы третьей и четвертой схем И связаны с второй парой входов распределителя, первый выход первой пары выходов распределителя через первую схему ИЛИ связан с выходом первой и третьей схем И, второй выход первой пары выходов через вторую ИЛИ связан с выходом второй и четвертой И, первый выход второй пары выходов распределителя через третью ИЛИ связан с выходом первой и четвертой И, а второй выход второй пары выходов через четвертую ИЛИ связан с выходом второй и третьей схем И.На фиг. 1 приведена блок-схема устройства; на фиг. 2 приведены временные диаграммы, поясняющие работу устройства.Устройство состоит из емкостных датчиков 1, включающих балансируемые мостовые схемы с емкостями С, - С 4 и резисторами Р - Р 4 и чувствительные элементы, выполненные в виде вертикально расположенных пластин, включенных в плечи балансируемых мостовых схем, генератора 2 синусоидальных колебаний, блока обработки сигналов, содержащего два преобразователя 3 разности фаз с сигнальным и квантующим входами и сигнальным и знаковым выходами, генератор 4 квантующих импульсов со схемой задержки 5, распределитель 6 импульсов с первой и второй парами сигнального и знакового входов 1 с и 2 с и двумя парами выходов, блока управления по линейному отклонению 7, сумматора 8, компаратора 9, ключа 10, блока управления по углу 11, преобразователя 12 и исполнительного механизма 13. Первая пара выходов распределителя 6 через блок управления по линейному отклонению 7 связана с первым входом сумматора 8 непосредственно и через компаратор 9 - с управляющим входом ключа 10, вторая пара выходов распределителя б через последовательно соедйненные блок управления по углу 11 и ключ10 связана с вторым входом сумматора 8,выход которого связан с входом преобра 5 зователя 12, каждая пара сигнального изнакового входов распределителя 6 черезсоответствующие выходы преобразователей3 разности фаз связана с выходами емкостных датчиков 1, а генератор 4 квантую 10 щих импульсов с квантующим входом одного преобразователя 3 разности фаз связаннепосредственно, а с другим - через схемузадержки 5. Чувствительные элементы датчиков 1 расположены один за другим на ба 15 зовом расстоянии агрегата вдоль оси, параллельной продольной оси агрегата.Преобразователи 3 разности фаз содержат формирующие устройства 14, дифференцирующую цепочку 15, логические схе 20 мы И - 16 а и 16 б, триггер 17 для формирования сигнала знака разности фаз.Блоки управления по углу 11 и по линейному отклонению 7 выполнены в виде последовательно включенных реверсивных25 счетчиков 20 а и 20 б, регистров памяти 21 ии цифроаналоговых преобразователей 22.Распределитель импульсов выполнен ввиде четырех логических схем И 18 и четырех логических схем ИЛИ 19, причем входыЗ 0 первой и второй схем И 18 связаны с первой парой сигнального и знакового входовраспределителя 6, входы третьей и четвертой схем И 18 связаны с второй паройвходов распределителя 6, первый выходЗ 5 первой пары выходов распределителя 6 через первую схему ИЛИ 19 связан с выходом первой и третьей схем И 18, второй выход первой пары выходов через вторуюИЛИ 19 связан с выходом второй и четвер 40 той И 18, первый выход второй пары выходов распределителя через третью ИЛИ 19связан с выходом первой и четвертой И 18,второй выход второй пары выходов черезчетвертую ИЛИ 19 связан с выходом вто 45 рой и третьей схем И 18.Работа устройства происходит следующим образом.Сельскохозяйственный агрегат устанавливается вдоль обрабатываемого массива рас50 тений (или маркерной линии при пахоте)таким образом, чтобы чувствительные элементы датчиков располагались на одинаковом заданном расстоянии от обрабатываемых растений,55 Генератор 2 вырабатывает гармонический сигнал с частотой(например,100 кГц), который подается на фазовращающие РС цепочки датчиков 1. С помощьюпеременных конденсаторов С и С 4 осуще 60 ствляется выставка устройства в нулевоеположение, т, е. сдвиг фаз между напряжениями в точках а и б (относительно заземленной точки) выставляется в нуль. После выставки агрегат приводится в движе 65 ние.5При отклонении от заданного расстояния агрегата вместе с чувствительными элементами между сигналами в точках а и тт каждого датчика 1 возникает фазовый сдвиг Лтр, величина которого определяется вели- чиной линейного смещения чувствительного элемента, а знак - направлением смещения, С помощью преобразователей 3 и генератора квантующих импульсов 4 сдвиги фаз преобразуются в последовательности импульсов, число которых определяется величиной фазового сдвига Лтр, а знак - знаком фазового сдвига Лтр. В частности, формирующие устройства 14 преобразуют гармонические сигналы в сигналы прямоугольной формы, которые после прохождения схемы И 16 а (точка е) преобразуются в широтно-модулированный сигнал Упричем ширина импульса пропорциональна фазовому сдвигу Лтр. Широтно-модулированный сигнал У, управляет работой схемы 16 б (на второй вход которой поступают короткие импульсы с высокой частотой . (например, 10 мГц) от генератора 4 квантующих импульсов, На выходе схемы 16 б (точка д) вырабатывается упомянутая последовательность импульсов. Триггер 17 знака совместно со связанными с ним схемами И 16 а и дифференцирующей цепочкой 15 вырабатывают сигнал знака,Последовательности импульсов, снимаемых с выхода каждого преобразователя 3 разности фаз, сдвигаются во времени относительно друг друга с помощью схемы задержки 5, что исключает сбои в работе последующих каскадов, в частности распределителя 6 импульсов и реверсивных счетчиков (20 а и 20 б).Последовательности импульсов поступатот на первый 1 с и второй 2 с сигнальные входы распределителя 6 импульсов, на управляющие входы 1 тт, 2 у которого посту- лают сигналы знака, С помощью схем И 18 распределителя 6 по знаковым сигналам осуществляется распределение импульсов на положительную и отрицательную шины (например, импульсы на шине+появляются при подаче на управляющем входе положительного знака сдвига фаз). С помощьюлогических схем ИЛИ 19 и изображенных связей осуществляется объединение последовательностей импульсов таким образом, что на первой паре выходов распределителя 1 в (связанных с блоком управления по линейному отклонению 7) формируются две последовательности импульсов, одна из которых образована положительными импульсами кажного из преобразователей 3, а дттугая - отпиттательньтми импульсами,а ттт второй паре вт.тходов 2 в (связаттньтх с блоком управления по углу 11) формируются две последовательности импульсов, каждая из которых образована положи 5 1 О 15 20 25 30 35 40 45 50 55 60 Формула изобретения1. Устройство для автоматического вождения сельскохозяйственных агрегатов, содеттжащее лва емкостных датчика, состоящих из белаттсттттуемьтх мостовых схем и 1 тувствитеттьттьтх элеметттов, вт.тпо,пттенпых в виде вертикально расположенных пластин, генератор синусоидальных колебаний, блок обработки сигналов, блок управления по Г 5 6тельными и отрицательными импульсами каждого из преобразователей 3.Другими словами, распределитель импульсов обеспечивает такую коммутацию импульсов. что реверсивный счетчик 20 а, входящий в блок управления по линейному отклонению 7, происходит алгебраическое суммирование импульсов, вырабатываемых первым и вторым емкостными датчиками 1, соответственно пт и п. Сумма ит+п пропорциональна отклонению центра сельскохозяйственного агрегата от нулевого положения, причем сумма будет положительной, если отклонение превосходит установленное а и отрицательной, если это отклонение меньше установленного а,Регистр памяти 21, цифроаналоговыйпреобразователь 22 обеспечивают преобразовав ние цифровой информации в аналоговыи сигнал.Таким образом, на реверсивный счетчик 20 а подается положительный сигнал, если отклонениебольше установленного, и отрицательный, если меньше установленного, при этом величина сигнала пропорциональна отклонению.Реверсивный счетчик 20 б, входящий в блок управления по углу 11, производит алгебраическое вычитание импульсов и, - и эта разность будет иметь тот же знак, что и угол между осью сельскохозяйственного агрегата и маркерной линией и равна нулю, если они параллельны.После преобразования этой информации в аналоговый сигнал она также поступает на сумматор 8.Таким образом, сумматор 8 формирует управляющий сигнал, определяемый суммой сигналов, поступающих с обоих блоков управления 7 и 11.Вьтхоттной сигнал сумматора 8 поступает через поеобразователь 12 на исполнительный механизм 13. обеспечивающий управление агрегатом. При больтпих начальных отклонениях центра сельскохозяйственного агпегата от маркерной линии сигналы с блока управления по углу 11 на сумматор 8 не проходят, что обеспечивается ключом, управляемым компапатором 9 и настроенным на некотооое пороговое значение сигналом на выходе блока управления по линейному отклонению 7. Это устраняет угловые колебания объекта (перерегулирование) и тем самым обеспечивает необходи- мое качество управления.линейному отклонению, преобразователь и исполнительный механизм, о т л и ч а ю щ е - е с я тем, что, с целью повышения точности и устойчивости вождения, расширения функциональных возможностей устройства, оно снабжено электронным блоком управления по углу, компаратором, ключом и сумматором, при этом чувствительные элементы расположены один за другим на базовом расстоянии агрегата вдоль оси, параллельной оси агрегата, и включены в плечи балансируемых мостовых схем, а блоки управления по углу, по линейному отклонению выполнены в виде последовательно включенных реверсивных счетчиков, регистров памяти и цифроаналоговых преобразователей, блок обработки сигналов выполнен в виде двух преобразователей разности фаз с сигнальным и квантующим входами и сигнальным и знаковым выходами, генератора квантующих импульсов со схемой задержки, распределителя импульсов с первой и второй парами сигнального и знакового входов и двумя парами выходов, причем первая пара выходов распределителя через блок управления по линейному отклонению связана с первым входом сумматора непосредственно и через компаратор - с управляющим входом ключа, вторая пара выходов распределителя через последовательно соединенные блок управления по углу и ключ связана с вторым входом сумматора, выход которого связан с входом преобразователя, и каждая пара сигнального и знакового входов распределителя через соответствующие выходы преобразователей разности фаз связана с выходами емкостных датчиков, а генератор квантующих5 импульсов с квантующим входом одногопреобразователя разности фаз связан непосредственно, а с другим - через схему задержки,2. Устройство по п. 1, отличающееся10 тем, что распределитель импульсов выполнен по крайней мере в виде четырех логических схем И и четырех схем ИЛИ, причем входы первой и второй схем И связаныс первой парой сигнального и знакового15 входов распределителя, входы третьей ичетвертой схем И связаны с второй паройвходов распределителя, первый выход первой пары выходов распределителя черезпервую схему ИЛИ связан с выходом пер 20 вой и третьей схем И, второй выход первойпары выходов через вторую ИЛИ связан свыходом второй и четвертой И, первый выход второй пары выходов распределителячерез третью ИЛИ связан с выходом пер 25 вой и четвертой И, второй выход второйпары выходов через четвертую ИЛИ связанс выходом второй и третьей схемы И.Источники информации,принятые во внимание при экспертизе30 1, Авторское свидетельство СССР382368, кл. А 01 В 69/04, 1971.2, Авторское свидетельство СССР266414, кл. А 01 В 69/04, 1968,843802 сГ едактор Е. Хорин ипография, пр, Сапунов Заказ 1143/14 НПО Поиск оставитель С. МартыновТехред А, Камышникова Корректор В, Нам Изд.414 Тираж 712 Подписноосударственного комитета СССР по делам изобретений и открытий 113035, Москва, Ж, Раушская наб., д. 4/5