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

Изобретение относится к области измерения, производимого приемником глобальной навигационной спутниковой системы (ГНСС), в частности к способу автоматической калибровки датчика угла для автоматической системы управления автоматическим приводом сельскохозяйственных машин. Способ автоматической калибровки датчика угла для системы управления автоматическим приводом сельскохозяйственной машины содержит несколько этапов. Рулевое колесо машины фиксируется для удерживания передних колес транспортного средства. Затем выполняются сбор и обработка информации о текущем положении машины для получения среднего значения. Создается кинематическая модель двухколесной сельскохозяйственной машины, основанной на центре задней оси. Вычисляется радиус для получения набора соответствий углов. Осуществляется поворот машины на заданный угол с постоянной скоростью, с задней осью машины в качестве центра. После многоповторного выполнения предыдущего этапа выполняется вычисление по подбору значения угла для получения калибровочного коэффициента. Повышается точность. 4 з.п. ф-лы, 3 ил.

 

Область техники

Настоящее изобретение относится к области измерения, производимого приемником глобальной навигационной спутниковой системы (ГНСС), в частности к способу автоматической калибровки датчика угла для автоматической системы управления автоматическим приводом сельскохозяйственных машин.

Уровень техники

Сельскохозяйственная машина (в частности, трактор, который будет в дальнейшем использоваться для обозначения сельскохозяйственной машины) является движущим агрегатом для различных механизированных операций, который представляет собой наиболее важную силовую машину в сельскохозяйственных производственных операциях. Сельскохозяйственная машина(-ы) может выполнять большинство работ на полях с навесным, присоединенным или буксируемым сельскохозяйственным оборудованием. Сельскохозяйственная машина(-ы) также может выполнять буксировку трейлера для выполнения транспортных операций. В связи с непрерывным повышением производительности труда в сельском хозяйстве, неизбежной тенденцией является развитие сельскохозяйственных тракторов в более широком масштабе. Эта тенденция особенно заметна в Северной Америке и Западной Европе. В последние годы в северо-восточном Китае и китайской провинции Синьцзян наблюдается устойчивый скачок развития. В результате, в процессе сельскохозяйственного производства пользователи все в большей степени зависят от тракторов большой мощности, поэтому крайне важно повысить степень использования тракторов при выполнении работ. Однако, когда механические узлы трактора работают в относительно суровых природных условиях, условия эксплуатации являются сложными и изменчивыми, качество работы операторов варьируется, и это приводит к низкой точности работы и низкому коэффициенту использования земли. Кроме того, не могут гарантироваться эффективность использования топлива и производительность трактора в процессе эксплуатации. Поэтому управление сельскохозяйственными машинами, особенно крупными сельскохозяйственными машинами, стало ключевой проблемой, срочно нуждающейся в решении для точного земледелия. Наиболее эффективным решением данной проблемы является технология автоматического привода ГНСС навигации.

Система управления автоматическим приводом ГНСС навигации в основном состоит из двух главных компонентов: интегрированного алгоритма навигации и алгоритма управления. Интегрированный алгоритм навигации предоставляет алгоритму управления точные данные о положении и высоте. Значение отклонения рассчитывается в реальном времени алгоритмом задания маршрута на основе местоположения и получаемой информации. Затем значение отклонения преобразуется алгоритмом управления в управляющую величину, чтобы управлять движением трактора в соответствии с заданным маршрутом. В данных алгоритмах должна быть создана кинематическая модель транспортного средства, и угол поворота переднего колеса в кинематической модели является одним из наиболее важных параметров модели. Из-за ошибки установки и ошибки изготовления, в модели будут возникать ошибки расчетов. В результате, алгоритм управления становится некорректным. Что еще хуже, управление может быть противоречивым, вследствие чего задача автоматического привода не может быть реализована.

Раскрытие сущности изобретения

Настоящее изобретение предлагает способ автоматической калибровки датчика угла для системы управления автоматическим приводом сельскохозяйственной машины, которая включает следующие этапы:

Этап S1: фиксация рулевого колеса сельскохозяйственной машины для удерживания передних колес транспортного средства под фиксированным углом;

Этап S2: сбор множества элементов информации о текущем положении сельскохозяйственной машины и обработка множества элементов информации о текущем положении для получения среднего значения;

Этап S3: создание кинематической модели двухколесной сельскохозяйственной машины, основанной на центре задней оси;

Этап S4: вычисление радиуса для получения набора соответствий углов;

Этап S5: поворот сельскохозяйственной машины на заданный угол с постоянной скоростью, с задней осью сельскохозяйственной машины в качестве центра, и выполнение этапов S1-S4;

Этап S6: выполнение вычисления по подбору значения угла для получения калибровочного коэффициента, после выполнения этапа S5 несколько раз.

В вышеупомянутом способе автоматической калибровки датчика угла для системы управления автоматическим приводом сельскохозяйственной машины, на этапе S6 данные о поворотах транспортного средства влево и вправо соответственно собирают не менее 5-ти раз.

В вышеупомянутом способе автоматической калибровки датчика угла для системы управления автоматическим приводом сельскохозяйственной машины этап S3, в частности, включает:

предположение того, что радиус окружности передних и задних колес равен R, и получение следующего уравнения 1:

где

θ - угол поворота трактора,

α - угол поворота переднего колеса трактора и

L - колесная база трактора.

В уравнении 1, β - соответствующий центральный угол колесной базы L, а α - соответствующий вписанный угол колесной базы L. Уравнение 2, приведенное ниже, получено из уравнения 1:

В вышеупомянутом способе автоматической калибровки датчика угла системы управления автоматическим приводом сельскохозяйственной машины этапы расчета радиуса R включают:

Уравнение 3

0.5

Где a, b, c, d, e и f - промежуточные вычисляемые переменные;

х и у - координаты центра окружности;

, - координаты трех точек, записанные в процессе вождения сельскохозяйственной машины.

В вышеупомянутом способе автоматической калибровки датчика угла системы управления автоматическим приводом сельскохозяйственной машины этапы расчета настройки значения угла включают:

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

= Уравнение 4

, - результаты калибровки.

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

1. Благодаря применению в настоящей заявке технологии, объединяющей кинематику транспортного средства и высокоточную ГНСС, может быть реализована высокоточная калибровка датчика угла.

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

3. Настоящая заявка подходит, в частности, для высокоточных систем управления автоматическим приводом сельскохозяйственных машин.

Краткое описание чертежей

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

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

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

На фиг. 3 представлена блок-схема последовательности операций настоящего изобретения согласно одному варианту осуществления.

Осуществление изобретения

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

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

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

Этап S1: фиксация рулевого колеса сельскохозяйственной машины для удерживания передних колес транспортного средства под фиксированным углом;

Этап S2: сбор множества элементов информации о текущем положении сельскохозяйственной машины и обработка множества элементов информации о текущем положении для получения среднего значения;

Этап S3: создание кинематической модели двухколесной сельскохозяйственной машины, основанной на центре задней оси;

Этап S4: вычисление радиуса для получения набора соответствий углов;

Этап S5: поворот сельскохозяйственной машины на заданный угол с постоянной скоростью, с задней осью сельскохозяйственной машины в качестве центра, и выполнение этапов S1-S4;

Этап S6: выполнение вычисления по настройке значения угла для получения калибровочного коэффициента, после выполнения этапа S5 несколько раз.

В необязательном варианте осуществления настоящего изобретения данные о поворотах транспортного средства влево и вправо соответственно собираются не менее 5-ти раз.

На фиг. 1 представлена принципиальная схема, показывающая кинематическую модель двухколесного трактора, основанную на центре задней оси. На данной фигуре, θ - угол поворота трактора, α - угол поворота переднего колеса трактора, V - скорость заднего колеса трактора, Vf - скорость переднего колеса трактора, L - колесная база (или длина хорды) трактора, точка C лежит на перпендикуляре к L и расположена на окружности передних и задних колес. То есть, α – это вписанный угол, соответствующий длине L хорды.

Предполагая, что радиус окружностей передних и задних колес равен R, то

Уравнение 1

В уравнении 1, - центральный угол, соответствующий длине L хорды, а α - вписанный угол, соответствующий длине L хорды. Кроме того, α равен значению датчика угла переднего колеса. Уравнение 2 получено из уравнения 1, то есть, угол поворота переднего колеса и радиус имеют нелинейную зависимость. Если можно узнать значение радиуса, значение угла переднего колеса может быть получено путем обратного вычисления:

Уравнение 2.

Для высокоточной ГНСС, за счет использования технологии кинематики в реальном времени RTK (КРВ) точность определения положения может быть повышена до диапазона в 1 см. В системе автоматического привода сельскохозяйственной машины датчик угла является одним из компонентов всей системы, а высокоточная плата ГНСС является другим компонентом. Поскольку настоящий патент сконцентрирован на изучении калибровки датчика угла, он не включает технологию КРВ. Настоящая заявка в вариантах применения непосредственно использует информацию о положении, выводимую высокоточной платой.

Уравнение 3 содержит формулы расчета алгебраического уравнения окружности, которая определена тремя точками. Координаты трех точек, записанные в процессе вождения трактора, обозначены как P1 (), P2 () и P3 (). Этапы вычисления радиуса R включают:

Уравнение 3

0.5

где

a, b, c, d, e и f – промежуточные вычисляемые переменные,

x, y - координаты центра окружности;

, , , - координаты трех точек, записанные в процессе вождения сельскохозяйственной машины.

Согласно уравнению 2 и уравнению 3 может быть получено значение радиуса, соответствующее фиксированному углу поворота переднего колеса. Теоретически, соответствующая линия может быть получена по двум значениям угла и значению радиуса. Однако из-за воздействия различных факторов окружающей среды, изменение значения угла может быть нелинейным. Чтобы повысить точность калибровки, в настоящем патенте используется способ наименьших квадратов квадратичной кривой для квадратичной настройки множества значений угла и значений радиуса.

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

= Уравнение 4

, являются результатами калибровки.

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

1. Благодаря применению в настоящей заявке технологии, объединяющей кинематику транспортного средства и высокоточную ГНСС, может быть реализована высокоточная калибровка датчика угла.

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

3. Настоящая заявка подходит, в частности, для систем управления автоматическим приводом для точного земледелия.

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

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

Этап S1: фиксация рулевого колеса сельскохозяйственной машины для удерживания передних колес транспортного средства под фиксированным углом;

Этап S2: сбор множества элементов информации о текущем положении сельскохозяйственной машины и обработка множества элементов информации о текущем положении для получения среднего значения;

Этап S3: создание кинематической модели двухколесной сельскохозяйственной машины, основанной на центре задней оси;

Этап S4: вычисление радиуса для получения набора соответствий углов;

Этап S5: поворот сельскохозяйственной машины на заданный угол с постоянной скоростью с задней осью сельскохозяйственной машины в качестве центра и выполнение этапов S1-S4;

Этап S6: выполнение вычисления по подбору значения угла для получения калибровочного коэффициента, после выполнения этапа S5 несколько раз.

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

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

предположение того, что радиус окружности переднего и заднего колеса равен R, и получение следующего уравнения 1:

где α - угол поворота переднего колеса трактора и

L - колесная база трактора;

при этом в уравнении 1, β - соответствующий центральный угол колесной базы L, и α - соответствующий вписанный угол колесной базы L; приведенное ниже уравнение 2 получают из уравнения 1

4. Способ автоматической калибровки датчика угла для системы управления автоматическим приводом сельскохозяйственной машины по п. 3, отличающийся тем, что этапы вычисления радиуса R включают:

Уравнение 3

0.5

где a, b, c, d, e и f - промежуточные вычисляемые переменные;

x и y - координаты центра окружности;

, , , , - координаты трех точек, записанные в процессе вождения сельскохозяйственной машины.

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

предположение того, что значение датчика угла равно , соответствующее значение датчика угла, рассчитанное с учетом выборочных точек положения в уравнении 3, равно , n представляет собой n-е соответствие, и калибровочные квадратичные коэффициенты датчика угла равны, , и ;

= Уравнение 4; и

, - результаты калибровки.



 

Похожие патенты:

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

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

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

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

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

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

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

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

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

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

Изобретение относится к области контроля состояния несущих конструкций антенно-мачтовых сооружений (АМС), оперативного оповещения об изменениях их состояния, предупреждения чрезвычайных ситуаций и может быть использовано в автоматизированных системах мониторинга состояния антенно-мачтовых сооружений.

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

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

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

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

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

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

Изобретение относится к области определения состояния несущих конструкций антенно-мачтовых сооружений (АМС). Способ контроля состояния антенно-мачтовых сооружений заключается в установке на его мачте блока с трехосным акселерометром, а также предусматривает дополнительную установку на ней, через равные расстояния, блоков с трехосными акселерометрами, установку анемометра, установку в ее заданных сечениях датчиков напряженно-деформированного состояния, а также предусматривает установку дополнительного блока с трехосным акселерометром в ее фундамент и сейсмодатчика в грунт, что позволит, после обработки полученной информации, в режиме on-line иметь информацию о реальных причинах возможных отклонений мачты от вертикальности, ее геометрии, о пространственном положении фундамента и уровнях напряжений конструктивных элементов мачты.

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

Изобретение относится к области измерения, производимого приемником глобальной навигационной спутниковой системы, в частности к способу автоматической калибровки датчика угла для автоматической системы управления автоматическим приводом сельскохозяйственных машин. Способ автоматической калибровки датчика угла для системы управления автоматическим приводом сельскохозяйственной машины содержит несколько этапов. Рулевое колесо машины фиксируется для удерживания передних колес транспортного средства. Затем выполняются сбор и обработка информации о текущем положении машины для получения среднего значения. Создается кинематическая модель двухколесной сельскохозяйственной машины, основанной на центре задней оси. Вычисляется радиус для получения набора соответствий углов. Осуществляется поворот машины на заданный угол с постоянной скоростью, с задней осью машины в качестве центра. После многоповторного выполнения предыдущего этапа выполняется вычисление по подбору значения угла для получения калибровочного коэффициента. Повышается точность. 4 з.п. ф-лы, 3 ил.

Наверх