RU2678960C1 - Устройство оценки положения транспортного средства, способ оценки положения транспортного средства - Google Patents
Устройство оценки положения транспортного средства, способ оценки положения транспортного средства Download PDFInfo
- Publication number
- RU2678960C1 RU2678960C1 RU2018110810A RU2018110810A RU2678960C1 RU 2678960 C1 RU2678960 C1 RU 2678960C1 RU 2018110810 A RU2018110810 A RU 2018110810A RU 2018110810 A RU2018110810 A RU 2018110810A RU 2678960 C1 RU2678960 C1 RU 2678960C1
- Authority
- RU
- Russia
- Prior art keywords
- landmark
- vehicle
- data
- unit
- adjustment range
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 230000033001 locomotion Effects 0.000 claims abstract description 55
- 238000006073 displacement reaction Methods 0.000 claims description 28
- 238000012937 correction Methods 0.000 claims description 25
- 230000000694 effects Effects 0.000 abstract description 2
- 239000000126 substance Substances 0.000 abstract 1
- 238000001514 detection method Methods 0.000 description 32
- 238000010586 diagram Methods 0.000 description 23
- 230000001133 acceleration Effects 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 230000007423 decrease Effects 0.000 description 4
- 239000010432 diamond Substances 0.000 description 3
- 240000004050 Pentaglottis sempervirens Species 0.000 description 2
- 235000004522 Pentaglottis sempervirens Nutrition 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000000994 depressogenic effect Effects 0.000 description 1
- 229910003460 diamond Inorganic materials 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/36—Input/output arrangements for on-board computers
- G01C21/3602—Input other than that of destination using image analysis, e.g. detection of road signs, lanes, buildings, real preceding vehicles using a camera
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/36—Input/output arrangements for on-board computers
- G01C21/3667—Display of a road map
- G01C21/367—Details, e.g. road map scale, orientation, zooming, illumination, level of detail, scrolling of road map or positioning of current position marker
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Aviation & Aerospace Engineering (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
Настоящее изобретение относится к устройству оценки положения транспортного средства и способу оценки положения транспортного средства. В данном устройстве оценки положения транспортного средства определяются положения ориентира на периферии транспортного средства, и наряду с этим определяются величины перемещений транспортного средства, и положения ориентира сохраняются в качестве данных о положении ориентира на основе величин перемещений. В дополнение, часть данных о положении ориентира группируется в группу в соответствии с состояниями поворота транспортного средства, и на основе величин перемещений транспортного средства при определении данных о положении ориентира устанавливается диапазон корректировки для группы. Кроме того, обеспечивается картографическая информация, включающая в себя положения ориентира, и путем сопоставления данных о положении ориентира с положениями ориентира в картографической информации на основе установленного диапазона корректировки оценивается положение транспортного средства. Технический результат – повышение точности оценки положения транспортного средства на дороге. 2 н. и 5 з.п. ф-лы, 16 ил.
Description
ОБЛАСТЬ ТЕХНИКИ, К КОТОРОЙ ОТНОСИТСЯ ИЗОБРЕТЕНИЕ
[0001] Настоящее изобретение относится к устройству оценки положения транспортного средства и способу оценки положения транспортного средства.
УРОВЕНЬ ТЕХНИКИ
[0002] Традиционная технология, раскрытая в Патентной литературе 1, представляет собой технологию, в которой автономно движущийся мобильный робот оценивает положение транспортного средства в соответствии с величиной перемещения и путем сопоставления пути, определенного в ходе лазерного сканирования, с полученной заранее картографической информацией выполняет корректировку оценочного положения транспортного средства. Определенный путь и картографическая информация рассматриваются как двумерные данные, если смотреть в плане, и при выполнении сопоставления используются только данные, находящиеся в заданном диапазоне от текущего местоположения.
Список библиографических документов
Патентная литература
[0003] Патентная литература 1: JP 2008-250906 A
СУЩНОСТЬ ИЗОБРЕТЕНИЯ
Техническая задача
[0004] При возникновении ошибки в информации об определенном пути из-за возникновения ошибки в величине перемещения возникает различие между определенной формой пути и фактической формой пути и степень соответствия между информацией об определенном пути и картографической информацией уменьшается, что не позволяет оценивать положение транспортного средства с высокой точностью.
Задача настоящего изобретения заключается в повышении точности оценки положений транспортного средства.
Решение задачи
[0005] Устройство оценки положения транспортного средства в соответствии с одним аспектом настоящего изобретения определяет положения ориентира на периферии транспортного средства и наряду с этим определяет величины перемещений транспортного средства и сохраняет положения ориентира в качестве данных о положении ориентира на основе величин перемещений. В дополнение, устройство оценки положения транспортного средства группирует часть данных о положении ориентира в группу в соответствии с состояниями поворота транспортного средства и на основе величин перемещений транспортного средства при определении данных о положении ориентира устанавливает диапазон корректировки для группы. Кроме того, устройство оценки положения транспортного средства получает картографическую информацию, включающую в себя положения ориентира, и путем сопоставления данных о положении ориентира с положениями ориентира в картографической информации на основе установленного диапазона корректировки оценивает положение транспортного средства.
Полезные эффекты изобретения
[0006] В соответствии с настоящим изобретением, поскольку положение транспортного средства оценивается путем сопоставления данных о положении ориентира с картографической информацией при корректировке данных о положении ориентира в пределах диапазона корректировки, точность оценки положения транспортного средства может быть улучшена.
КРАТКОЕ ОПИСАНИЕ ЧЕРТЕЖЕЙ
[0007] Фиг. 1 представляет собой конфигурационную схему устройства оценки положения транспортного средства;
Фиг. 2 представляет собой схематическое изображение, иллюстрирующее расположение радиолокационных устройств и камер;
Фиг. 3 представляет собой схематическое изображение, иллюстрирующее диапазоны сканирования радиолокационных устройств и диапазоны обзора камер;
Фиг. 4 представляет собой схематическое изображение, иллюстрирующее систему координат транспортного средства;
Фиг. 5 представляет собой схематическое изображение, иллюстрирующее систему координат одометрии;
Фиг. 6 представляет собой схематическое изображение, иллюстрирующее положения ориентиров в системе координат транспортного средства;
Фиг. 7 представляет собой схематическое изображение, на котором траектория движения связана с положениями ориентиров;
Фиг. 8A и 8B представляют собой схематические изображения, иллюстрирующие способы обнаружения точки Pt поворота;
Фиг. 9 представляет собой схематическое изображение, иллюстрирующее группирование;
Фиг. 10 представляет собой график, используемый для установки допустимого диапазона α.
Фиг. 11 представляет собой график, используемый для установки допустимых диапазонов β1 и β2 в соответствии с радиусом R поворота;
Фиг. 12 представляет собой схематическое изображение, иллюстрирующее данные о положении ориентира до корректировки;
Фиг. 13 представляет собой схематическое изображение, иллюстрирующее данные о положении ориентира после корректировки;
Фиг. 14 представляет собой блок-схему, иллюстрирующую процесс оценки положения транспортного средства;
Фиг. 15A и 15B представляют собой схематические изображения, иллюстрирующие результат получения прямой линии; и
Фиг. 16 представляет собой график, используемый для установки допустимых диапазонов β1 и β2 в соответствии с расстоянием dm перемещения.
ОСУЩЕСТВЛЕНИЕ ИЗОБРЕТЕНИЯ
[0008] Далее будет описан вариант осуществления настоящего изобретения со ссылкой на чертежи. Отметим, что чертежи являются схематичными и иногда отличаются от фактических вариантов осуществления. В дополнение, следующий далее вариант осуществления описывает устройства и способы воплощения технической идеи настоящего изобретения путем примера и не ограничивает конфигурацию описанным ниже. Другими словами, техническая идея настоящего изобретения может быть подвергнута различным изменениям в пределах технического объема, описанного в формуле изобретения.
[0009] Первый вариант осуществления
Конфигурация
Фиг. 1 представляет собой конфигурационную схему устройства оценки положения транспортного средства.
Устройство 11 оценки положения транспортного средства представляет собой устройство, выполненное с возможностью оценки положения транспортного средства, и включает в себя радиолокационные устройства 12, камеры 13, картографическую базу 14 данных, группу 15 датчиков и контроллер 16.
Фиг. 2 представляет собой схематическое изображение, иллюстрирующее расположение радиолокационных устройств и камер.
Фиг. 3 представляет собой схематическое изображение, иллюстрирующее диапазоны сканирования радиолокационных устройств и диапазоны обзора камер.
[0010] Каждое радиолокационное устройство 12 имеет конфигурацию, включающую в себя, например, лазерный дальномер (LRF), измеряет направление и расстояние до объекта, который находится сбоку от транспортного средства 21, и выводит измеренные данные в контроллер 16. Радиолокационные устройства 12 расположены в двух местах, а именно на левой боковой поверхности и правой боковой поверхности транспортного средства 21. Когда два радиолокационных устройства 12 отличаются друг от друга, радиолокационные устройства, расположенные на левой боковой поверхности и правой боковой поверхности транспортного средства 21, называются левым радиолокационным устройством 12L и правым радиолокационным устройством 12R соответственно. Левое радиолокационное устройство 12L и правое радиолокационное устройство 12R выполняют сканирование в направлениях снизу влево и в направлениях снизу вправо соответственно. Другими словами, каждое из левого радиолокационного устройства 12L и правого радиолокационного устройства 12R имеет ось вращения в продольном направлении кузова транспортного средства и выполняет сканирование в направлениях под прямым углом к оси. В ходе этой операции определяются направления и расстояния до дорожной поверхности 22 и бордюра 23 сбоку от кузова транспортного средства. Бордюр 23 обеспечен на обочине дороги вдоль полосы движения в качестве границы между дорожным полотном и тротуаром.
[0011] Каждая камера 13 имеет конфигурацию, включающую в себя, например, широкоугольную камеру с использованием датчика изображения с зарядовой связью (CCD), захватывает боковую сторону транспортного средства 21 и выводит захваченные данные в контроллер 16. Камеры 13 расположены в двух местах, а именно на левом дверном зеркале и правом дверном зеркале транспортного средства 21. Когда две камеры 13 отличаются друг от друга, камеры, расположенные на левом дверном зеркале и правом дверном зеркале транспортного средства 21, называются левой камерой 13L и правой камерой 13R соответственно. Левая камера 13L и правая камера 13R захватывают дорожную поверхность 22 с левой стороны и с правой стороны от транспортного средства 21 соответственно. В ходе этой операции определяются линии 24 дорожной разметки сбоку от кузова транспортного средства. Линии 24 дорожной разметки представляют собой разделительные линии, например, белые линии, которые нанесены на дорожную поверхность 22 для обозначения полосы движения (полосы движения транспортного средства), по которой должно перемещаться транспортное средство 21, и которые проходят вдоль полосы движения. Отметим, что хотя в целях описания на Фиг. 3 проиллюстрированы трехмерные линии 24 дорожной разметки, предполагается, что линии 24 дорожной разметки выполнены заподлицо с дорожной поверхностью 22, так как их толщина на практике может считаться нулевой.
[0012] Картографическая база 14 данных получает информацию дорожных карт. В информацию дорожных карт входит информация о положении бордюра 23 и линий 24 дорожной разметки. Являясь объектом, имеющим высоту, бордюр 23 рассматривается как двумерные данные, если смотреть в плане. Бордюр 23 и линии 24 дорожной разметки закодированы в данные, которые представляют собой набор прямых линий, причем каждая прямая линия рассматривается как информация о положении обоих ее концевых точек, а дуговая кривая, которая изгибается, рассматривается как прямые линии, которые образуют ломаную линию, аппроксимирующую дуговую кривую. Отметим, что картографическая база 14 данных может представлять собой носитель данных, который хранит информацию дорожных карт для навигационной системы транспортного средства, или может получать картографическую информацию извне посредством системы связи, например, системы беспроводной связи (также применима связь между дорожной инфраструктурой и транспортным средством и связь между транспортными средствами). В этом случае картографическая база 14 данных может периодически получать последнюю картографическую информацию и обновлять сохраненную картографическую информацию. Картографическая база 14 данных также может сохранять маршруты, фактически пройденные транспортным средством, в качестве картографической информации.
[0013] Группа 15 датчиков включает в себя, например, GPS-приемник, датчик педали акселератора, датчик угла поворота рулевого колеса, датчик педали тормоза, датчик скорости транспортного средства, датчики ускорения, датчики скорости колес, датчик скорости рыскания и т.п., и выводит соответствующие обнаруженные данные в контроллер 16. GPS-приемник получает информацию о текущем местоположении транспортного средства 21. Датчик педали акселератора определяет величину нажатия педали акселератора. Датчик угла поворота рулевого колеса определяет величину поворота рулевого колеса. Датчик педали тормоза определяет величину нажатия педали тормоза и давление в усилителе тормозов. Датчик скорости транспортного средства определяет скорость транспортного средства. Датчики ускорения определяют ускорение/замедление в продольном направлении и боковое ускорение транспортного средства. Датчики скорости колес определяют скорости соответствующих колес. Датчик скорости рыскания определяет скорость рыскания транспортного средства.
[0014] Контроллер 16 имеет конфигурацию, включающую в себя, например, электронный блок управления (ECU), который включает в себя CPU, ROM, RAM и т.п., и в ROM записана программа, которая выполняет различные типы рабочих процессов, например, процесс оценки положения транспортного средства, который будет описан ниже. Отметим, что может быть обеспечен контроллер 16, специально предназначенный для процесса оценки положения транспортного средства, или другой контроллер может быть выполнен с возможностью работы в качестве контроллера для процесса оценки положения транспортного средства.
Контроллер 16 включает в себя, в качестве составных функциональных блоков, блок 31 определения положения ориентира, блок 32 определения величины перемещения, блок 33 хранения положения ориентира, блок 34 установки диапазона корректировки и блок 35 оценки положения транспортного средства.
[0015] Блок 31 определения положения ориентира определяет положения ориентиров на периферии транспортного средства, например, бордюра 23 и линий 24 дорожной разметки, как относительные положения относительно транспортного средства в системе координат транспортного средства, зафиксированной относительно транспортного средства.
Фиг. 4 представляет собой схематическое изображение, иллюстрирующее систему координат транспортного средства.
Система координат транспортного средства представляет собой двумерную систему координат, если смотреть в плане, и, например, середина задней колесной оси, продольное направление и правое и левое направления транспортного средства 21 считаются началом O координат, осью XVHC и осью YVHC соответственно. Формула, которая преобразует каждую из систем координат радиолокационных устройств 12 и систем координат камер 13 в систему координат транспортного средства получена заранее. В дополнение параметры дорожной поверхности 22 в системе координат транспортного средства известны заранее.
[0016] Дорожная поверхность 22 сканируется лазером по направлению к внешним сторонам в направлении ширины транспортного средства путем использования радиолокационных устройств 12, и положение, в котором в результате сканирования наблюдается большое изменение высоты (перепад высот), определяется как конечная точка со стороны дорожного полотна в направлении ширины бордюра 23. Другими словами, положение бордюра 23 определяется на основе трехмерных данных и проецируется на двумерную систему координат транспортного средства. На Фиг. 4 точка обнаружения бордюра 23 обозначена Pc и показана заштрихованным ромбом.
Путем захвата дорожной поверхности 22 с использованием камер 13 и путем получения на захваченных полутоновых изображениях образцов, на которых яркость изменяется с темного участка на яркий участок и с яркого участка на темный участок вдоль правого и левого направлений кузова транспортного средства, определяются линии 24 дорожной разметки. Например, определяются средние точки в направлении ширины линий 24 дорожной разметки. Другими словами, данные изображения, захваченные камерами 13, преобразуются посредством преобразования вида с высоты птичьего полета в изображения с высоты птичьего полета, на основе которых определяются линии 24 дорожной разметки и проецируются на систему координат транспортного средства. На Фиг. 4 точки обнаружения линий 24 дорожной разметки обозначены Pw и показаны заштрихованными кругами.
[0017] Блок 32 определения величины перемещения определяет одометрию, то есть величину перемещения транспортного средства 21 в единицу времени на основе различных типов информации, обнаруженной группой 15 датчиков. Объединение одометрий позволяет вычислять траекторию движения транспортного средства в системе координат одометрии.
Фиг. 5 представляет собой схематическое изображение, иллюстрирующее систему координат одометрии.
Система координат одометрии принимает положение транспортного средства в момент времени, например, при включении или выключении питания системы, за начало координат, а угловое пространственное положение кузова транспортного средства (азимут) в момент времени за 0 градусов. Путем сохранения трех параметров транспортного средства, а именно координатных положений [XODM, YODM] и углового пространственного положения кузова транспортного средства [θODM], в системе координат одометрии в каждый рабочий цикл определяется траектория движения. На Фиг. 5 проиллюстрированы координатные положения и пространственные положения кузова транспортного средства в моменты времени t1-t4. Отметим, что с использованием текущего местоположения транспортного средства, установленного в начало координат, может каждый раз выполняться преобразование координат сохраненных данных о положении ориентира. Другими словами, может быть достаточно, чтобы данные о положении ориентира сохранялись в одной системе координат.
[0018] Блок 33 хранения положения ориентира хранит траекторию движения на основе величин перемещений, определенных блоком 32 определения величины перемещения, и положения ориентиров, определенные блоком 31 определения положения ориентира, в связи друг с другом в системе координат одометрии.
Фиг. 6 представляет собой схематическое изображение, иллюстрирующее положения ориентиров в системе координат транспортного средства.
На Фиг. 6 проиллюстрированы положения ориентиров в системе координат транспортного средства, определенные блоком 31 определения положения ориентира в моменты времени t1-t4. Что касается ориентиров, определены точки Pc обнаружения бордюра 23 с левой стороны от транспортного средства 21, точки Pw обнаружения одной из линий 24 дорожной разметки с левой стороны от транспортного средства 21 и точки Pw обнаружения другой из линий 24 дорожной разметки с правой стороны от транспортного средства 21. Положения соответствующих ориентиров в системе координат транспортного средства изменяются в зависимости от момента времени из-за смещения и изменения углового пространственного положения транспортного средства 21.
[0019] Фиг. 7 представляет собой схематическое изображение, на котором траектория движения на основе величин перемещений транспортного средства связана с положениями ориентиров.
Другими словами, соответствующие координатным положениям и угловым пространственным положениям кузова транспортного средства в моменты времени t1-t4 положения ориентиров в соответствующие моменты времени проецируются на систему координат одометрии. Другими словами, точки Pc обнаружения бордюра 23 с левой стороны от транспортного средства 21, точки Pw обнаружения одной из линий 24 дорожной разметки с левой стороны от транспортного средства 21 и точки Pw обнаружение другой из линий 24 дорожной разметки с правой стороны от транспортного средства 21 проецируются в соответствующие моменты времени.
[0020] Блок 33 хранения положения ориентира получает прямые линии, направленные вдоль полосы движения из группы точек, полученных в течение единичного интервала времени Δt, на ориентирах, последовательно обнаруженных блоком 31 определения положения ориентира. В частности, в системе координат одометрии вычисляются оптимальные параметры a, b и c в уравнении [aXODM+bYODM+c=0], представляющем прямую линию.
Если предполагается, что единичный интервал времени Δt составляет 0,2 секунды, радиолокационные устройства 12 работают с частотой 25 Гц, и камеры 13 работают с частотой 30 Гц, в течение единичного интервала времени Δt могут быть получены данные в пяти точках и данные в шести точках в отношении бордюра 23 и каждой линии 24 дорожной разметки соответственно. Предполагается, что нахождение каждого ориентира с левой стороны или с правой стороны от транспортного средства 21 определяется в зависимости от того, является ли координата YVHC ориентира в системе координат транспортного средства положительной или отрицательной. Таким образом, группа точек делится в зависимости от того, расположена ли каждая точка с правой стороны или с левой стороны от транспортного средства 21, а затем вычисляются параметры a, b и c.
[0021] Когда сумма расстояний между прямой линией и соответствующими точками обнаружения становится не меньше порогового значения, определяется, что прямая линия неопределима. С другой стороны, когда сумма расстояний между прямой линией и соответствующими точками обнаружения становится меньше порогового значения, определяется, что прямая линия определима. Две точки, которые обеспечивают максимальную длину между ними, выбираются из точек обнаружения, которые обеспечивают минимальное расстояние до прямой линии, и информация о двух точках вместе с моментами их получения сохраняется в блоке 33 хранения положения ориентира.
В этом случае прямая линия L23 получается из точек Pc обнаружения бордюра 23 с левой стороны от транспортного средства 21, обнаруженных в моменты времени t1-t4. В дополнение прямая линия L24 получается из точек Pw обнаружения одной из линий 24 дорожной разметки с левой стороны от транспортного средства 21, обнаруженных в моменты времени t1-t4. Кроме того, другая прямая линия L24 получается из точек Pw обнаружения другой линии 24 дорожной разметки с правой стороны от транспортного средства 21, обнаруженных в моменты времени t1-t4.
[0022] Блок 34 установки диапазона корректировки группирует части данных о положении ориентира, сохраненных в блоке 33 хранения положения ориентира, в группы в соответствии с состояниями поворота транспортного средства и на основе величин перемещений транспортного средства при определении данных о положении ориентира устанавливает диапазоны корректировки для групп.
Сначала определяется точка Pt поворота транспортного средства на основе траектории движения, основанной на величинах перемещений. В варианте осуществления точка Pt поворота определяется любым из следующих далее способов.
Фиг. 8A и 8B представляют собой схематические изображения, иллюстрирующие способы обнаружения точки Pt поворота.
На Фиг. 8A текущее местоположение Pn и точка Pr, полученная путем возврата из текущего местоположения Pn на заданное расстояние D1, соединены прямой линией L1. Исходя из этого в диапазоне возврата из текущего местоположения Pn на заданное расстояние D1 точка, расстояние d до которой от прямой линии L1 в направлении, перпендикулярном ей, не меньше заданного значения d1, которая максимально удалена от прямой линии L1, определена как точка Pt поворота.
[0023] На Фиг. 8B точка, в которой при возврате из текущего местоположения Pn угол θt поворота транспортного средства впервые становится не меньше заданного угла θ1, определена как точка Pt поворота. Угол θt поворота транспортного средства в системе координат одометрии представляет собой величину изменения углового пространственного положения до тех пор, пока не будет достигнуто текущее угловое пространственное положение кузова транспортного средства и, следовательно, угловая разница кузова транспортного средства с текущим направлением кузова транспортного средства, используемая в качестве контрольного угла. Заданный угол θ1 составляет, например, 60 градусов.
Затем данные о положении ориентира в точках в или после точки Pt поворота группируются в группу данных, называемую первой группой Gr1. В дополнение данные о положении ориентира в точках перед точкой Pt поворота группируются в другую группу данных, называемую второй группой Gr2.
[0024] Фиг. 9 представляет собой схематическое изображение, иллюстрирующее группирование.
На Фиг. 9 данные о положении ориентира от точки Pt поворота до текущего местоположения Pn и данные о положении ориентира в заданном диапазоне перед точкой Pt поворота группируются в первую группу Gr1 и вторую группу Gr2 соответственно.
Затем устанавливаются допустимый диапазон α и допустимые диапазоны β1 и β2 в корректировке положения (поперечное перемещение) и корректировке угла (поворот) сгруппированных данных о положении ориентира соответственно для сопоставления сгруппированных данных о положении ориентира с картографической информацией. Положения [xg, yg] сгруппированных данных о положении ориентира могут быть скорректированы по положению в пределах диапазона, имеющего радиус α с центром в точке Pt поворота в системе координат одометрии, и углы Φg сгруппированных данных о положении ориентира могут быть скорректированы по углу в пределах диапазонов β1 и β2 с центром вращения в точке Pt поворота в системе координат одометрии. Отметим, что допустимые диапазоны β1 и β2 могут быть установлены в одном и том же угловом диапазоне. В дополнение при выполнении корректировки в отношении только первой группы Gr1 может быть установлен только допустимый диапазон β1, тогда как допустимый диапазон β2 установлен на ноль, и при выполнении корректировки в отношении только второй группы Gr2 может быть установлен только допустимый диапазон β2, тогда как допустимый диапазон β1 установлен на ноль.
[0025] Прежде всего при увеличении расстояния перемещения в количестве перемещения транспортного средства более вероятно возникновение ошибки в информации одометрии. Таким образом, при увеличении расстояния dm перемещения допустимый диапазон α становится больше.
Фиг. 10 представляет собой график, используемый для установки допустимого диапазона α.
Абсцисса и ордината графика представляют расстояние dm перемещения в величине перемещения транспортного средства в данных о положении ориентира и допустимый диапазон α для корректировки положения соответственно. Что касается расстояния dm перемещения, значение dm1, которое больше 0, и значение dm2, которое больше dm1, определены заранее. Что касается допустимого диапазона α, значение αMIN, которое больше 0, и значение αMAX, которое больше αMIN, определены заранее. Когда расстояние dm перемещения находится в диапазоне от dm1 до dm2, чем больше расстояние dm перемещения, тем больше становится допустимый диапазон α в пределах диапазона от αMIN до αMAX. В дополнение, когда расстояние dm перемещения не меньше dm2, допустимый диапазон α сохраняется на αMAX.
[0026] При увеличении величины поворота в величине перемещения транспортного средства возникает более сильное боковое скольжение, что приводит к вероятному возникновению ошибки в информации одометрии из-за характеристик датчиков. Отметим, что большая величина поворота в величине перемещения транспортного средства означает меньший радиус R поворота. Таким образом, при уменьшении радиуса R поворота допустимые диапазоны β1 и β2 становятся больше.
Фиг. 11 представляет собой график, используемый для установки допустимых диапазонов β1 и β2 в соответствии с радиусом R поворота.
Абсцисса и ордината графика представляют радиус R поворота транспортного средства в данных о положении ориентира и допустимые диапазоны β1 и β2 в угловой корректировке. Что касается радиуса R поворота, значение R1, которое больше 0, и значение R2, которое больше R1, определены заранее. Что касается допустимых диапазонов β1 и β2, значение βMIN, которое больше 0, и значение βMAX, которое больше βMIN, определены заранее. Когда радиус R поворота не меньше R2, допустимые диапазоны β1 и β2 сохраняются на βMIN. Когда радиус R поворота находится в диапазоне от R2 до R1, чем меньше радиус R поворота, тем больше становятся допустимые диапазоны β1 и β2 в пределах диапазона от βMIN до βMAX.
[0027] Блок 35 оценки положения транспортного средства путем сопоставления данных о положении ориентира, сохраненных в блоке 33 хранения положения ориентира, с картографической информацией, сохраненной в картографической базе 14 данных, на основе диапазонов, установленных блоком 34 установки диапазона корректировки, оценивает положение транспортного средства 21 в системе координат карты.
Сначала при сопоставлении данных о положении ориентира с картографической информацией вычисляется расположение соответствующих групп, которое минимизирует ошибку сопоставления, в то время как данные о положении ориентира перемещаются в пределах диапазонов корректировки с точкой Pt поворота в качестве опорной точки. В ходе корректировки при сохранении относительных позиционных взаимосвязей между данными о положении ориентира в соответствующей группе относительная взаимосвязь между группами корректируется с точкой Pt поворота в качестве опорной точки. Другими словами, хотя элементы данных в соответствующих из первой группы Gr1 и второй группы Gr2 не перемещаются в пределах групп, каждая из первой группы Gr1 и второй группы Gr2 перемещается и поворачивается как одно целое. При сопоставлении сгруппированных данных о положении ориентира с картографической информацией прямые линии L23 получаются на основе точек Pc обнаружения бордюров 23, а прямые линии L24 получаются на основе точек Pw обнаружения линий 24 дорожной разметки, как описано выше, а затем с использованием этих прямых линий L23 и L24 данные о положении ориентира сопоставляются с картографической информацией.
[0028] Фиг. 12 представляет собой схематическое изображение, иллюстрирующее данные о положении ориентира до корректировки.
Система координат карты представляет собой двумерную систему координат, если смотреть в плане, и предполагается, что направление восток-запад и направление север-юг соответствуют оси XMAP и оси YMAP соответственно. Угловое пространственное положение кузова транспортного средства (азимут) представлено углом против часовой стрелки, причем 0 градусов является направлением на восток. На Фиг. 12 проиллюстрирована ситуация, в которой транспортное средство выполнило поворот направо на перекрестке. Как до, так и после поворота направо точки обнаружения бордюров, обозначенные заштрихованными ромбами, и точки обнаружения линий дорожной разметки, обозначенные заштрихованными кругами, отличаются от соответствующих положений бордюров 23 и линий 24 дорожной разметки в системе координат карты соответственно. На Фиг. 12 также проиллюстрированы допустимые диапазоны, в пределах которых могут быть скорректированы данные о положении ориентира, и данные о положении ориентира относительно каждой группы могут быть скорректирован по положению и скорректированы по углу в пределах диапазона, имеющего радиус α, и диапазонов β1 и β2 соответственно с центром в точке Pt0 поворота до корректировки.
[0029] Фиг. 13 представляет собой схематическое изображение, иллюстрирующее данные о положении ориентира после корректировки.
В этом примере сгруппированные данные о положении ориентира сопоставляются с картографической информацией с точкой Pt поворота в качестве опорной точки. Другими словами, расположение соответствующих групп корректируется с точкой Pt поворота в качестве опорной точки так, что позиционные смещения точек обнаружения бордюров и точек обнаружения линий дорожной разметки от соответствующих положений бордюров 23 и линий 24 дорожной разметки в системе координат карты минимизируются. Сначала точка поворота корректируется по положению с Pt0 на Pt1, и величина корректировки при корректировке составляет ΔPt[Δx, Δy], что находится в допустимом диапазоне α. В дополнение, группа данных о положении ориентира в и после точки Pt1 поворота корректируется по углу с центром вращения в точке Pt1 поворота, и величина корректировки при корректировке составляет Δθ1, что находится в допустимых диапазонах β1 и β2. Подобным образом, группа данных о положении ориентира перед точкой Pt1 поворота также корректируется с центром вращения в точке Pt1 поворота, и величина корректировки при корректировке составляет Δθ2, что находится в допустимых диапазонах β1 и β2. Вышеуказанная корректировка приводит к тому, что точки обнаружения бордюров и точки обнаружения линий дорожной разметки как в данных о положении ориентира до поворота направо, так и в данных о положении ориентира после поворота направо по существу совпадают с соответствующими положениями бордюров 23 и линий 24 дорожной разметки в системе координат карты.
[0030] Как описано выше, после сопоставления данных о положении ориентира, сохраненных в блоке 33 хранения положения ориентира, с картографической информацией, сохраненной в картографической базе 14 данных, блок 35 оценки положения транспортного средства оценивает положение транспортного средства 21 в системе координат карты.
Система координат карты представляет собой двумерную систему координат, если смотреть в плане, и предполагается, что направление восток-запад и направление север-юг соответствуют оси XMAP и оси YMAP соответственно. Угловое пространственное положение кузова транспортного средства (азимут) представлено углом против часовой стрелки, причем 0 градусов является направлением на восток. В системе координат карты оцениваются три параметра, а именно координатные положения [XMAP, YMAP] и угловое пространственное положение [θMAP] кузова транспортного средства. Для сопоставления (картографического сопоставления), например, используется итеративный алгоритм ближайших точек (ICP). При сопоставлении прямых линий друг с другом конечные точки на обоих концах прямых линий сопоставляются друг с другом в качестве точек оценки, и когда пространство между конечными точками на обоих концах является большим, точки в пространстве могут быть интерполированы.
[0031] Если степень соответствия при сопоставлении является высокой, когда блок 35 оценки положения транспортного средства корректирует данные о положении ориентира в пределах допустимых диапазонов, блок 33 хранения положения ориентира корректирует (обновляет) сохраненные данные о положении ориентира в соответствии с данными о положении ориентира после корректировки. С другой стороны, если степень соответствия при сопоставлении является низкой, когда блок 35 оценки положения транспортного средства корректирует данные о положении ориентира в пределах допустимых диапазонов, блок 33 хранения положения ориентира оставляет сохраненные данные о положении ориентира, то есть данные о положении ориентира до корректировки.
[0032] Далее будет описан процесс оценки положения транспортного средства, который выполняется контроллером 16 в каждом заданном интервале времени (например, 10 мс).
Фиг. 14 представляет собой блок-схему, иллюстрирующую процесс оценки положения транспортного средства.
Первый этап S101 соответствует процессу, выполняемому блоком 31 определения положения ориентира, в котором определяются положения ориентиров на периферии транспортного средства, например, бордюра 23 и линий 24 дорожной разметки, как относительные положения относительно транспортного средства в системе координат транспортного средства, зафиксированной относительно транспортного средства. Другими словами, в системе координат транспортного средства определяются точки Pc обнаружения бордюра 23, обнаруженные радиолокационными устройствами 12, и точки Pw обнаружения линий 24 дорожной разметки, обнаруженные камерами 13.
[0033] Следующий этап S102 соответствует процессу, выполняемому блоком 32 определения величины перемещения, в котором определяются одометрии, каждая из которых представляет собой величину перемещения транспортного средства 21 в единицу времени, на основе различных типов информации, обнаруженной группой 15 датчиков. Объединение одометрий позволяет вычислять траекторию движения транспортного средства в системе координат одометрии. Другими словами, три параметра транспортного средства, а именно координатные положения [XODM, YODM] и угловое пространственное положение кузова транспортного средства [θODM], сохраняются в системе координат одометрии в каждом рабочем цикле.
Следующий этап S103 соответствует процессу, выполняемому блоком 33 хранения положения ориентира, в котором траектория движения на основе величин перемещений, определенных блоком 32 определения величины перемещения, и положения ориентиров, определенные блоком 31 определения положения ориентира, сохраняются в связи друг с другом в системе координат одометрии. Другими словами, данные о положении ориентира, обнаруженные в соответствующие моменты времени, перемещаются на величины перемещений транспортного средства в течение прошедших моментов времени от соответствующих моментов времени до настоящего момента времени, и соответствующие координатным положениям и угловым пространственным положениям кузова транспортного средства в соответствующие моменты времени, соответствующие данные о положении бордюра 23, линий 24 дорожной разметки и т.п. проецируются на систему координат одометрии и сохраняются.
[0034] Следующий этап S104 соответствует процессу, выполняемому блоком 34 установки диапазона корректировки, в котором части данных о положении ориентира, сохраненные в блоке 33 хранения положения ориентира, группируются в группы в соответствии с состояниями поворота транспортного средства, и на основе величин перемещений транспортного средства при определении данных о положении ориентира устанавливаются диапазоны корректировки для групп. Сначала определяется точка Pt поворота транспортного средства на основе траектории движения, и данные о положении ориентира в точках в или поле точки Pt поворота группируются в первую группу Gr1. В дополнение, данные о положении ориентира в точках перед точкой Pt поворота группируются во вторую группу Gr2. Затем устанавливаются допустимый диапазон α и допустимые диапазоны β1 и β2 в корректировке по положению и корректировке по углу сгруппированных данных о положении ориентира соответственно в соответствии с картографической информацией.
[0035] Следующий этап S105 соответствует процессу, выполняемому блоком 35 оценки положения транспортного средства, в котором путем сопоставления сохраненных данных о положении ориентира с соответствующими положениями ориентиров в картографической информации на основе диапазонов корректировки оценивается положение транспортного средства 21 в системе координат карты. Сначала при сопоставлении данных о положении ориентира с соответствующими положениями ориентиров в картографической информации вычисляется расположение соответствующих групп, которое минимизирует ошибку сопоставления, в то время как данные о положении ориентира перемещаются в пределах диапазонов корректировки с точкой Pt поворота в качестве опорной точки, а затем оценивается положение транспортного средства 21 в системе координат карты. Другими словами, в системе координат карты оцениваются три параметра, а именно координатные положения [XMAP, YMAP] и угловое пространственное положение [θMAP] кузова транспортного средства.
[0036] Следующий этап S106 соответствует процессу, выполняемому блоком 33 хранения положения ориентира, в котором данные о положении ориентира обновляются соответствующим образом, а затем процесс возвращается к заданной основной программе. Другими словами, при корректировке блоком 35 оценки положения транспортного средства данных о положении ориентира в пределах допустимых диапазонов оценивается степень соответствия при сопоставлении. Когда степень соответствия является высокой, сохраненные данные о положении ориентира корректируются (обновляются) в соответствии с данными о положении ориентира после корректировки. С другой стороны, когда степень соответствия является низкой, остаются ранее сохраненные данные о положении ориентира без корректировки (обновления) данных о положении ориентира, то есть данные о положении ориентира до корректировки.
Выше описан процесс оценки положения транспортного средства.
[0037] Функционирование
Путем сопоставления положений ориентиров, например, бордюра 23, обнаруженного радиолокационными устройствами 12, и линий 24 дорожной разметки, обнаруженных камерами 13, с положениями соответствующих ориентиров, заранее закодированными в данные в качестве картографической информации, оценивается положение транспортного средства 21. Настоящий вариант осуществления иллюстрирует способ, в котором картографическая информация создается только с использованием ориентиров, например, бордюра 23 и линий 24 дорожной разметки, обнаружение которых проще по сравнению с другими ориентирами, и которые могут быть описаны в виде двумерных данных, если смотреть в плане, и оценка положения транспортного средства выполняется с использованием картографической информации. Отметим, что, когда должна быть получена более высокая точность оценки положений транспортного средства, может быть использована картографическая информация, содержащая трехмерные (длина, ширина и высота) данные о конструкциях. В этом случае также может быть применен настоящий вариант осуществления.
[0038] Сохранение определенной величины предыдущей траектории движения в системе координат одометрии путем использования информации о перемещении транспортного средства 21 и сопоставление системы координат одометрии, на которую проецируются данные о положении ориентира, с системой координат карты, в которой заранее сохранены положения ориентиров, позволяют оценивать положение транспортного средства. Однако существует проблема, заключающаяся в том, что в системе координат одометрии, чем больше расстояние перемещения, и чем больше величина поворота, тем больше становится суммарная ошибка. Фиг. 12 представляет собой схематическое изображение, иллюстрирующее данные о положении ориентира до корректировки. В этой сцене при выполнении транспортным средством поворота направо величина поворота увеличивается, и возникает ошибка одометрии, что приводит к вычислению траектории движения так, как будто транспортное средство выполнило больший поворот, чем фактический поворот, и форма дороги, которую определяют данные о положении ориентира, сохраненные в соответствии с вычисленной траекторией движения, смещается относительно фактической формы дороги.
По этой причине при сопоставлении формы дороги, которую определяют данные о положении ориентира, сохраненные неизменными, с формой дороги в картографической информации степень соответствия уменьшается, и минимальная ошибка увеличивается, что делает невозможной оценку положения транспортного средства с высокой точностью. Таким образом, в системе координат одометрии положение транспортного средства оценивается путем сопоставления групп по меньшей мере частей данных о положении ориентира, в которых траектория движения и положения ориентиров сохранены в связи друг с другом, с положениями ориентиров в картографической информации при корректировке положения и угла между группами.
[0039] Далее будет описана конкретная процедура.
Сначала определяются положения ориентиров, например, бордюров 23 и линий 24 дорожной разметки, вдоль полосы движения в системе координат транспортного средства (этап S101), и путем объединения различных типов информации, обнаруженной группой 15 датчиков, определяется траектория движения транспортного средства в системе координат одометрии (этап S102). Определенная траектория движения и определенные положения ориентиров сохраняются в связи друг с другом в системе координат одометрии (этап S103).
[0040] Части сохраненных данных о положении ориентира группируются в соответствии с состояниями поворота транспортного средства, и на основе величин перемещений транспортного средства при определении данных о положении ориентира устанавливаются диапазоны корректировки для групп (этап S104). На этом этапе сначала определяется точка Pt поворота транспортного средства на основе траектории движения. Например, текущее местоположение Pn и точка Pr, полученная путем возврата из текущего местоположения Pn на заданное расстояние D1, соединяются прямой линией L1, и в диапазоне возврата из текущего местоположения Pn на заданное расстояние D1 точка, расстояние d до которой от прямой линии L1 в направлении, перпендикулярном ей, не меньше заданного значения d1, которая максимально удалена от прямой линии L1, определяется как точка Pt поворота. Альтернативно, точка, в которой при возврате из текущего местоположения Pn угол θt поворота транспортного средства впервые становится не меньше заданного угла θ1, определяется как точка Pt поворота. Как описано выше, использование расстояния d от прямой линии L1 и угла θt поворота позволяет легко определять точку Pt поворота транспортного средства.
[0041] Путем группирования данных о положении ориентира в точках в или после точки Pt поворота устанавливается первая группа Gr1, и наряду с этим путем группирования данных о положении ориентира в точках перед точкой Pt поворота устанавливается вторая группа Gr2. В дополнение, устанавливаются допустимый диапазон α и допустимые диапазоны β1 и β2 в корректировке по положению и корректировке по углу сгруппированных данных о положении ориентира соответственно для сопоставления данных о положении ориентира с картографической информацией. В ходе установки при увеличении расстояния dm перемещения в величине перемещения транспортного средства в сохраненных данных о положении ориентира допустимый диапазон α становится больше, и при увеличении величины поворота в величине перемещения транспортного средства (при уменьшении радиуса поворота) допустимые диапазоны β1 и β2 становятся больше.
[0042] Путем сопоставления сохраненных данных о положении ориентира с картографической информацией на основе диапазонов α, β1 и β2 корректировки с точкой Pt поворота в качестве опорной точки оценивается положение транспортного средства 21 в системе координат карты (этап S105). Другими словами, поскольку при перемещении данных о положении ориентира в пределах диапазонов корректировки с точкой Pt поворота в качестве опорной точки относительно картографической информации, вычисляется расположение соответствующих групп, которое минимизирует ошибку сопоставления, а затем оценивается положение транспортного средства 21, влияние суммарной ошибки в информации одометрии может быть предотвращено, и точность оценки положения транспортного средства может быть улучшена. Другими словами, поскольку вышеописанный процесс эквивалентен сопоставлению данных о положении ориентира с картографической информацией с точкой Pt поворота в качестве опорной точки с тремя степенями свободы, а именно положениями [xg, yg] и углом Φg сгруппированных данных о положении ориентира, точность оценки координатных положений [XMAP, YMAP] и угловых пространственных положений [θMAP] кузова транспортного средства может быть улучшена.
[0043] Поскольку, в частности, во время поворота, происходит боковое скольжение транспортного средства, вероятно появление ошибки в информации одометрии. В связи с этим обнаружение точки Pt поворота, группирование данных о положении ориентира в группы в точках в и после точки Pt поворота и перед точкой Pt поворота и корректировка положения и корректировка угла каждой группы с точкой Pt поворота в качестве опорной точки, как описано выше, позволяют эффективно исключать ошибку в информации одометрии. С другой стороны, поскольку корректировка данных о положении ориентира выполняется в пределах допустимых диапазонов α, β1 и β2 с точкой Pt поворота в качестве опорной точки, может быть предотвращено чрезмерное перемещение, и корректировка может быть выполнена в пределах надлежащего диапазона. Поскольку при увеличении расстояния dm перемещения ошибка в информации одометрии становится больше, установка допустимого диапазона α в соответствии с расстоянием dm перемещения и установка допустимых диапазонов β1 и β2 в соответствии с величиной поворота в величине перемещения транспортного средства позволяет устанавливать надлежащие допустимые диапазоны α, β1 и β2 и выполнять эффективную корректировку положения и корректировку угла.
[0044] При сопоставлении групп сгруппированных данных о положении ориентира с картографической информацией при корректировке положения и угла между группами прямые линии L23 и прямые линии L24 получаются на основе точек Pc обнаружения бордюров 23 и точек Pw обнаружения линий 24 дорожной разметки в группах соответственно, а затем с использованием этих прямых линий L23 и L24 данные о положении ориентира сопоставляются с картографической информацией.
Фиг. 15A и 15B представляют собой схематические изображения, иллюстрирующие результат получения прямой линии.
Фиг. 15A иллюстрирует случай, в котором точки Pc обнаружения бордюров 23, обозначенные заштрихованными ромбами, сопоставляются с картографической информацией, как есть, без получения прямой линии. Точка Pc обнаружения в области A, которая должна сопоставляться с линией, представляющей бордюр 23x, сопоставляется с линией, представляющей бордюр 23y, которая расположена наиболее близко к точке Pc обнаружения. Фиг. 15B иллюстрирует случай, в котором получение прямой линии L23 позволяет сопоставлять точку Pc обнаружения с линией, представляющей бордюр 23x. Как описано выше, получение прямых линий и сопоставление данных о положении ориентира с картографической информацией путем использования прямых линий позволяет повышать точность оценки положения транспортного средства.
[0045] Если степень соответствия при сопоставлении является высокой, когда данные о положении ориентира корректируются в пределах допустимых диапазонов, сохраненные данные о положении ориентира корректируются (обновляются) в соответствии с данными о положении ориентира после корректировки (этап S106). Корректировка позволяет сохранять данные о положении ориентиров с высокой точностью. Наоборот, когда степень соответствия является низкой, остаются сохраненные данные о положении ориентира, то есть данные о положении ориентира до корректировки. Эта операция позволяет предотвращать возникновение ситуации, в которой сохраняются данные о положении ориентира с низкой точностью.
[0046] Вариант
Хотя в первом варианте осуществления данные о положении ориентира в точках в или после точки Pt поворота группируются в одну группу данных, и наряду с этим данные о положении ориентира в точках перед точкой Pt поворота группируются в другую группу данных, и корректируется соответствующая группа данных о положении ориентира, настоящее изобретение не ограничивается этой конфигурацией. Другими словами, если в момент времени до прохождения точки Pt поворота данные о положении ориентира в точках перед точкой Pt поворота уже скорректированы путем сопоставления с картографической информацией, нет необходимости дополнительного выполнения корректировки путем сопоставления с картографической информацией после прохождения точки Pt поворота. В связи с этим по меньшей мере данные о положении ориентира в точках в или после точки Pt поворота могут быть сгруппированы в группу, и при корректировке положения и угла группы с точкой Pt поворота в качестве опорной точки группа может сопоставляться с картографической информацией. Другими словами, вторая группа Gr2, которая представляет собой группу данных о положении ориентира в точках перед точкой Pt поворота, зафиксирована, и только первая группа Gr1, которая представляет собой группу данных о положении ориентира в точках в или после точки Pt поворота, может корректироваться. Эта конфигурация позволяет предотвращать рабочую нагрузку и более эффективно выполнять сопоставление.
[0047] Пример применения
Хотя в первом варианте осуществления допустимые диапазоны β1 и β2 в корректировке угла устанавливаются в соответствии с величиной поворота в величине перемещения транспортного средства, настоящее изобретение не ограничивается этой конфигурацией. Поскольку при возникновении изменения скорости транспортного средства вероятно появление ошибки в информации одометрии из-за характеристик датчиков, и при увеличении расстояния перемещения ошибка дополнительно увеличивается, допустимые диапазоны β1 и β2 в корректировке угла могут быть установлены в соответствии с расстоянием dm перемещения транспортного средства.
Фиг. 16 представляет собой график, используемый для установки допустимых диапазонов β1 и β2 в соответствии с расстоянием dm перемещения.
Абсцисса и ордината графика представляют расстояние dm перемещения в величине перемещения транспортного средства в данных о положении ориентира и допустимые диапазоны β1 и β2 в корректировке угла соответственно. Что касается расстояния dm перемещения, значение dm1, которое больше 0, и значение dm2, которое больше dm1, определены заранее. Что касается допустимых диапазонов β1 и β2, значение βMIN, которое больше 0, и значение βMAX, которое больше βMIN, определены заранее. Когда расстояние dm перемещения находится в диапазоне от dm1 до dm2, чем больше расстояние dm перемещения, тем больше становится допустимый диапазон β в пределах диапазона от βMIN до βMAX. В дополнение, когда расстояние dm перемещение не меньше dm2, допустимые диапазоны β1 и β2 сохраняются на βMAX.
Установка допустимых диапазонов β1 и β2 в корректировке угла в соответствии с расстоянием dm перемещения, как описано выше, позволяет устанавливать надлежащие допустимые диапазоны β1 и β2 и выполнять эффективную корректировку угла.
Отметим, что допустимые диапазоны β1 и β2 могут быть установлены с учетом как величины поворота, так и расстояния dm перемещения в величине перемещения транспортного средства в данных о положении ориентира. В дополнение, ускорение/замедление также может учитываться в качестве величины перемещения транспортного средства.
[0048] Взаимосвязи соответствия
В первом варианте осуществления блок 31 определения положения ориентира и процесс на этапе S101 соответствуют «блоку определения положения ориентира». Блок 32 определения величины перемещения и процесс на этапе S102 соответствуют «блоку определения траектории движения». Блок 33 хранения положения ориентира и процесс на этапах S103 и S106 соответствуют «блоку хранения данных о положении ориентира». Картографическая база 14 данных соответствует «блоку хранения картографической информации». Блок 34 установки диапазона корректировки и процесс на этапе S104 соответствуют «блоку корректировки данных о положении ориентира». Блок 35 оценки положения транспортного средства и процесс на этапе S105 соответствуют «блоку оценки положения транспортного средства».
[0049] Полезные эффекты
Далее будут описаны полезные эффекты изобретения, достигаемые основной частью первого варианта осуществления.
(1) Устройство оценки положения транспортного средства в соответствии с первым вариантом осуществления определяет положения ориентира на периферии транспортного средства и наряду с этим определяет величины перемещений транспортного средства и сохраняет положения ориентира в качестве данных о положении ориентира на основе величин перемещений. В дополнение, устройство оценки положения транспортного средства группирует часть данных о положении ориентира в группу в соответствии с состояниями поворота транспортного средства и на основе величин перемещений транспортного средства при определении данных о положении ориентира устанавливает диапазон корректировки для группы. Кроме того, устройство оценки положения транспортного средства получает картографическую информацию, включающую в себя положения ориентира, и путем сопоставления данных о положении ориентира с положениями ориентира в картографической информации на основе установленного диапазона корректировки оценивает положение транспортного средства.
Поскольку, как описано выше, положение транспортного средства оценивается путем сопоставления данных о положении ориентира с картографической информацией при корректировке данных о положении ориентира в пределах диапазона корректировки, точность оценки положения транспортного средства может быть улучшена.
[0050] (2) Устройство оценки положения транспортного средства в соответствии с первым вариантом осуществления устанавливает диапазон корректировки в качестве диапазона положений и диапазона углов между группами.
Корректировка положения и угла между группами, как описано выше, позволяет предотвращать влияние ошибки в информации одометрии.
[0051] (3) Устройство оценки положения транспортного средства в соответствии с первым вариантом осуществления при увеличении величины перемещения транспортного средства в сохраненных данных о положении ориентира увеличивает допустимые диапазоны α, β1 и β2.
Корректировка допустимых диапазонов α, β1 и β2 в соответствии с величиной перемещения (радиусом R поворота и расстоянием dm перемещения) транспортного средства, как описано выше, позволяет устанавливать надлежащие допустимые диапазоны и выполнять эффективную корректировку положения и корректировку угла.
[0052] (4) Устройство оценки положения транспортного средства в соответствии с первым вариантом осуществления определяет точку Pt поворота транспортного средства из траектории движения на основе величин перемещений транспортного средства и на основе точки Pt поворота группирует данные о положении ориентира.
Определение точки Pt поворота и группирование данных о положении ориентира на основе точки Pt поворота, как описано выше, позволяет эффективно исключать ошибку в информации одометрии с точкой Pt поворота в качестве опорной точки.
[0053] (5) Устройство оценки положения транспортного средства в соответствии с первым вариантом осуществления при сопоставлении данных о положении ориентира с положениями ориентира в картографической информации корректирует (обновляет) данные о положении ориентира на основе результата сопоставления.
Поскольку, как описано выше, необходимость корректировки данных о положении ориентира определяется на основе результата сопоставления, могут быть сохранены данные о положении ориентира с высокой точностью.
[0054] (6) Устройство оценки положения транспортного средства в соответствии с первым вариантом осуществления получает прямые линии на основе данных о положении ориентира и сопоставляет полученные прямые линии с положениями ориентира в картографической информации.
Обнаружение прямых линий и сопоставление полученных прямых линий с картографической информацией, как описано выше, позволяют повышать точность сопоставления.
[0055] (7) Способ оценки положения транспортного средства в соответствии с первым вариантом осуществления содержит этапы, на которых определяют положения ориентиров на периферии транспортного средства и наряду с этим определяют величины перемещений транспортного средства и сохраняют положения ориентиров в качестве данных о положении ориентира на основе величин перемещений. В дополнение, способ оценки положения транспортного средства содержит этапы, на которых группируют часть данных о положении ориентира в группу в соответствии с состояниями поворота транспортного средства и на основе величин перемещений транспортного средства при определении данных о положении ориентира устанавливают диапазон корректировки для группы. Кроме того, устройство оценки положения транспортного средства получает картографическую информацию, включающую в себя положения ориентира, и путем сопоставления данных о положении ориентира с положениями ориентира в картографической информации на основе установленного диапазона корректировки оценивает положение транспортного средства.
Поскольку, как описано выше, положение транспортного средства оценивается путем сопоставления данных о положении ориентира с картографической информацией при корректировке данных о положении ориентира в пределах диапазона корректировки, точность оценки положения транспортного средства может быть улучшена.
[0056] Хотя настоящее изобретение описано со ссылкой на ограниченное количество вариантов осуществления, объем охраны настоящего изобретения не ограничивается этим, и модификации соответствующих вариантов осуществления на основе вышеприведенного описания очевидны специалисту в области техники.
Список ссылочных позиций
[0057]
11 Устройство оценки положения транспортного средства
12 Радиолокационное устройство
13 Камера
14 Картографическая база данных
15 Группа датчиков
16 Контроллер
21 Транспортное средство
22 Дорожная поверхность
23 Бордюр
24 Линия дорожной разметки
31 Блок определения положения ориентира
32 Блок определения величины перемещения
33 Блок хранения положения ориентира
34 Блок установки диапазона корректировки
35 Блок оценки положения транспортного средства.
Claims (27)
1. Устройство оценки положения транспортного средства, содержащее:
блок определения положения ориентира, выполненный с возможностью определения положения ориентира на периферии транспортного средства;
блок определения величины перемещения, выполненный с возможностью определения величины перемещения транспортного средства;
блок хранения положения ориентира, выполненный с возможностью хранения положения ориентира, определенного блоком определения положения ориентира, в качестве данных о положении ориентира на основе величин перемещений, определенных блоком определения величины перемещения;
блок получения картографической информации, выполненный с возможностью получения картографической информации, включающей в себя положения ориентира;
блок установки диапазона корректировки, выполненный с возможностью группирования части данных о положении ориентира, сохраненных в блоке хранения положения ориентира, в группу в соответствии с состояниями поворота транспортного средства и на основе величин перемещения транспортного средства при определении данных о положении ориентира установки диапазона корректировки для группы; и
блок оценки положения транспортного средства, выполненный с возможностью путем сопоставления данных о положении ориентира, сохраненных в блоке хранения положения ориентира, с положением ориентира в картографической информации, полученной блоком получения картографической информации, на основе диапазона корректировки, установленного блоком установки диапазона корректировки, оценки положения транспортного средства.
2. Устройство оценки положения транспортного средства по п. 1, в котором
блок установки диапазона корректировки устанавливает диапазон корректировки в качестве диапазона положений и диапазона углов между группами.
3. Устройство оценки положения транспортного средства по п. 1 или 2, в котором
блок установки диапазона корректировки при увеличении величины перемещения транспортного средства в данных о положении ориентира, сохраненных в блоке хранения положения ориентира, увеличивает диапазон корректировки.
4. Устройство оценки положения транспортного средства по п. 1 или 2, в котором
блок установки диапазона корректировки
определяет точку поворота транспортного средства из траектории движения на основе величин перемещения транспортного средства и на основе точки поворота группирует данные о положении ориентира.
5. Устройство оценки положения транспортного средства по п. 1 или 2, в котором
блок хранения положения ориентира
при сопоставлении данных о положении ориентира с положением ориентира в картографической информации блоком оценки положения транспортного средства корректирует данные о положении ориентира на основе результата сопоставления.
6. Устройство оценки положения транспортного средства по п. 1 или 2, в котором
блок оценки положения транспортного средства
получает прямую линию на основе данных о положении ориентира и сопоставляет полученную прямую линию с положениями ориентира в картографической информации.
7. Способ оценки положения транспортного средства, содержащий этапы, на которых:
определяют положение ориентира на периферии транспортного средства посредством блока определения положения ориентира;
определяют величину перемещения транспортного средства посредством блока определения величины перемещения;
сохраняют положения ориентира, определенные блоком определения положения ориентира, в качестве данных о положении ориентира на основе величин перемещений, определенных блоком определения величины перемещения, посредством блока хранения положения ориентира;
получают картографическую информацию, включающую в себя положения ориентира, посредством блока получения картографической информации;
группируют часть данных о положении ориентира, сохраненных в блоке хранения положения ориентира, в группу в соответствии с состояниями поворота транспортного средства и на основе величин перемещения транспортного средства при определении данных о положении ориентира устанавливают диапазон корректировки для группы посредством блока установки диапазона корректировки; и
оценивают положение транспортного средства путем сопоставления данных о положении ориентира, сохраненных в блоке хранения положения ориентира, с положениями ориентира в картографической информации, полученной блоком получения картографической информации, на основе диапазона корректировки, установленного блоком установки диапазона корректировки, посредством блока оценки положения транспортного средства.
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2015/004383 WO2017037753A1 (ja) | 2015-08-28 | 2015-08-28 | 車両位置推定装置、車両位置推定方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
RU2678960C1 true RU2678960C1 (ru) | 2019-02-04 |
Family
ID=58187180
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2018110810A RU2678960C1 (ru) | 2015-08-28 | 2015-08-28 | Устройство оценки положения транспортного средства, способ оценки положения транспортного средства |
Country Status (10)
Country | Link |
---|---|
US (1) | US10508923B2 (ru) |
EP (1) | EP3343174B1 (ru) |
JP (1) | JP6414337B2 (ru) |
KR (1) | KR101927038B1 (ru) |
CN (1) | CN107923758B (ru) |
BR (1) | BR112018004048B1 (ru) |
CA (1) | CA2997046C (ru) |
MX (1) | MX364577B (ru) |
RU (1) | RU2678960C1 (ru) |
WO (1) | WO2017037753A1 (ru) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20190031544A (ko) * | 2016-07-26 | 2019-03-26 | 닛산 지도우샤 가부시키가이샤 | 자기 위치 추정 방법 및 자기 위치 추정 장치 |
JP7034741B2 (ja) * | 2018-01-26 | 2022-03-14 | アルパイン株式会社 | 情報処理装置、自車位置算出システム及び車両 |
CN108873899B (zh) * | 2018-06-27 | 2022-03-25 | 杨扬 | 吸尘机器人的避障方法 |
KR101944497B1 (ko) * | 2018-08-02 | 2019-01-31 | 블랙썬 주식회사 | 지능형 cctv를 활용한 무인주행차량의 제어시스템 및 방법 |
JP7257158B2 (ja) * | 2019-02-04 | 2023-04-13 | 日産自動車株式会社 | 周囲環境情報生成方法及び周囲環境情報生成装置 |
CN110095126B (zh) * | 2019-05-07 | 2021-03-12 | 北京百度网讯科技有限公司 | 地图匹配方法、装置、设备和介质 |
US11378403B2 (en) * | 2019-07-26 | 2022-07-05 | Honeywell International Inc. | Apparatus and method for terrain aided navigation using inertial position |
US11906309B2 (en) * | 2019-09-27 | 2024-02-20 | Here Global B.V. | Method and apparatus for providing a map matcher tolerant to wrong map features |
JP7421923B2 (ja) | 2019-12-23 | 2024-01-25 | フォルシアクラリオン・エレクトロニクス株式会社 | 位置推定装置、及び位置推定方法 |
CN114762020A (zh) * | 2020-01-17 | 2022-07-15 | 株式会社爱信 | 周边车辆位置推定***、周边车辆位置推定程序 |
JP2022086432A (ja) * | 2020-11-30 | 2022-06-09 | 株式会社Subaru | 車両の走行軌跡送信システムおよび車両の交通システム |
CN112820115B (zh) * | 2021-01-05 | 2021-11-23 | 四川铁投信息技术产业投资有限公司 | 一种行驶车辆转向状态识别方法 |
DE102021204063A1 (de) * | 2021-04-23 | 2022-10-27 | Zf Friedrichshafen Ag | Abgleich von Kartendaten und Sensordaten |
WO2023194761A1 (ja) * | 2022-04-08 | 2023-10-12 | 日産自動車株式会社 | 情報処理方法及び情報処理装置 |
JP7486556B2 (ja) | 2022-09-02 | 2024-05-17 | 本田技研工業株式会社 | 区画線認識装置 |
CN116930956B (zh) * | 2023-09-19 | 2023-11-17 | 南京隼眼电子科技有限公司 | 基于目标尺寸的目标轨迹拼接方法、装置及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6151539A (en) * | 1997-11-03 | 2000-11-21 | Volkswagen Ag | Autonomous vehicle arrangement and method for controlling an autonomous vehicle |
RU2162202C1 (ru) * | 2000-03-21 | 2001-01-20 | Ачильдиев Владимир Михайлович | Способ определения уклонов, кривизны, неровности и коэффициента сцепления дорожного покрытия и устройство для его осуществления |
US6191704B1 (en) * | 1996-12-19 | 2001-02-20 | Hitachi, Ltd, | Run environment recognizing apparatus |
US6249214B1 (en) * | 1999-07-26 | 2001-06-19 | Pioneer Corporation | Image processing apparatus, image processing method, navigation apparatus, program storage device and computer data signal embodied in carrier wave |
Family Cites Families (49)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03201110A (ja) * | 1989-12-28 | 1991-09-03 | Toyota Central Res & Dev Lab Inc | 自律走行車の位置方位検出装置 |
GB2270438B (en) * | 1992-09-08 | 1996-06-26 | Caterpillar Inc | Apparatus and method for determining the location of a vehicle |
JPH06282798A (ja) | 1993-03-30 | 1994-10-07 | Fujitsu Ten Ltd | 目標捜索装置、及びそれを利用した警報装置、自動追尾装置 |
JPH08247775A (ja) * | 1995-03-15 | 1996-09-27 | Toshiba Corp | 移動体の自己位置同定装置および自己位置同定方法 |
JP3209392B2 (ja) | 1995-07-20 | 2001-09-17 | 三菱電機株式会社 | 車両周辺検知装置 |
JP3290133B2 (ja) * | 1998-04-21 | 2002-06-10 | 株式会社ケンウッド | カーナビゲーションシステム |
JP2001331787A (ja) * | 2000-05-19 | 2001-11-30 | Toyota Central Res & Dev Lab Inc | 道路形状推定装置 |
US6581005B2 (en) * | 2000-11-30 | 2003-06-17 | Nissan Motor Co., Ltd. | Vehicle position calculation apparatus and method |
JP3690366B2 (ja) * | 2001-12-27 | 2005-08-31 | 日産自動車株式会社 | 前方物体検出装置 |
JP4506162B2 (ja) * | 2003-02-20 | 2010-07-21 | 日産自動車株式会社 | 前方物体検出装置及び前方物体検出方法 |
JP4899351B2 (ja) * | 2005-06-17 | 2012-03-21 | 株式会社デンソー | 走行状況判定装置及び車載ナビゲーション装置 |
JP4889272B2 (ja) * | 2005-09-30 | 2012-03-07 | アルパイン株式会社 | ナビゲーション装置及び車両位置推定方法 |
JP5388082B2 (ja) * | 2006-09-07 | 2014-01-15 | 株式会社豊田中央研究所 | 静止物地図生成装置 |
JP4869858B2 (ja) * | 2006-10-05 | 2012-02-08 | クラリオン株式会社 | 車両の走行制御システム |
JP2008241446A (ja) | 2007-03-27 | 2008-10-09 | Clarion Co Ltd | ナビゲーション装置及びその制御方法 |
JP2008250906A (ja) | 2007-03-30 | 2008-10-16 | Sogo Keibi Hosho Co Ltd | 移動ロボット、自己位置補正方法および自己位置補正プログラム |
JP5064870B2 (ja) * | 2007-04-17 | 2012-10-31 | 株式会社日立製作所 | デジタル道路地図の生成方法及び地図生成システム |
KR20090001721A (ko) * | 2007-05-14 | 2009-01-09 | 팅크웨어(주) | 맵 매칭 보정 방법 및 상기 방법을 수행하는 내비게이션시스템 |
TW200900655A (en) | 2007-06-21 | 2009-01-01 | Mitac Int Corp | Navigation device and method calibrated by map position-matching |
JP4416021B2 (ja) * | 2007-08-21 | 2010-02-17 | 株式会社デンソー | 車両ナビゲーション装置 |
KR101503904B1 (ko) * | 2008-07-07 | 2015-03-19 | 삼성전자 주식회사 | 이동 로봇의 지도 구성 장치 및 방법 |
US8775063B2 (en) * | 2009-01-26 | 2014-07-08 | GM Global Technology Operations LLC | System and method of lane path estimation using sensor fusion |
US8340818B2 (en) * | 2009-04-24 | 2012-12-25 | Robert Bosch Gmbh | Method of accurate mapping with mobile robots |
JP5441549B2 (ja) * | 2009-07-29 | 2014-03-12 | 日立オートモティブシステムズ株式会社 | 道路形状認識装置 |
US8301374B2 (en) * | 2009-08-25 | 2012-10-30 | Southwest Research Institute | Position estimation for ground vehicle navigation based on landmark identification/yaw rate and perception of landmarks |
JP2011191239A (ja) | 2010-03-16 | 2011-09-29 | Mazda Motor Corp | 移動***置検出装置 |
US8369606B2 (en) * | 2010-07-21 | 2013-02-05 | Palo Alto Research Center Incorporated | System and method for aligning maps using polyline matching |
KR101750340B1 (ko) * | 2010-11-03 | 2017-06-26 | 엘지전자 주식회사 | 로봇 청소기 및 이의 제어 방법 |
JP2012194860A (ja) * | 2011-03-17 | 2012-10-11 | Murata Mach Ltd | 走行車 |
US9140792B2 (en) * | 2011-06-01 | 2015-09-22 | GM Global Technology Operations LLC | System and method for sensor based environmental model construction |
JP5834933B2 (ja) * | 2012-01-17 | 2015-12-24 | 日産自動車株式会社 | 車両位置算出装置 |
JP5903901B2 (ja) * | 2012-01-17 | 2016-04-13 | 日産自動車株式会社 | 車両位置算出装置 |
JP5404861B2 (ja) * | 2012-07-17 | 2014-02-05 | 株式会社豊田中央研究所 | 静止物地図生成装置 |
JP2014093018A (ja) * | 2012-11-06 | 2014-05-19 | Honda Elesys Co Ltd | 車線認識装置、運転支援装置、車線認識方法、および、車線認識プログラム |
JP5962771B2 (ja) * | 2012-12-12 | 2016-08-03 | 日産自動車株式会社 | 移動物***置姿勢角推定装置及び移動物***置姿勢角推定方法 |
JP6233706B2 (ja) * | 2013-04-02 | 2017-11-22 | パナソニックIpマネジメント株式会社 | 自律移動装置及び自律移動装置の自己位置推定方法 |
US9043072B1 (en) * | 2013-04-04 | 2015-05-26 | Google Inc. | Methods and systems for correcting an estimated heading using a map |
US9377310B2 (en) * | 2013-05-02 | 2016-06-28 | The Johns Hopkins University | Mapping and positioning system |
JP6325806B2 (ja) * | 2013-12-06 | 2018-05-16 | 日立オートモティブシステムズ株式会社 | 車両位置推定システム |
US9395192B1 (en) * | 2013-12-20 | 2016-07-19 | Google Inc. | Methods and systems for road and lane boundary tracing |
US9081383B1 (en) * | 2014-01-22 | 2015-07-14 | Google Inc. | Enhancing basic roadway-intersection models using high intensity image data |
EP2918974B1 (en) * | 2014-03-11 | 2019-01-16 | Volvo Car Corporation | Method and system for determining a position of a vehicle |
CN106574976B (zh) * | 2014-04-09 | 2019-11-05 | 大陆-特韦斯股份有限公司 | 通过参考周围环境中的物体来进行车辆的位置校正 |
MX364590B (es) | 2015-05-28 | 2019-05-02 | Nissan Motor | Dispositivo de estimacion de posicion y metodo de estimacion de posicion. |
RU2669652C1 (ru) * | 2015-07-13 | 2018-10-12 | Ниссан Мотор Ко., Лтд. | Устройство оценки собственной позиции и способ оценки собственной позиции |
US9884623B2 (en) * | 2015-07-13 | 2018-02-06 | GM Global Technology Operations LLC | Method for image-based vehicle localization |
CA2993420C (en) | 2015-07-24 | 2018-11-20 | Nissan Motor Co., Ltd. | Self-position estimation device and self-position estimation method |
DE102015214338A1 (de) * | 2015-07-29 | 2017-02-02 | Volkswagen Aktiengesellschaft | Bestimmung einer Anordnungsinformation für ein Fahrzeug |
MX364578B (es) * | 2015-08-28 | 2019-05-02 | Nissan Motor | Dispositivo de estimacion de posicion de vehiculo, metodo de estimacion de posicion de vehiculo. |
-
2015
- 2015-08-28 JP JP2017537033A patent/JP6414337B2/ja not_active Expired - Fee Related
- 2015-08-28 CN CN201580082772.7A patent/CN107923758B/zh active Active
- 2015-08-28 CA CA2997046A patent/CA2997046C/en active Active
- 2015-08-28 US US15/755,900 patent/US10508923B2/en active Active
- 2015-08-28 RU RU2018110810A patent/RU2678960C1/ru active
- 2015-08-28 BR BR112018004048-7A patent/BR112018004048B1/pt not_active IP Right Cessation
- 2015-08-28 WO PCT/JP2015/004383 patent/WO2017037753A1/ja active Application Filing
- 2015-08-28 EP EP15902879.4A patent/EP3343174B1/en active Active
- 2015-08-28 MX MX2018002267A patent/MX364577B/es active IP Right Grant
- 2015-08-28 KR KR1020187008129A patent/KR101927038B1/ko active IP Right Grant
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6191704B1 (en) * | 1996-12-19 | 2001-02-20 | Hitachi, Ltd, | Run environment recognizing apparatus |
US6151539A (en) * | 1997-11-03 | 2000-11-21 | Volkswagen Ag | Autonomous vehicle arrangement and method for controlling an autonomous vehicle |
US6249214B1 (en) * | 1999-07-26 | 2001-06-19 | Pioneer Corporation | Image processing apparatus, image processing method, navigation apparatus, program storage device and computer data signal embodied in carrier wave |
RU2162202C1 (ru) * | 2000-03-21 | 2001-01-20 | Ачильдиев Владимир Михайлович | Способ определения уклонов, кривизны, неровности и коэффициента сцепления дорожного покрытия и устройство для его осуществления |
Also Published As
Publication number | Publication date |
---|---|
KR101927038B1 (ko) | 2018-12-07 |
US10508923B2 (en) | 2019-12-17 |
KR20180041741A (ko) | 2018-04-24 |
MX2018002267A (es) | 2018-03-23 |
CA2997046C (en) | 2018-11-13 |
CN107923758B (zh) | 2019-03-01 |
JPWO2017037753A1 (ja) | 2018-02-22 |
US20190033082A1 (en) | 2019-01-31 |
EP3343174A1 (en) | 2018-07-04 |
CN107923758A (zh) | 2018-04-17 |
BR112018004048B1 (pt) | 2022-08-30 |
EP3343174B1 (en) | 2020-04-15 |
JP6414337B2 (ja) | 2018-10-31 |
EP3343174A4 (en) | 2018-08-01 |
BR112018004048A2 (ru) | 2018-10-02 |
MX364577B (es) | 2019-05-02 |
WO2017037753A1 (ja) | 2017-03-09 |
CA2997046A1 (en) | 2017-03-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
RU2678960C1 (ru) | Устройство оценки положения транспортного средства, способ оценки положения транспортного средства | |
JP6418332B2 (ja) | 車両位置推定装置、車両位置推定方法 | |
WO2018225198A1 (ja) | 地図データ補正方法および装置 | |
KR102327901B1 (ko) | 이동하는 오브젝트 센서의 정렬을 교정하기 위한 방법 | |
WO2013133129A1 (ja) | 移動物***置姿勢推定装置及び移動物***置姿勢推定方法 | |
JP6020729B2 (ja) | 車両位置姿勢角推定装置及び車両位置姿勢角推定方法 | |
JP6171849B2 (ja) | 移動***置姿勢角推定装置及び移動***置姿勢角推定方法 | |
JP7418196B2 (ja) | 走行軌跡推定方法及び走行軌跡推定装置 | |
CN112150547B (zh) | 一种确定车***姿的方法、装置及环视视觉里程计*** | |
CA2994652A1 (en) | Step detection device and step detection method | |
JP6044084B2 (ja) | 移動物***置姿勢推定装置及び方法 | |
CN108710371B (zh) | 一种采用测距激光扫描建图的机器人室内定位方法 | |
JP2021081272A (ja) | 位置推定装置および位置推定用コンピュータプログラム | |
JP2018185156A (ja) | 物標位置推定方法及び物標位置推定装置 | |
US11867526B2 (en) | Map generation apparatus | |
US20220291013A1 (en) | Map generation apparatus and position recognition apparatus | |
JP2018059742A (ja) | 自己位置推定方法、移動体の走行制御方法、自己位置推定装置、及び移動体の走行制御装置 | |
JP2022112754A (ja) | 自律走行車 |