RU2769440C1 - Способ комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства - Google Patents

Способ комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства Download PDF

Info

Publication number
RU2769440C1
RU2769440C1 RU2021113915A RU2021113915A RU2769440C1 RU 2769440 C1 RU2769440 C1 RU 2769440C1 RU 2021113915 A RU2021113915 A RU 2021113915A RU 2021113915 A RU2021113915 A RU 2021113915A RU 2769440 C1 RU2769440 C1 RU 2769440C1
Authority
RU
Russia
Prior art keywords
vehicle
agv
angle
rotation
speed
Prior art date
Application number
RU2021113915A
Other languages
English (en)
Inventor
Владислав Игоревич Кибалов
Анатолий Евгеньевич Кабаков
Олег Сергеевич Шипитько
Original Assignee
Общество с ограниченной ответственностью «ЭвоКарго»
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Общество с ограниченной ответственностью «ЭвоКарго» filed Critical Общество с ограниченной ответственностью «ЭвоКарго»
Priority to RU2021113915A priority Critical patent/RU2769440C1/ru
Priority to PCT/RU2021/000489 priority patent/WO2022245246A1/ru
Priority to EP21940963.8A priority patent/EP4343283A1/en
Application granted granted Critical
Publication of RU2769440C1 publication Critical patent/RU2769440C1/ru

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183Compensation of inertial measurements, e.g. for temperature effects
    • G01C21/188Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/20Control system inputs
    • G05D1/24Arrangements for determining position or orientation
    • G05D1/245Arrangements for determining position or orientation using dead reckoning

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Navigation (AREA)

Abstract

Изобретение относится к области навигации, а именно к способам позиционирования автономных наземных транспортных средств (АТС), в том числе мобильных роботов. Способ комплексирования разнородной навигационной информации, получаемой от бортовых датчиков автономного наземного транспортного средства (АТС) с целью его позиционирования, отличается тем, что данные о скорости движения АТС получают от энкодеров относительного или абсолютного типа, устанавливаемых на колесах АТС, и GNSS приемника, данные об угле поворота АТС вокруг вертикальной оси получают от энкодера, устанавливаемого на рулевой рейке АТС, и инерциальной навигационной системы, при этом в случае использования относительного колесного энкодера показания о направлении движения АТС получают от энкодера вращения, размещаемого на валу двигателя АТС. Далее производят конвертацию полученных данных от указанных бортовых датчиков в соответствующие единицы измерения скорости и угла поворота, определяют скорость движения АТС как сумму значений скоростей, полученных по показаниям колесных энкодеров и GNSS приемника с учетом весового коэффициента, предназначенного для регулирования степени влияния показаний указанных бортовых датчиков на оценку скорости движения АТС. Затем определяют расчетный угол поворота АТС вокруг вертикальной оси по углу рулевой рейки с учетом значения скорости АТС, определенного на основе показаний колесных энкодеров и GNSS приемника, определяют относительные повороты АТС вокруг вертикальной оси по показаниям инерциальной навигационной системы и энкодера рулевой рейки как разность между предыдущими и текущими показаниями соответствующих бортовых датчиков, определяют угол поворота АТС вокруг вертикальной оси как сумму значений относительных поворотов по показаниям энкодера рулевой рейки и инерциальной навигационной системы с учетом весового коэффициента, предназначенного для регулирования степени влияния показаний указанных бортовых датчиков на оценку угла поворота АТС, полученные данные об угле поворота АТС вокруг вертикальной оси и скорости АТС комплексируют с помощью кинематической модели АТС, в результате чего определяют координаты и курс АТС. Технический результат – повышение точности определения положения автономного наземного транспортного средства в пространстве при обеспечении стабильности позиционирования АТС в различных условиях эксплуатации. 1 ил.

Description

Изобретение относится к области навигации, а именно к способам позиционирования автономных наземных транспортных средств (АТС), в том числе мобильных роботов.
В настоящее время АТС, в том числе робототехнические системы, находят все более широкое применение для выполнения различного рода операций в производственных и складских помещениях для автоматизации технологических процессов в различных отраслях производства, а также на опасных производствах, где нежелательно или недопустимо присутствие человека.
Основным требованием, предъявляемым к АТС, является точное определение собственного положения в пространстве, для чего автономные транспортные средства содержат в своем составе бортовые датчики, среди которых выделяются навигационная спутниковая система (например, GPS, ГЛОНАСС, и т.д.), одометрия, инерциальная навигационная система (ИНС), включающая в себя акселерометры, гироскопы и. т. д.
Особенности эксплуатации АТС (условия окружающей среды) и технические особенности работы бортовых датчиков определяют ошибки измерений параметров местоположения и углового положения АТС на местности, так спутниковый сигнал в условиях применения АТС в помещениях может приниматься неустойчиво и с помехами, одометрия имеет особенность накапливания ошибок измерений под воздействием внешних и внутренних помех, а также за счет проскальзывания колеса и его неровности, для ИНС главные недостатки − накопление ошибок измерения за время активной работы и снижение точности измерений в результате резкой и частой смены скорости объекта.
Таким образом, для точного позиционирования АТС целесообразно получать данные о его параметрах от нескольких разнородных бортовых датчиков с дальнейшим комплексированием полученной навигационной информацией, а также с возможностью варьирования степени влияния измерений каждого бортового датчика на определение местоположения и углового положения АТС в соответствии с условиями эксплуатации АТС и точностью измерений каждого бортового датчика в данных условиях.
Из данного уровня техники известны следующие технические решения.
Известен способ определения пространственного положения транспортного средства на базе GNSS-INS и инерциальной навигационной системы (патент RU 2662462). Данный способ включает в себя следующие этапы: установку антенны GNSS в центре масс и в центре транспортного средства и установку измерительного блока IMU датчика на основе MEMS на валу рулевого механизма транспортного средства; получение информации о положении и скорости транспортного средства с помощью антенны GNSS, получение информации о курсовой угловой скорости транспортного средства с помощью измерительного блока IMU; вычисление угла пространственного положения транспортного средства с помощью комбинации акселерометра и гироскопа; вычисление курсового угла транспортного средства на базе положения, скорости и курсовой угловой скорости транспортного средства. Посредством комбинации одиночной антенны GNSS и датчика на основе IMU/MEMS небольшой стоимости пространственное положение и направление могут быть определены на базе кинематической модели транспортного средства.
Данный способ предназначен для позиционирования сельскохозяйственного транспортного средства, как правило, функционирующего на открытой местности, что ограничивает возможности определения местоположения объекта в закрытом помещении, где сигнал GNSS принимается неустойчиво и с помехами, а указанный инерциальный набор датчиков не имеет возможности определения координат объекта и не обеспечивает достаточную точность позиционирования.
Известен способ позиционирования робота (CN110567458), при котором данные о пространственном положении робота получают от бортовых датчиков, представленных в виде инерциальных датчиков, датчика позиционирования GPS, датчика зрения, лидарного датчика, энкодеров, датчика на основе технологии UWB.
Затем получают информацию о условиях окружающей среды, в которой функционирует робот (помещение/открытая среда, освещение, гладкость поверхности пола), и для каждого бортового датчика определяют весовой коэффициент, характеризующий точность измерений в данных условиях, после чего выбирают из представленных бортовых датчиков по весовым коэффициентам наиболее приоритетные по точности измерений и в соответствии с выбранным алгоритмом позиционирования (в предпочтительном варианте, расширенный алгоритм Калмана) обрабатывают показания от выбранных приоритетных бортовых датчиков.
В данном способе для позиционирования робота применяют набор разнородных бортовых датчиков, характеризующихся высокой стоимостью и сложностью алгоритмов обработки выходных сигналов, при этом указанные датчики собирают информацию об окружающей среде, на основании которой определяют приоритетные датчики для определения пространственного положения робота, что увеличивает вычислительную сложность алгоритма и как следствие снижает скорость его выполнения.
Известен способ определения навигационного состояния наземного транспортного средства (в том числе автономного транспортного средства) (US2009319186), при котором получают данные об угле поворота от энкодера, связанного с поворотным колесом транспортного средства, получают информацию о продольных угловых скоростях колес от датчиков скорости, установленных на данных колесах транспортного средства, получают данные GPS-позиционирования от GPS-приемника, установленного на транспортном средстве, определяют скорость рыскания для транспортного средства на основе информации о продольных угловых скоростях колес, угле поворота и данных позиционирования GPS, производят интегрирование скорости рыскания для определения курса транспортного средства.
Набор бортовых датчиков, заявленный в данном способе для получения навигационных данных, не обеспечивает высокой точности позиционирования транспортного средства, так поступление данных от GPS-приемника зависят от условий приема, местоположения приемной антенны по отношению к строениям и деревьям, а в закрытых помещениях принимается неустойчиво и с помехами, а на точность измерений датчиков, устанавливаемых на колесах транспортного средства, влияют характеристики дорожного покрытия.
Известен способ спутникового определения местоположения транспортного средства с использованием датчика движения и положения (WO2019179844), который включает в себя прием спутниковых данных GNSS, прием данных о скорости вращения колес транспортного средства и угле рулевого управления от датчиков транспортного средства, а также данных коррекции GNSS или данных инерциальных датчиков, прием дополнительных данных, позволяющих сделать выводы о качестве и/или точности определения позиции транспортного средства, поддерживаемой спутниковой навигационной системой. Такими данными могут быть данные о погоде, давлении в шинах колес, уровне скольжения колес, мобильной связи.
Данные о транспортном средстве, полученные на указанных шагах, поступают на датчик движения и положения, где осуществляется определение пространственного положения транспортного средства.
В представленном способе дополнительные данные о условиях окружающей среды получают в процессе определения местоположения транспортного средства для установления приоритета по точности измерений используемых бортовых датчиков, что усложняет работу алгоритма и снижает скорость обработки навигационной информации. К тому же, в способе не указано, как реализуется возможность независимой оценки скорости и углового положения транспортного средства по показаниям от нескольких разнородных бортовых датчиков.
Способ, раскрытый в источнике WO2019179844, является наиболее близким по технической сущности к заявляемому изобретению и может выступать в качестве прототипа.
Задачей, на решение которой направлено заявленное изобретение, является создание способа, позволяющего с высокой точностью определять пространственное положение наземного АТС при различных условиях его эксплуатации за счет комплексирования различных навигационных данных, получаемых от разнородных бортовых датчиков с возможностью регулирования степени влияния каждого бортового датчика − источника навигационной информации− на оценку пространственного положения в соответствии с условиями эксплуатации АТС.
Технический результат заявленного изобретения заключается в повышение точности определения положения наземного транспортного средства в пространстве при обеспечении стабильности позиционирования транспортного средства в различных условиях эксплуатации.
Технический результат заявленного изобретения достигается при реализации способа комплексирования разнородной навигационной информации, получаемой от бортовых датчиков автономного наземного транспортного средства (АТС) с целью его позиционирования, отличающегося тем, что данные о скорости движения АТС получают от энкодеров относительного или абсолютного типа, устанавливаемых на колесах АТС, и GNSS приемника, данные об угле поворота АТС вокруг вертикальной оси получают от энкодера, устанавливаемого на рулевой рейке АТС, и инерциальной навигационной системы, при этом в случае использования относительного колесного энкодера, показания о направлении движения АТС получают от энкодера вращения, размещаемого на валу двигателя АТС, производят конвертацию полученных данных от указанных бортовых датчиков в соответствующие единицы измерения скорости и угла поворота, определяют скорость движения АТС как сумму значений скоростей, полученных по показаниям колесных энкодеров и GNSS приемника с учетом весового коэффициента, предназначенного для регулирования степени влияния показаний указанных бортовых датчиков на оценку скорости движения АТС, затем определяют расчетный угол поворота АТС вокруг вертикальной оси по углу рулевой рейки с учетом значения скорости АТС, определенного на основе показаний колесных энкодеров и GNSS приемника, определяют относительные повороты АТС вокруг вертикальной оси по показаниям инерциальной навигационной системы и энкодера рулевой рейки как разность между предыдущими и текущими показаниями соответствующих бортовых датчиков, определяют угол поворота АТС вокруг вертикальной оси как сумму значений относительных поворотов по показаниям энкодера рулевой рейки и инерциальной навигационной системы с учетом весового коэффициента, предназначенного для регулирования степени влияния показаний указанных бортовых датчиков на оценку угла поворота АТС, полученные данные об угле поворота АТС вокруг вертикальной оси и скорости АТС комплексируют с помощью кинематической модели АТС, в результате чего определяют координаты и курс АТС.
Осуществление этапов предлагаемого способа, заключающихся в получении разнородной навигационной информации от разнородных бортовых датчиков АТС, независимом определении на ее основе скорости движения АТС и его углового положения вокруг вертикальной оси с возможностью настройки степени влияния каждого источника навигационной информации на оценку позиционирования АТС в соответствии с условиями среды эксплуатации, позволяет учитывать технические особенности работы бортовых датчиков в составе АТС при различных условиях окружающей среды, в результате чего обеспечивается настройка системы позиционирования АТС под заданные условия его эксплуатации, что приводит к повышению точности определения положения наземного транспортного средства в пространстве при обеспечении стабильности позиционирования транспортного средства в различных условиях эксплуатации.
На фиг. 1 представлена схема последовательности осуществления способа комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства.
Способ реализуется следующим образом.
Способ комплексирования разнородной навигационной информации для позиционирования автономного наземного транспортного средства (фиг. 1) предназначен для точного определения положения в пространстве (на плоскости) наземного транспортного средства. Положение, состоящее из координат и ориентации (угол курса), определяется в относительной системе координат, связанной с начальным положением транспортного средства, что обеспечивает гладкость траектории.
Положение в пространстве АТС, в том числе колесных и гусеничных роботов, определяется путем комплексирования различных навигационных данных, полученных от разнородных бортовых датчиков, при этом независимо оценивают скорость движения транспортного средства и его курс.
Данные о скорости движения транспортного средства получают от энкодеров, устанавливаемых на колесах транспортного средства, и от GNSS приемника.
Так как в реальной системе позиционирования АТС применяются относительные энкодеры, которые учитывают только разницу между измерениями, и не позволяют определять направление движения АТС, то дополнительно на валу двигателя АТС может быть расположен энкодер вращения, позволяющий определять частоту вращения и направление тягового вала двигателя, и, следовательно, оценивать текущее направление движения АТС.
В случае применения абсолютных энкодеров, позволяющих оценивать направление движения АТС, использование энкодера вращения на валу двигателя не обязательно.
Данные об угле поворота транспортного средства вокруг вертикальной оси получают от энкодера, устанавливаемого на рулевой рейке транспортного средства, и от инерциальной навигационной системы.
Затем производят конвертацию полученных данных от указанных бортовых датчиков в соответствующие единицы измерения скорости и угла поворота: информацию о скорости движения конвертируют в м/c, информацию об угле поворота - в радианы, после чего указанные данные подвергаются обработке экспоненциальным фильтром.
Скорость движения транспортного средства определяют как сумму значений скоростей, полученных по показаниям колесных энкодеров и GNSS приемника с учетом весового коэффициента, предназначенного для изменения степени влияния показаний указанных бортовых датчиков на оценку скорости движения транспортного средства:
Figure 00000001
где
Figure 00000002
- значение суммарной скорости по показаниям GNSS приемника и колесных энкодеров,
Figure 00000003
- значение скорости, полученное по показаниям колесных энкодеров,
Figure 00000004
- значение скорости, полученное по показаниям GNSS приемника,
Figure 00000005
- весовой коэффициент, предназначенный для изменения степени влияния показаний GNSS приемника и колесных энкодеров на результат значения скорости
Figure 00000002
.
Затем рассчитывают угол поворота транспортного средства вокруг вертикальной оси по углу рулевой рейки с учетом значение суммарной скорости
Figure 00000002
:
Figure 00000006
где
Figure 00000007
- ширина колесной базы, м;
Figure 00000008
- угол рулевой рейки, рад.
Определяют относительный поворот АТС вокруг вертикальной оси Z на основе показаний инерциального сенсора
Figure 00000009
и относительный поворот АТС вокруг вертикальной оси Z на основе показаний энкодера рулевой рейки
Figure 00000010
как разность между предыдущими и текущими показаниями соответствующих бортовых датчиков:
Figure 00000011
Figure 00000012
где
Figure 00000009
- разница между текущим значением угла поворота относительно оси Z
Figure 00000013
и предыдущим значением
Figure 00000014
по показаниям инерциального сенсора,
Figure 00000010
- разница между текущим значение угла поворота относительно оси Z
Figure 00000015
и предыдущим значением
Figure 00000016
по показаниям энкодера рулевой рейки.
Определяют значение суммарной величины угла поворота вокруг вертикальной оси Z по показаниям энкодера рулевой рейки и инерциальной навигационной системы как сумму значений относительных поворотов
Figure 00000009
и
Figure 00000010
с учетом весового коэффициента, предназначенного для изменения степени влияния указанных бортовых датчиков на оценку угла поворота транспортного средства вокруг вертикальной оси:
Figure 00000017
где
Figure 00000018
- значение суммарной величины угла поворота по показаниям энкодера рулевой рейки и инерциальной навигационной системы,
Figure 00000019
- весовой коэффициент, предназначенный для изменения степени влияния показаний энкодера рулевой рейки и инерциальной навигационной системы.
Настойка весового коэффициента, характеризующего степень «доверия» к каждому бортовому датчику - источнику навигационной информации - производится в зависимости от заданных условий окружающей среды и плана работы АТС (изменение скорости в течение времени работы, частота смены направлений, время работы), в которой функционирует АТС.
Так, в случае пропадания сигнала от GNSS или его ошибки, которое возможно, например, в тоннелях, лесах, гаражах, закрытых помещениях, приоритетным бортовым датчиком для определения скорости является колесный энкодер, обеспечивая при этом непрерывность и стабильность процесса локализации АТС.
В случае продолжительного времени функционирования АТС, гироскоп в составе инерциальной навигационной системы, может накопить достаточно большую ошибку и не обеспечить требуемую точность измерения углового положения, поэтому приоритет по точности измерений будет иметь энкодер рулевой рейки.
Основным фактором, влияющим на точность измерения колесных энкодеров, является тип поверхности дорожного покрытия, в соответствии с чем подбирается весовой коэффициент для данного бортового датчика. Весовые коэффициенты
Figure 00000005
,
Figure 00000019
принимают значения в диапазоне от 0 до 1.
Возможны следующие пограничные случаи значений весовых коэффициентов
Figure 00000005
:
-
Figure 00000005
=0 - значение скорости оценивается только по показаниям колесных энкодеров;
-
Figure 00000005
=1 - значение скорости оценивается только по показаниям GNSS;
-
Figure 00000005
=0.5 - значение скорости оценивается как среднее арифметическое между показаниями колесных энкодеров и GNSS.
Допустимы также любые промежуточные значения коэффициента в зависимости от определенной априорно, например, в результате экспериментов, точности источников - колесных энкодеров и GNSS.
Возможны следующие пограничные случаи значений весовых коэффициентов
Figure 00000019
:
-
Figure 00000019
=0 - значение угла поворота оценивается только по показаниям энкодера рулевой рейки;
-
Figure 00000019
=1 - значение угла поворота АТС оценивается только по показаниям инерциальной навигационной системы;
-
Figure 00000019
=0.5 - значение угла поворота оценивается как среднее арифметическое между показаниями энкодера рулевой рейки и инерциальной навигационной системы.
Допустимы также любые промежуточные значения коэффициента
Figure 00000019
в зависимости от определенной априорно, например, в результате экспериментов, точности источников - энкодера рулевой рейки и инерциальной навигационной системы.
Для определения местоположения и курсового угла АТС угол поворота
Figure 00000018
и скорость
Figure 00000002
комплексируют с помощью кинематической модели транспортного средства, в результате чего определяют координаты и курс транспортного средства:
Figure 00000020
Figure 00000021
Figure 00000022
где
Figure 00000023
- курсовой угол транспортного средства, рад;
Figure 00000024
- время, прошедшее с предыдущего расчета;
(
Figure 00000025
) - начальные координаты АТС;
(
Figure 00000026
) - оценка координат АТС.
Таким образом, в результате реализации способа комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства, при сформированном наборе бортовых датчиков, входящих в состав АТС, обеспечивается повышенная точность локализации АТС в различных условиях его эксплуатации при надежности и стабильности осуществления процесса навигации и как следствие безопасности эксплуатации АТС.

Claims (1)

  1. Способ комплексирования разнородной навигационной информации, получаемой от бортовых датчиков автономного наземного транспортного средства (АТС) с целью его позиционирования, отличающийся тем, что данные о скорости движения АТС получают от энкодеров относительного или абсолютного типа, устанавливаемых на колесах АТС, и GNSS приемника, данные об угле поворота АТС вокруг вертикальной оси получают от энкодера, устанавливаемого на рулевой рейке АТС, и инерциальной навигационной системы, при этом в случае использования относительного колесного энкодера показания о направлении движения АТС получают от энкодера вращения, размещаемого на валу двигателя АТС, производят конвертацию полученных данных от указанных бортовых датчиков в соответствующие единицы измерения скорости и угла поворота, определяют скорость движения АТС как сумму значений скоростей, полученных по показаниям колесных энкодеров и GNSS приемника с учетом весового коэффициента, предназначенного для регулирования степени влияния показаний указанных бортовых датчиков на оценку скорости движения АТС, затем определяют расчетный угол поворота АТС вокруг вертикальной оси по углу рулевой рейки с учетом значения скорости АТС, определенного на основе показаний колесных энкодеров и GNSS приемника, определяют относительные повороты АТС вокруг вертикальной оси по показаниям инерциальной навигационной системы и энкодера рулевой рейки как разность между предыдущими и текущими показаниями соответствующих бортовых датчиков, определяют угол поворота АТС вокруг вертикальной оси как сумму значений относительных поворотов по показаниям энкодера рулевой рейки и инерциальной навигационной системы с учетом весового коэффициента, предназначенного для регулирования степени влияния показаний указанных бортовых датчиков на оценку угла поворота АТС, полученные данные об угле поворота АТС вокруг вертикальной оси и скорости АТС комплексируют с помощью кинематической модели АТС, в результате чего определяют координаты и курс АТС.
RU2021113915A 2021-05-18 2021-05-18 Способ комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства RU2769440C1 (ru)

Priority Applications (3)

Application Number Priority Date Filing Date Title
RU2021113915A RU2769440C1 (ru) 2021-05-18 2021-05-18 Способ комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства
PCT/RU2021/000489 WO2022245246A1 (ru) 2021-05-18 2021-11-08 Способ комплексирования навигационных данных для позиционирования транспортного средства
EP21940963.8A EP4343283A1 (en) 2021-05-18 2021-11-08 Method of integrating navigational data to determine the position of a vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
RU2021113915A RU2769440C1 (ru) 2021-05-18 2021-05-18 Способ комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства

Publications (1)

Publication Number Publication Date
RU2769440C1 true RU2769440C1 (ru) 2022-03-31

Family

ID=81075787

Family Applications (1)

Application Number Title Priority Date Filing Date
RU2021113915A RU2769440C1 (ru) 2021-05-18 2021-05-18 Способ комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства

Country Status (3)

Country Link
EP (1) EP4343283A1 (ru)
RU (1) RU2769440C1 (ru)
WO (1) WO2022245246A1 (ru)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7979172B2 (en) * 1997-10-22 2011-07-12 Intelligent Technologies International, Inc. Autonomous vehicle travel control systems and methods
RU2559194C1 (ru) * 2014-09-02 2015-08-10 Открытое акционерное общество "Завод им. В.А. Дегтярева" Робототехнический комплекс
RU2634082C1 (ru) * 2016-06-02 2017-10-23 Публичное акционерное общество "Московский институт электромеханики и автоматики" (ПАО "МИЭА") Способ комплексирования бесплатформенных инерциальных навигационных систем
RU2685767C1 (ru) * 2018-08-13 2019-04-23 Самсунг Электроникс Ко., Лтд. Способ и устройство бесплатформенной инерциальной навигации

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090319186A1 (en) 2008-06-24 2009-12-24 Honeywell International Inc. Method and apparatus for determining a navigational state of a vehicle
CN105823481B (zh) 2015-12-21 2019-02-12 上海华测导航技术股份有限公司 一种基于单天线的gnss-ins车辆定姿方法
DE102018204304A1 (de) 2018-03-21 2019-09-26 Robert Bosch Gmbh Verfahren zur satellitengestützten Ermittlung einer Fahrzeugposition mittels eines Bewegungs- und Positionssensors
CN110567458A (zh) 2018-06-05 2019-12-13 北京三快在线科技有限公司 一种机器人定位方法及装置和机器人

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7979172B2 (en) * 1997-10-22 2011-07-12 Intelligent Technologies International, Inc. Autonomous vehicle travel control systems and methods
RU2559194C1 (ru) * 2014-09-02 2015-08-10 Открытое акционерное общество "Завод им. В.А. Дегтярева" Робототехнический комплекс
RU2634082C1 (ru) * 2016-06-02 2017-10-23 Публичное акционерное общество "Московский институт электромеханики и автоматики" (ПАО "МИЭА") Способ комплексирования бесплатформенных инерциальных навигационных систем
RU2685767C1 (ru) * 2018-08-13 2019-04-23 Самсунг Электроникс Ко., Лтд. Способ и устройство бесплатформенной инерциальной навигации

Also Published As

Publication number Publication date
EP4343283A1 (en) 2024-03-27
WO2022245246A1 (ru) 2022-11-24

Similar Documents

Publication Publication Date Title
EP3715785B1 (en) Slam assisted ins
EP2856273B1 (en) Pose estimation
EP1435555B1 (en) Robot localization system
CN106289275B (zh) 用于改进定位精度的单元和方法
JP5036462B2 (ja) ナビゲーション・システムおよびナビゲーション方法
JP7073052B2 (ja) ビークルの角度位置を測定するシステムおよび方法
JP4964047B2 (ja) 位置検出装置及び位置検出方法
EP3884353B1 (en) Detecting a location of an autonomous device
JP2005140789A (ja) 移動物体の進行方向の推定方法およびシステム
JP2020169872A (ja) 慣性航法装置
CN113670334B (zh) 一种飞行汽车的初始对准方法和装置
KR20190003265A (ko) 관성센서 캘리브레이션 방법
JP5164645B2 (ja) カルマンフィルタ処理における繰り返し演算制御方法及び装置
Takanose et al. Eagleye: A lane-level localization using low-cost gnss/imu
RU2769440C1 (ru) Способ комплексирования разнородной навигационной информации для позиционирования наземного транспортного средства
CN113063441B (zh) 里程计累计推算误差的数据源纠正方法及装置
KR101987413B1 (ko) 측위 시스템 및 방법
KR101964059B1 (ko) 실내 주차장 안내 시스템을 위한 바퀴 속력 센서 기반 차량 측위 시스템
CN112406861B (zh) 利用地图数据进行卡尔曼滤波器参数选择的方法和装置
WO2023162017A1 (ja) 位置姿勢推定装置、位置姿勢推定システム、およびセンサ設置方法
JP7155686B2 (ja) 自律移動体の位置推定装置
JP6900248B2 (ja) 現在位置算出装置、ナビゲーションシステム及びピッチ角誤差の算出方法
KR101921483B1 (ko) Gnss 기반의 위치 추정의 불확실성을 측정하는 방법
CN118089764A (zh) 一种自动驾驶定位方法及系统
Ruangpayoongsak et al. LOCALIZATION FOR A CAR-LIKE MOBILE ROBOT USING NONLINEAR DYNAMIC MODEL