JPWO2018220787A1 - Map processing apparatus, map processing method, and map processing program - Google Patents

Map processing apparatus, map processing method, and map processing program Download PDF

Info

Publication number
JPWO2018220787A1
JPWO2018220787A1 JP2019521869A JP2019521869A JPWO2018220787A1 JP WO2018220787 A1 JPWO2018220787 A1 JP WO2018220787A1 JP 2019521869 A JP2019521869 A JP 2019521869A JP 2019521869 A JP2019521869 A JP 2019521869A JP WO2018220787 A1 JPWO2018220787 A1 JP WO2018220787A1
Authority
JP
Japan
Prior art keywords
map
region
interest
area
vector
Prior art date
Legal status (The legal status 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 status listed.)
Granted
Application number
JP2019521869A
Other languages
Japanese (ja)
Other versions
JP6605180B2 (en
Inventor
道学 吉田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Publication of JPWO2018220787A1 publication Critical patent/JPWO2018220787A1/en
Application granted granted Critical
Publication of JP6605180B2 publication Critical patent/JP6605180B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3863Structures of map data
    • G01C21/387Organisation of map data, e.g. version management or database structures
    • G01C21/3881Tile-based structures
    • 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/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/36Input/output arrangements for on-board computers
    • G01C21/3691Retrieval, searching and output of information related to real-time traffic, weather, or environmental conditions
    • 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/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3863Structures of map data
    • G01C21/387Organisation of map data, e.g. version management or database structures
    • G01C21/3878Hierarchical structures, e.g. layering
    • 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/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/16Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/18Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
    • GPHYSICS
    • G09EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
    • G09BEDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
    • G09B29/00Maps; Plans; Charts; Diagrams, e.g. route diagram

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Databases & Information Systems (AREA)
  • Data Mining & Analysis (AREA)
  • Mathematical Analysis (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Computational Mathematics (AREA)
  • General Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Algebra (AREA)
  • Software Systems (AREA)
  • Environmental & Geological Engineering (AREA)
  • Probability & Statistics with Applications (AREA)
  • Atmospheric Sciences (AREA)
  • Biodiversity & Conservation Biology (AREA)
  • Ecology (AREA)
  • Operations Research (AREA)
  • Environmental Sciences (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Evolutionary Biology (AREA)
  • Computing Systems (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Educational Administration (AREA)
  • Educational Technology (AREA)
  • Business, Economics & Management (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)
  • Instructional Devices (AREA)

Abstract

1次ベクトル計算部(23)は、各領域に物体が存在する存在確率を示す第1地図及び第2地図それぞれについて、対象領域についての存在確率と、対象領域と隣接した隣接領域についての存在確率との差を、対象領域についての隣接領域に対するベクトルとし、対象領域についての周囲の領域に対するベクトルの和を、対象領域の1次ベクトルとして計算する。2次ベクトル計算部(24)は、注目領域に含まれる各領域の1次ベクトルの和を、注目領域の2次ベクトルとして計算する。判定部(25)は、第1地図についての注目領域に対して計算された2次ベクトルと、第2地図ついての注目領域に対して計算された2次ベクトルとを比較して、第1地図についての注目領域と第2地図ついての注目領域とが対応するか否かを判定する。The primary vector calculation unit (23) includes, for each of the first map and the second map indicating the existence probability that an object exists in each region, the existence probability for the target region and the existence probability for the adjacent region adjacent to the target region. And the sum of the vectors for the surrounding regions of the target region is calculated as the primary vector of the target region. The secondary vector calculation unit (24) calculates the sum of the primary vectors of the respective areas included in the attention area as the secondary vector of the attention area. The determination unit (25) compares the secondary vector calculated for the attention area for the first map with the secondary vector calculated for the attention area for the second map, and determines the first map. It is determined whether or not the attention area for and the attention area for the second map correspond to each other.

Description

この発明は、各領域に物体が存在する存在確率を示す複数の地図の対応付け技術に関する。   The present invention relates to a technique for associating a plurality of maps indicating the probability of existence of an object in each region.

車両といった移動体の周辺の広い範囲の地図を得るために、移動体で取得された地図と、周辺に存在する移動体又は路側機等で取得された地図とを合成することがある。特許文献1,2には、地図を合成する方法が記載されている。   In order to obtain a map of a wide range around a moving object such as a vehicle, a map acquired by the moving object may be combined with a map acquired by a moving object or a roadside device existing in the vicinity. Patent Documents 1 and 2 describe a method of synthesizing a map.

特許文献1では、各地図について、各グリッドが占有グリッドと非占有グリッドと未知グリッドとのいずれかに分けられる。占有グリッドを中心とするウインドウについて占有グリッドと非占有グリッドと未知グリッドとの数を表すヒストグラムが作成される。ヒストグラムに基づき、地図間で対応する点が特定される。そして、特定された点同士が重なるように座標変換が行われる。   In Patent Document 1, for each map, each grid is divided into an occupied grid, an unoccupied grid, and an unknown grid. A histogram representing the number of occupied grids, unoccupied grids, and unknown grids is created for a window centered on the occupied grid. Based on the histogram, corresponding points between the maps are identified. Then, coordinate conversion is performed so that the specified points overlap each other.

特許文献2では、障害物セル間の距離が計算される。そして、計算された距離の合計値に関する最適化処理がされ、座標変換が行われる。   In Patent Document 2, the distance between obstacle cells is calculated. And the optimization process regarding the total value of the calculated distance is performed, and coordinate conversion is performed.

特開2005−326944号公報JP 2005-326944 A 特開2009−157430号公報JP 2009-157430 A

特許文献1に記載された方法では、ヒストグラムに基づく処理を行うため、計算処理が多く、処理時間がかかってしまう。また、特許文献2に記載された方法では、障害物が移動する場合にノイズが大きくなり、合成の精度が低くなってしまう。
この発明は、処理時間を短くしつつ、移動する物体が存在する場合にも精度よく地図間の対応する点を特定可能にすることを目的とする。
In the method described in Patent Literature 1, since processing based on a histogram is performed, there are many calculation processes and processing time is required. Further, in the method described in Patent Document 2, when an obstacle moves, noise increases and the synthesis accuracy is lowered.
An object of the present invention is to make it possible to specify corresponding points between maps with high accuracy even when a moving object exists while shortening the processing time.

この発明に係る地図処理装置は、
各領域に物体が存在する存在確率を示す第1地図及び第2地図それぞれについて、少なくとも一部の領域を対象領域として、前記対象領域についての前記存在確率と、前記対象領域と隣接した隣接領域についての前記存在確率との差を、前記対象領域についての前記隣接領域に対するベクトルとし、前記対象領域についての周囲の領域に対するベクトルの和を、前記対象領域の1次ベクトルとして計算する1次ベクトル計算部と、
前記第1地図及び前記第2地図それぞれについて、2つ以上の領域を注目領域として、前記注目領域に含まれる各領域の前記1次ベクトルの和を、前記注目領域の2次ベクトルとして計算する2次ベクトル計算部と、
前記第1地図についての前記注目領域に対して計算された前記2次ベクトルと、前記第2地図ついての前記注目領域に対して計算された前記2次ベクトルとを比較して、前記第1地図についての前記注目領域と前記第2地図ついての前記注目領域とが対応するか否かを判定する判定部と
を備える。
The map processing apparatus according to this invention is
For each of the first map and the second map indicating the existence probability that an object exists in each area, the existence probability for the target area and the adjacent area adjacent to the target area with at least a part of the area as the target area A first vector calculation unit that calculates a difference between the existence probability of the target region as a vector for the adjacent region with respect to the target region and a sum of vectors with respect to surrounding regions for the target region as a primary vector of the target region When,
For each of the first map and the second map, two or more regions are used as a region of interest, and the sum of the primary vectors of the regions included in the region of interest is calculated as a secondary vector of the region of interest 2 A next vector calculation unit;
Comparing the secondary vector calculated for the region of interest for the first map with the secondary vector calculated for the region of interest for the second map; A determination unit that determines whether or not the region of interest for and the region of interest for the second map correspond to each other.

この発明では、各領域に物体が存在する存在確率の差をベクトルとして、ベクトルを比較することにより、地図間の対応する点を特定する。これにより、処理時間を短くしつつ、移動する物体が存在する場合にも精度よく地図間の対応する点を特定することが可能である。   In the present invention, the corresponding points between the maps are specified by comparing the vectors by using the difference in the existence probability that the object exists in each region as a vector. Thereby, it is possible to specify the corresponding points between maps with high accuracy even when there is a moving object while shortening the processing time.

実施の形態1に係る地図処理装置10の構成図。1 is a configuration diagram of a map processing apparatus 10 according to Embodiment 1. FIG. 実施の形態1に係る地図処理装置10の全体的な処理のフローチャート。2 is a flowchart of overall processing of the map processing apparatus 10 according to the first embodiment. 実施の形態1に係る第1地図31及び第2地図32の説明図。Explanatory drawing of the 1st map 31 and the 2nd map 32 which concern on Embodiment 1. FIG. 実施の形態1に係る解像度変更処理の説明図。FIG. 3 is an explanatory diagram of resolution change processing according to the first embodiment. 実施の形態1に係る1次ベクトル計算処理のフローチャート。4 is a flowchart of primary vector calculation processing according to the first embodiment. 実施の形態1に係る対象領域選択処理の説明図。Explanatory drawing of the object area | region selection process which concerns on Embodiment 1. FIG. 実施の形態1に係るベクトル41の説明図。Explanatory drawing of the vector 41 which concerns on Embodiment 1. FIG. 実施の形態1に係る1次ベクトル42の説明図。Explanatory drawing of the primary vector 42 concerning Embodiment 1. FIG. 実施の形態1に係る2次ベクトル計算処理のフローチャート。4 is a flowchart of secondary vector calculation processing according to the first embodiment. 実施の形態1に係る第1注目領域38の説明図。Explanatory drawing of the 1st attention area 38 which concerns on Embodiment 1. FIG. 実施の形態1に係る2次ベクトル43の説明図。Explanatory drawing of the secondary vector 43 which concerns on Embodiment 1. FIG. 実施の形態1に係る類似領域検索処理のフローチャート。6 is a flowchart of similar region search processing according to the first embodiment. 実施の形態1に係る第2注目領域39の説明図。Explanatory drawing of the 2nd attention area | region 39 which concerns on Embodiment 1. FIG. 実施の形態1に係る第1注目領域38に近接する第1注目領域38’の説明図。Explanatory drawing of 1st attention area | region 38 'adjacent to the 1st attention area | region 38 which concerns on Embodiment 1. FIG. 実施の形態1に係る第1注目領域38に近接する第1注目領域38’の説明図。Explanatory drawing of 1st attention area | region 38 'adjacent to the 1st attention area | region 38 which concerns on Embodiment 1. FIG. 実施の形態1に係る第1注目領域38に近接する第1注目領域38’の説明図。Explanatory drawing of 1st attention area | region 38 'adjacent to the 1st attention area | region 38 which concerns on Embodiment 1. FIG. 実施の形態1に係る第1地図31を回転させる処理の説明図。Explanatory drawing of the process which rotates the 1st map 31 which concerns on Embodiment 1. FIG. 変形例3に係る地図処理装置10の構成図。The block diagram of the map processing apparatus 10 which concerns on the modification 3. FIG. 実施の形態2に係る地図処理装置10の構成図。The block diagram of the map processing apparatus 10 which concerns on Embodiment 2. FIG. 実施の形態2に係る地図処理装置10の全体的な処理のフローチャート。10 is a flowchart of overall processing of the map processing apparatus 10 according to the second embodiment. 実施の形態3に係る地図処理装置10の構成図。The block diagram of the map processing apparatus 10 which concerns on Embodiment 3. FIG. 実施の形態3に係る地図処理装置10の全体的な処理のフローチャート。10 is a flowchart of overall processing of the map processing apparatus 10 according to the third embodiment.

実施の形態1.
***構成の説明***
図1を参照して、実施の形態1に係る地図処理装置10の構成を説明する。
地図処理装置10は、コンピュータである。
地図処理装置10は、プロセッサ11と、メモリ12と、ストレージ13と、通信インタフェース14とのハードウェアを備える。プロセッサ11は、信号線を介して他のハードウェアと接続され、これら他のハードウェアを制御する。
Embodiment 1 FIG.
*** Explanation of configuration ***
With reference to FIG. 1, the structure of the map processing apparatus 10 which concerns on Embodiment 1 is demonstrated.
The map processing device 10 is a computer.
The map processing apparatus 10 includes hardware including a processor 11, a memory 12, a storage 13, and a communication interface 14. The processor 11 is connected to other hardware via a signal line, and controls these other hardware.

プロセッサ11は、プロセッシングを行うIC(Integrated Circuit)である。プロセッサ11は、具体例としては、CPU(Central Processing Unit)、DSP(Digital Signal Processor)、GPU(Graphics Processing Unit)である。   The processor 11 is an IC (Integrated Circuit) that performs processing. The processor 11 is a CPU (Central Processing Unit), a DSP (Digital Signal Processor), or a GPU (Graphics Processing Unit) as specific examples.

メモリ12は、データを一時的に記憶する記憶装置である。メモリ12は、具体例としては、SRAM(Static Random Access Memory)、DRAM(Dynamic Random Access Memory)である。   The memory 12 is a storage device that temporarily stores data. As a specific example, the memory 12 is an SRAM (Static Random Access Memory) or a DRAM (Dynamic Random Access Memory).

ストレージ13は、データを保管する記憶装置である。ストレージ13は、具体例としては、HDD(Hard Disk Drive)である。また、ストレージ13は、SD(登録商標,Secure Digital)メモリカード、CF(CompactFlash)、NANDフラッシュ、フレキシブルディスク、光ディスク、コンパクトディスク、ブルーレイ(登録商標)ディスク、DVD(Digital Versatile Disk)といった可搬記憶媒体であってもよい。   The storage 13 is a storage device that stores data. The storage 13 is an HDD (Hard Disk Drive) as a specific example. The storage 13 is a portable storage such as an SD (Registered Trademark, Secure Digital) memory card, CF (CompactFlash), NAND flash, flexible disk, optical disk, compact disk, Blu-ray (registered trademark) disk, or DVD (Digital Versatile Disk). It may be a medium.

通信インタフェース14は、外部の装置と通信するためのインタフェースである。通信インタフェース14は、具体例としては、Ethernet(登録商標)、USB(Universal Serial Bus)、HDMI(登録商標,High−Definition Multimedia Interface)のポートである。   The communication interface 14 is an interface for communicating with an external device. As a specific example, the communication interface 14 is a port of Ethernet (registered trademark), USB (Universal Serial Bus), or HDMI (registered trademark, High-Definition Multimedia Interface).

地図処理装置10は、機能構成要素として、取得部21と、解像度変更部22と、1次ベクトル計算部23と、2次ベクトル計算部24と、判定部25とを備える。地図処理装置10の各機能構成要素の機能はソフトウェアにより実現される。
ストレージ13には、地図処理装置10の各機能構成要素の機能を実現するプログラムが記憶されている。このプログラムは、プロセッサ11によりメモリ12に読み込まれ、プロセッサ11によって実行される。これにより、地図処理装置10の各機能構成要素の機能が実現される。
The map processing apparatus 10 includes an acquisition unit 21, a resolution change unit 22, a primary vector calculation unit 23, a secondary vector calculation unit 24, and a determination unit 25 as functional components. The function of each functional component of the map processing apparatus 10 is realized by software.
The storage 13 stores a program that realizes the function of each functional component of the map processing device 10. This program is read into the memory 12 by the processor 11 and executed by the processor 11. Thereby, the function of each function component of the map processing apparatus 10 is implement | achieved.

図1では、プロセッサ11は、1つだけ示されている。しかし、地図処理装置10は、プロセッサ11を代替する複数のプロセッサを備えていてもよい。これら複数のプロセッサは、地図処理装置10の各機能構成要素の機能を実現するプログラムの実行を分担する。それぞれのプロセッサは、プロセッサ11と同じように、プロセッシングを行うICである。   In FIG. 1, only one processor 11 is shown. However, the map processing apparatus 10 may include a plurality of processors that replace the processor 11. The plurality of processors share the execution of a program that realizes the function of each functional component of the map processing device 10. Each processor is an IC that performs processing in the same manner as the processor 11.

***動作の説明***
図2から図17を参照して、実施の形態1に係る地図処理装置10の動作を説明する。
実施の形態1に係る地図処理装置10の動作は、実施の形態1に係る地図処理方法に相当する。また、実施の形態1に係る地図処理装置10の動作は、実施の形態1に係る地図処理プログラムの処理に相当する。
*** Explanation of operation ***
The operation of the map processing apparatus 10 according to the first embodiment will be described with reference to FIGS.
The operation of the map processing apparatus 10 according to the first embodiment corresponds to the map processing method according to the first embodiment. The operation of the map processing apparatus 10 according to the first embodiment corresponds to the processing of the map processing program according to the first embodiment.

図2を参照して、実施の形態1に係る地図処理装置10の全体的な処理を説明する。
(ステップS10:取得処理)
取得部21は、合成する対象の地図として、第1地図31と第2地図32とを取得する。
具体的には、取得部21は、通信インタフェース14を介して、外部の装置から第1地図31と第2地図32とを取得する。あるいは、取得部21は、事前にメモリ12又はストレージ13に記憶された第1地図31と第2地図32とを取得する。
With reference to FIG. 2, the overall processing of the map processing apparatus 10 according to the first embodiment will be described.
(Step S10: Acquisition process)
The acquisition unit 21 acquires the first map 31 and the second map 32 as the maps to be combined.
Specifically, the acquisition unit 21 acquires the first map 31 and the second map 32 from an external device via the communication interface 14. Alternatively, the acquisition unit 21 acquires the first map 31 and the second map 32 stored in the memory 12 or the storage 13 in advance.

図3を参照して、実施の形態1に係る第1地図31及び第2地図32を説明する。
第1地図31及び第2地図32は、各領域33に物体が存在する存在確率を示す地図である。
実施の形態1では、図3に示すように、第1地図31及び第2地図32は、地図範囲内が格子状に複数の領域33に分割され、各領域33に物体が存在する存在確率が示された占有格子地図である。実施の形態1では、各領域の存在確率は、物体が存在することを示す“1”(占有)と、物体が存在しないことを示す“0”(空き)と、物体が存在するか否か未知であることを示す“0.5”(不明)とのいずれかである。図3では、存在確率“1”の領域が菱形のハッチングで示され、存在確率“0”の領域が白で示され、存在確率“0.5”の領域が斜線のハッチングで示されている。
With reference to FIG. 3, the 1st map 31 and the 2nd map 32 which concern on Embodiment 1 are demonstrated.
The first map 31 and the second map 32 are maps showing the existence probability that an object exists in each area 33.
In the first embodiment, as shown in FIG. 3, the first map 31 and the second map 32 are divided into a plurality of regions 33 in a lattice area within the map range, and the existence probability that an object exists in each region 33 is high. It is the occupancy grid map shown. In the first embodiment, the existence probability of each area is “1” (occupation) indicating that an object exists, “0” (vacant) indicating that no object exists, and whether or not an object exists. It is either “0.5” (unknown) indicating unknown. In FIG. 3, the region having the existence probability “1” is indicated by rhombus hatching, the region having the existence probability “0” is indicated by white, and the region having the existence probability “0.5” is indicated by hatching. .

第1地図31は、例えば、車両といった移動体によって生成された地図である。また、第2地図32は、例えば、第1地図31を生成した移動体とは異なる他の移動体等である周辺体によって生成された地図である。
具体的には、移動体が、ステレオカメラ又はレーザセンサといったセンサにより移動体周囲の点群データを取得する。そして、移動体が、取得された点群データから移動体周囲を格子に区切った各領域33に物体が存在する存在確率を計算する。この処理を、移動体が移動しながら繰り返し行うことにより、第1地図31が生成される。同様に、点群データを取得し、各位置に物体が存在する存在確率を計算するという処理を、周辺体が移動しながら繰り返し行うことにより、第2地図32が生成される。
The first map 31 is a map generated by a moving body such as a vehicle, for example. Moreover, the 2nd map 32 is a map produced | generated by the peripheral body which is another mobile body etc. which are different from the mobile body which produced | generated the 1st map 31, for example.
Specifically, the moving body acquires point cloud data around the moving body using a sensor such as a stereo camera or a laser sensor. Then, the moving object calculates the existence probability that the object exists in each region 33 obtained by dividing the periphery of the moving object into a lattice from the acquired point cloud data. The first map 31 is generated by repeating this process while the moving body is moving. Similarly, the second map 32 is generated by repeatedly performing the process of acquiring the point cloud data and calculating the existence probability that the object exists at each position while the peripheral body moves.

実施の形態1では、第1地図31及び第2地図32の各領域33は、位置が特定されているとする。上述したように、第1地図31及び第2地図32が移動体によって生成される場合、移動体に搭載された測位装置により特定された移動体の位置と、センサの情報とから、第1地図31及び第2地図32の各領域33の位置が特定される。第1地図31及び第2地図32は、各領域33の位置がグローバル座標系で表されているものとする。   In Embodiment 1, it is assumed that the positions of the regions 33 of the first map 31 and the second map 32 are specified. As described above, when the first map 31 and the second map 32 are generated by the moving body, the first map is determined based on the position of the moving body specified by the positioning device mounted on the moving body and the sensor information. The position of each area | region 33 of 31 and the 2nd map 32 is pinpointed. In the first map 31 and the second map 32, the position of each region 33 is represented in the global coordinate system.

(ステップS20:解像度変更処理)
解像度変更部22は、第1地図31及び第2地図32について、複数の領域を1つの領域にすることにより、第1地図31及び第2地図32を低解像度化する。
(Step S20: Resolution changing process)
The resolution changing unit 22 reduces the resolution of the first map 31 and the second map 32 by making a plurality of areas into one area for the first map 31 and the second map 32.

図4を参照して具体的に説明する。図4には、第1地図31が低解像度化される例が示されている。第2地図32についても同じ方法により低解像度化される。
解像度変更部22は、第1地図31及び第2地図32の各領域33を、基準位置から指定倍率範囲毎に新たな領域34に分ける。図4では、縦2つ横2つの合計4つの領域33が1つの新たな領域34とされている。解像度変更部22は、各新たな領域34について次のように存在確率を決定する。(1)解像度変更部22は、1つでも存在確率が“1”の領域33がある場合には、存在確率を“1”に決定する。(2)解像度変更部22は、全ての領域33が存在確率が“0”の場合には、存在確率を“0”に決定する。(3)解像度変更部22は、1つでも存在確率が“0.5”の領域33がある場合には、存在確率を“0.5”に決定する。
This will be specifically described with reference to FIG. FIG. 4 shows an example in which the resolution of the first map 31 is reduced. The second map 32 is also reduced in resolution by the same method.
The resolution changing unit 22 divides each area 33 of the first map 31 and the second map 32 into new areas 34 for each designated magnification range from the reference position. In FIG. 4, a total of four regions 33, two vertically and two horizontally, are defined as one new region 34. The resolution changing unit 22 determines the existence probability for each new area 34 as follows. (1) The resolution changing unit 22 determines the existence probability to be “1” when there is at least one region 33 having the existence probability “1”. (2) The resolution changing unit 22 determines the existence probability to be “0” when the existence probability of all the regions 33 is “0”. (3) The resolution changing unit 22 determines the existence probability to be “0.5” when there is at least one region 33 having the existence probability of “0.5”.

(ステップS30:1次ベクトル計算処理)
1次ベクトル計算部23は、ステップS20で低解像度化された第1地図31について、1次ベクトル42を計算する。
(Step S30: primary vector calculation process)
The primary vector calculation unit 23 calculates a primary vector 42 for the first map 31 whose resolution has been reduced in step S20.

図5を参照して、実施の形態1に係る1次ベクトル計算処理を説明する。
(ステップS301:判定領域選択処理)
図6に示すように、1次ベクトル計算部23は、ステップS20で低解像度化された第1地図31のうち、少なくとも一部の領域34を判定領域35として選択する。
第1地図31と第2地図32との各領域33の位置が特定されている。そのため、各領域34の位置も特定されている。したがって、1次ベクトル計算部23は、第1地図31のどの部分と第2地図32のどの部分とが重なっているかを、領域34の位置から概ね特定することが可能である。そこで、1次ベクトル計算部23は、第2地図32と重なっている可能性の高い第1地図31の一部の領域34を判定領域35として選択する。
ここでは、1次ベクトル計算部23は、矩形の第1地図31のある1つの辺について、外側から対象数の領域34を判定領域35として選択する。図6では、左側の辺について、外側から3個の領域34が判定領域35として選択されている。なお、最も外側の領域34は、後述する1次ベクトル42を計算することができないため、判定領域35から除外されている。対象数は、例えば、領域34の位置の精度等により決定される。
With reference to FIG. 5, the primary vector calculation process according to the first embodiment will be described.
(Step S301: Determination area selection process)
As illustrated in FIG. 6, the primary vector calculation unit 23 selects at least a part of the region 34 as the determination region 35 from the first map 31 whose resolution has been reduced in step S <b> 20.
The position of each area 33 of the first map 31 and the second map 32 is specified. Therefore, the position of each region 34 is also specified. Therefore, the primary vector calculation unit 23 can generally specify which part of the first map 31 and which part of the second map 32 overlap from the position of the region 34. Therefore, the primary vector calculation unit 23 selects a partial region 34 of the first map 31 that is likely to overlap the second map 32 as the determination region 35.
Here, the primary vector calculation unit 23 selects a target number of regions 34 from the outside as a determination region 35 for one side of the rectangular first map 31. In FIG. 6, three areas 34 from the outside are selected as determination areas 35 for the left side. The outermost region 34 is excluded from the determination region 35 because a primary vector 42 described later cannot be calculated. The number of objects is determined by the accuracy of the position of the region 34, for example.

(ステップS302:対象抽出処理)
1次ベクトル計算部23は、ステップS301で判定領域35として選択された領域34のうちある領域34を対象領域36として抽出する。
(Step S302: Object extraction process)
The primary vector calculation unit 23 extracts a region 34 among the regions 34 selected as the determination region 35 in step S <b> 301 as the target region 36.

(ステップS303:ベクトル計算処理)
1次ベクトル計算部23は、対象領域36についての存在確率と、対象領域36と隣接した領域34で隣接領域37についての存在確率との差を、対象領域36についての隣接領域37に対するベクトル41として計算する。具体例としては、図7に示すように、対象領域36の存在確率が“0”であり、隣接領域37の存在確率が“0.5”であるとする。この場合、対象領域36についての隣接領域37に対するベクトル41は、対象領域36から隣接領域37へ向かう方向の、長さが0.5のベクトルである。
図8に示すように、1次ベクトル計算部23は、対象領域36についての周囲の8個の領域34に対するベクトル41の和を、対象領域36の1次ベクトル42として計算する。つまり、1次ベクトル計算部23は、数1により1次ベクトル42を計算する。

Figure 2018220787
数1では、ベクトルa は対象領域36の存在確率である。ベクトルa ijは隣接領域37の存在確率である。変数iは横方向の領域34の位置を表し、変数jは縦方向の領域34の位置を表す。したがって、ベクトル41は、(a ij−a )である。ベクトルb は対象領域36の1次ベクトル42である。(Step S303: Vector calculation process)
The primary vector calculation unit 23 sets the difference between the existence probability for the target region 36 and the existence probability for the adjacent region 37 in the region 34 adjacent to the target region 36 as a vector 41 for the adjacent region 37 for the target region 36. calculate. As a specific example, as shown in FIG. 7, it is assumed that the existence probability of the target area 36 is “0” and the existence probability of the adjacent area 37 is “0.5”. In this case, the vector 41 for the adjacent region 37 for the target region 36 is a vector having a length of 0.5 in the direction from the target region 36 to the adjacent region 37.
As shown in FIG. 8, the primary vector calculation unit 23 calculates the sum of vectors 41 for the surrounding eight regions 34 for the target region 36 as a primary vector 42 of the target region 36. That is, the primary vector calculation unit 23 calculates the primary vector 42 using Equation 1.
Figure 2018220787
In Equation 1, the vector a 0 is the existence probability of the target region 36. The vector a ij is the existence probability of the adjacent region 37. The variable i represents the position of the region 34 in the horizontal direction, and the variable j represents the position of the region 34 in the vertical direction. Therefore, the vector 41 is (a ij− a 0 ). The vector b 0 is the primary vector 42 of the target area 36.

(ステップS304:丸め処理)
1次ベクトル計算部23は、ステップS302で計算された1次ベクトル42の長さが1次閾値よりも短い場合には、1次ベクトル42を0に変更する。
(Step S304: Rounding process)
The primary vector calculation unit 23 changes the primary vector 42 to 0 when the length of the primary vector 42 calculated in step S302 is shorter than the primary threshold.

(ステップS305:終了判定処理)
1次ベクトル計算部23は、ステップS301で判定領域35として選択された全ての領域34について1次ベクトル42が計算されたか否かを判定する。
1次ベクトル計算部23は、全ての領域34について1次ベクトル42が計算された場合には、処理を終了する。一方、1次ベクトル計算部23は、そうでない場合には、処理をステップS302に戻す。
(Step S305: End determination processing)
The primary vector calculation unit 23 determines whether or not the primary vector 42 has been calculated for all the regions 34 selected as the determination region 35 in step S301.
The primary vector calculation unit 23 ends the process when the primary vectors 42 are calculated for all the regions 34. On the other hand, if not, the primary vector calculation unit 23 returns the process to step S302.

(ステップS40:2次ベクトル計算処理)
2次ベクトル計算部24は、ステップS20で低解像度化された第1地図31について、2次ベクトル43を計算する。
(Step S40: secondary vector calculation process)
The secondary vector calculation unit 24 calculates a secondary vector 43 for the first map 31 whose resolution has been reduced in step S20.

図9を参照して、実施の形態1に係る2次ベクトル計算処理を説明する。
(ステップS401:注目領域抽出処理)
図10に示すように、2次ベクトル計算部24は、ステップS301で判定領域35として選択された領域34から隣接する2つ以上の領域34を第1注目領域38として抽出する。図10では、縦2つ横2つの合計4つの領域34が第1注目領域38として抽出されている。
With reference to FIG. 9, the secondary vector calculation process according to the first embodiment will be described.
(Step S401: attention area extraction processing)
As illustrated in FIG. 10, the secondary vector calculation unit 24 extracts two or more adjacent regions 34 as the first region of interest 38 from the region 34 selected as the determination region 35 in step S <b> 301. In FIG. 10, a total of four regions 34, two vertically and two horizontally, are extracted as the first region of interest 38.

(ステップS402:ベクトル計算処理)
図11に示すように、2次ベクトル計算部24は、ステップS401で抽出された第1注目領域38に含まれる各領域34についての1次ベクトル42の和を、2次ベクトル43として計算する。つまり、2次ベクトル計算部24は、数2により、各領域34についての1次ベクトル42を合成して2次ベクトル43を計算する。

Figure 2018220787
数2では、ベクトルbijは各領域34の1次ベクトル42である。変数iは横方向の領域34の位置を表し、変数jは縦方向の領域34の位置を表す。変数i,jの範囲は、第1注目領域38の範囲である。ベクトルbは2次ベクトル43である。(Step S402: Vector calculation process)
As shown in FIG. 11, the secondary vector calculation unit 24 calculates the sum of the primary vectors 42 for each region 34 included in the first region of interest 38 extracted in step S <b> 401 as the secondary vector 43. That is, the secondary vector calculation unit 24 calculates the secondary vector 43 by combining the primary vectors 42 for each region 34 according to Equation 2.
Figure 2018220787
In Equation 2, the vector b ij is the primary vector 42 of each region 34. The variable i represents the position of the region 34 in the horizontal direction, and the variable j represents the position of the region 34 in the vertical direction. The range of the variables i and j is the range of the first attention area 38. The vector b is a secondary vector 43.

(ステップS403:丸め処理)
2次ベクトル計算部24は、ステップS402で計算された2次ベクトル43の長さが2次閾値よりも短い場合には、2次ベクトル43を0に変更する。
(Step S403: Rounding process)
The secondary vector calculation unit 24 changes the secondary vector 43 to 0 when the length of the secondary vector 43 calculated in step S402 is shorter than the secondary threshold.

(ステップS404:終了判定処理)
2次ベクトル計算部24は、2次ベクトル43の長さが0であるか否かを判定する。
2次ベクトル計算部24は、2次ベクトル43の長さが0である場合には、処理をステップS401に戻して、別の第1注目領域38を抽出させる。一方、2次ベクトル計算部24は、そうでない場合には、処理を終了する。
(Step S404: end determination processing)
The secondary vector calculation unit 24 determines whether or not the length of the secondary vector 43 is zero.
If the length of the secondary vector 43 is 0, the secondary vector calculation unit 24 returns the process to step S401 to extract another first region of interest 38. On the other hand, the secondary vector calculation part 24 complete | finishes a process, when that is not right.

(ステップS50:類似領域検索処理)
判定部25は、ステップS401で抽出された第1注目領域38と類似度が高い第2地図32の領域を探索する。
(Step S50: Similar region search processing)
The determination unit 25 searches for an area of the second map 32 having a high similarity with the first attention area 38 extracted in step S401.

図12を参照して、実施の形態1に係る類似領域検索処理を説明する。
(ステップS501:注目領域抽出処理)
図13に示すように、判定部25は、ステップS20で低解像度化された第2地図32から隣接する2つ以上の領域34を第2注目領域39として抽出する。ここで抽出される第2注目領域39は、ステップS401で抽出される第1注目領域38と同じサイズである。つまり、ここで抽出される第2注目領域39と、ステップS401で抽出される第1注目領域38とは、縦方向に含まれる領域34の数及び横方向に含まれる領域34の数が同じである。
With reference to FIG. 12, the similar area search processing according to the first embodiment will be described.
(Step S501: attention area extraction processing)
As illustrated in FIG. 13, the determination unit 25 extracts two or more adjacent areas 34 as the second attention area 39 from the second map 32 whose resolution has been reduced in step S <b> 20. The second region of interest 39 extracted here is the same size as the first region of interest 38 extracted in step S401. That is, the second region of interest 39 extracted here and the first region of interest 38 extracted in step S401 have the same number of regions 34 included in the vertical direction and the number of regions 34 included in the horizontal direction. is there.

(ステップS502:第1ベクトル計算処理)
判定部25は、1次ベクトル計算部23及び2次ベクトル計算部24に、ステップS501で抽出された第2注目領域39についての2次ベクトル43を計算させる。
2次ベクトル43の計算方法は、上述した通りである。つまり、まず1次ベクトル計算部23が、第2注目領域39に含まれる各領域34の1次ベクトル42を計算する。すなわち、1次ベクトル計算部23は、各領域34を対象領域36として、対象領域36についての周囲の8個の領域34に対するベクトル41の和を、対象領域36の1次ベクトル42として計算する。そして、2次ベクトル計算部24は、第2注目領域39に含まれる各領域34についての1次ベクトル42の和を、2次ベクトル43として計算する。
(Step S502: First vector calculation process)
The determination unit 25 causes the primary vector calculation unit 23 and the secondary vector calculation unit 24 to calculate the secondary vector 43 for the second region of interest 39 extracted in step S501.
The calculation method of the secondary vector 43 is as described above. That is, first, the primary vector calculation unit 23 calculates the primary vector 42 of each area 34 included in the second attention area 39. That is, the primary vector calculation unit 23 calculates each region 34 as the target region 36, and calculates the sum of the vectors 41 for the eight surrounding regions 34 with respect to the target region 36 as the primary vector 42 of the target region 36. Then, the secondary vector calculation unit 24 calculates the sum of the primary vectors 42 for each area 34 included in the second attention area 39 as a secondary vector 43.

(ステップS503:第1類似度計算処理)
判定部25は、ステップS402で計算された第1注目領域38についての2次ベクトル43と、ステップS502で計算された第2注目領域39についての2次ベクトル43とのコサイン類似度を計算する。
具体的には、判定部25は、数3により、第1注目領域38についての2次ベクトル43と、第2注目領域39についての2次ベクトル43とのコサイン類似度を計算する。

Figure 2018220787
数3では、ベクトルAは第1注目領域38についての2次ベクトル43である。ベクトルBは第2注目領域39についての2次ベクトル43である。cos(A,B)は、第1注目領域38についての2次ベクトル43と、第2注目領域39についての2次ベクトル43とのコサイン類似度である。(Step S503: First similarity calculation process)
The determination unit 25 calculates the cosine similarity between the secondary vector 43 for the first region of interest 38 calculated in step S402 and the secondary vector 43 for the second region of interest 39 calculated in step S502.
Specifically, the determination unit 25 calculates the cosine similarity between the secondary vector 43 for the first region of interest 38 and the secondary vector 43 for the second region of interest 39 using Equation 3.
Figure 2018220787
In Equation 3, the vector A is a secondary vector 43 for the first region of interest 38. The vector B is a secondary vector 43 for the second region of interest 39. cos (A , B ) is a cosine similarity between the secondary vector 43 for the first region of interest 38 and the secondary vector 43 for the second region of interest 39.

(ステップS504:第1類似度判定処理)
判定部25は、ステップS504で計算されたコサイン類似度が類似閾値よりも小さいか否かを判定する。
判定部25は、コサイン類似度が類似閾値よりも小さい場合には、第1注目領域38と第2注目領域39とが対応するとして、処理をステップS505に進める。この際、変数kに1を設定する。一方、そうでない場合には、処理をステップS511に進める。この際、変数kに0を設定する。
(Step S504: First similarity determination process)
The determination unit 25 determines whether or not the cosine similarity calculated in step S504 is smaller than the similarity threshold.
When the cosine similarity is smaller than the similarity threshold, the determination unit 25 determines that the first attention area 38 and the second attention area 39 correspond to each other, and advances the processing to step S505. At this time, 1 is set to the variable k. On the other hand, if not, the process proceeds to step S511. At this time, 0 is set to the variable k.

(ステップS505:領域ずらし処理)
判定部25は、ステップS2で低解像度化された第1地図31から、第1注目領域38に基準方向に近接する別の第1注目領域38(ここでは、便宜的に第1注目領域38’と呼ぶ)を抽出する。また、判定部25は、ステップS20で低解像度化された第2地図32から、第2注目領域39に基準方向に近接する別の第2注目領域39(ここでは、便宜的に第2注目領域39’と呼ぶ)を抽出する。
第1注目領域38に近接する第1注目領域38’とは、図14に示すように、第1注目領域38と第1注目領域38’とが隣り合っていてもよい。また、第1注目領域38に近接する第1注目領域38’とは、図15に示すように、一部が重なり合っていてもよい。また、第1注目領域38に近接する第1注目領域38’とは、図16に示すように、間が空いていてもよい。第2注目領域39に近接する第2注目領域39’についても同様である。
但し、第1注目領域38と第1注目領域38’との位置関係と、第2注目領域39と第2注目領域39’との位置関係とは、同じである。つまり、第1注目領域38’が第1注目領域38の下隣りであれば、第2注目領域39’も第2注目領域39の下隣りである。
(Step S505: Area shift processing)
The determination unit 25 determines, from the first map 31 whose resolution has been reduced in step S2, another first attention area 38 that is close to the first attention area 38 in the reference direction (here, the first attention area 38 ′ for convenience). Called). In addition, the determination unit 25 determines, from the second map 32 whose resolution has been reduced in step S20, another second attention area 39 (here, the second attention area for convenience) that is close to the second attention area 39 in the reference direction. 39 ′).
As shown in FIG. 14, the first region of interest 38 and the first region of interest 38 ′ may be adjacent to the first region of interest 38 ′ adjacent to the first region of interest 38. Moreover, as shown in FIG. 15, a part may overlap with 1st attention area | region 38 'adjacent to the 1st attention area 38. As shown in FIG. Further, as shown in FIG. 16, the first attention area 38 ′ adjacent to the first attention area 38 may be spaced. The same applies to the second attention area 39 ′ adjacent to the second attention area 39.
However, the positional relationship between the first region of interest 38 and the first region of interest 38 'is the same as the positional relationship between the second region of interest 39 and the second region of attention 39'. That is, if the first region of interest 38 ′ is adjacent below the first region of interest 38, the second region of interest 39 ′ is also adjacent below the second region of interest 39.

(ステップS506:第2ベクトル計算処理)
判定部25は、1次ベクトル計算部23及び2次ベクトル計算部24に、ステップS505で抽出された第1注目領域38及び第2注目領域39についての2次ベクトル43を計算させる。
2次ベクトル43の計算方法は、上述した通りである。つまり、まず1次ベクトル計算部23が、第1注目領域38に含まれる各領域34の1次ベクトル42を計算する。すなわち、1次ベクトル計算部23は、各領域34を対象領域36として、対象領域36についての周囲の8個の領域34に対するベクトル41の和を、対象領域36の1次ベクトル42として計算する。そして、2次ベクトル計算部24は、第1注目領域38に含まれる各領域34についての1次ベクトル42の和を、2次ベクトル43として計算する。同様の処理が第2注目領域39についても実行され、2次ベクトル43が計算される。
(Step S506: second vector calculation process)
The determination unit 25 causes the primary vector calculation unit 23 and the secondary vector calculation unit 24 to calculate the secondary vector 43 for the first attention area 38 and the second attention area 39 extracted in step S505.
The calculation method of the secondary vector 43 is as described above. That is, first, the primary vector calculation unit 23 calculates the primary vector 42 of each area 34 included in the first attention area 38. That is, the primary vector calculation unit 23 calculates each region 34 as the target region 36, and calculates the sum of the vectors 41 for the eight surrounding regions 34 with respect to the target region 36 as the primary vector 42 of the target region 36. Then, the secondary vector calculation unit 24 calculates the sum of the primary vectors 42 for each region 34 included in the first attention region 38 as a secondary vector 43. Similar processing is executed for the second region of interest 39, and a secondary vector 43 is calculated.

(ステップS507:第2類似度計算処理)
判定部25は、ステップS506で計算された第1注目領域38についての2次ベクトル43と、第2注目領域39についての2次ベクトル43とのコサイン類似度を計算する。
コサイン類似度の計算方法は、ステップS503と同じである。
(Step S507: Second similarity calculation process)
The determination unit 25 calculates the cosine similarity between the secondary vector 43 for the first region of interest 38 calculated in step S506 and the secondary vector 43 for the second region of interest 39.
The cosine similarity calculation method is the same as that in step S503.

(ステップS508:第2類似度判定処理)
判定部25は、ステップS507で計算されたコサイン類似度が類似閾値よりも小さいか否かを判定する。
判定部25は、コサイン類似度が類似閾値よりも小さい場合には、ステップS505で抽出された第1注目領域38とステップS505で抽出された第2注目領域39とが対応するとして、処理をステップS509に進める。この際、変数kに1加算する。一方、そうでない場合には、処理をステップS511に進める。この際、変数kに0を設定する。
(Step S508: Second similarity determination process)
The determination unit 25 determines whether or not the cosine similarity calculated in step S507 is smaller than the similarity threshold.
When the cosine similarity is smaller than the similarity threshold, the determination unit 25 determines that the first attention area 38 extracted in step S505 corresponds to the second attention area 39 extracted in step S505. The process proceeds to S509. At this time, 1 is added to the variable k. On the other hand, if not, the process proceeds to step S511. At this time, 0 is set to the variable k.

(ステップS509:連続判定処理)
判定部25は、変数kが基準数Nであるか否かを判定する。言い換えると、判定部25は、基準個(N個)の第1注目領域38及び第2注目領域39が連続して対応したか否かを判定する。
判定部25は、変数kが基準数Nである場合には、処理をステップS510に進める。一方、判定部25は、そうでない場合には、処理をステップS505に戻す。
(Step S509: Continuous determination process)
The determination unit 25 determines whether or not the variable k is the reference number N. In other words, the determination unit 25 determines whether or not the reference number (N) of the first attention area 38 and the second attention area 39 correspond continuously.
If the variable k is the reference number N, the determination unit 25 advances the process to step S510. On the other hand, the determination part 25 returns a process to step S505, when that is not right.

(ステップS510:一致処理)
判定部25は、第1地図31についての近接する基準個の第1注目領域38と第2地図32ついての近接する基準個の第2注目領域39とが同じ位置を示していると判定する。そして、判定部25は、同じ位置を示すと判定された第1注目領域38及び第2注目領域39の位置関係から、第1地図31と第2地図32とを対応するための変換量を得る。
具体的には、変換量は、地図を平行移動させる移動量と、地図を回転させる回転量とからなる。移動量は、同じ位置を示すと判定された第1注目領域38及び第2注目領域39の位置のずれに相当する。また、回転量は、後述するステップS90で第1地図31が回転された角度に相当する。
(Step S510: Matching process)
The determining unit 25 determines that the adjacent reference number of first attention areas 38 for the first map 31 and the adjacent reference number of second attention areas 39 for the second map 32 indicate the same position. And the determination part 25 obtains the conversion amount for making the 1st map 31 and the 2nd map 32 correspond from the positional relationship of the 1st attention area 38 and the 2nd attention area 39 which were determined to show the same position. .
Specifically, the conversion amount includes a movement amount that translates the map and a rotation amount that rotates the map. The amount of movement corresponds to the displacement of the positions of the first attention area 38 and the second attention area 39 that are determined to indicate the same position. The rotation amount corresponds to the angle at which the first map 31 is rotated in step S90 described later.

(ステップS511:第2領域判定処理)
判定部25は、第2地図32の全ての領域を第2注目領域39として抽出したか否かを判定する。
判定部25は、全ての領域を抽出した場合には、処理をステップS513に進める。一方、判定部25は、そうでない場合には、処理をステップS512に進める。
(Step S511: Second Area Determination Process)
The determination unit 25 determines whether or not all areas of the second map 32 have been extracted as the second attention area 39.
If the determination unit 25 has extracted all the regions, the process proceeds to step S513. On the other hand, the determination part 25 advances a process to step S512, when that is not right.

(ステップS512:近接領域抽出処理)
判定部25は、ステップS20で低解像度化された第2地図32から、第2注目領域39に近接する別の第2注目領域39を抽出する。そして、判定部25は、処理をステップS502に戻す。
(Step S512: proximity region extraction process)
The determination unit 25 extracts another second region of interest 39 close to the second region of interest 39 from the second map 32 whose resolution has been reduced in step S20. Then, the determination unit 25 returns the process to step S502.

(ステップS513:不一定処理)
判定部25は、ステップS401で選択された第1注目領域38に対応する領域34は第2地図32にはないと判定する。つまり、ステップS401で選択された第1注目領域38と同じ位置を示す領域34は第2地図32にはないと判定する。
(Step S513: Uncertain processing)
The determination unit 25 determines that the region 34 corresponding to the first region of interest 38 selected in step S <b> 401 is not in the second map 32. That is, it is determined that the region 34 that indicates the same position as the first region of interest 38 selected in step S401 is not in the second map 32.

(ステップS60:特定判定処理)
判定部25は、ステップS50で、ステップS401で抽出された第1注目領域38と類似度が高い第2地図32の領域が特定されたか否かを判定する。
判定部25は、類似度が高い第2地図32の領域が特定された場合には、処理を終了する。判定部25は、そうでない場合には、処理をステップS70に進める。
(Step S60: specific determination process)
In step S50, the determination unit 25 determines whether or not an area of the second map 32 having a high similarity with the first attention area 38 extracted in step S401 has been specified.
The determination part 25 complete | finishes a process, when the area | region of the 2nd map 32 with high similarity is specified. If not, the determination unit 25 advances the process to step S70.

(ステップS70:第1領域判定処理)
判定部25は、ステップS401で判定領域35に含まれる全ての領域34が第1注目領域38として選択されたか否かを判定する。
判定部25は、全ての領域34が第1注目領域38として選択されていない場合には、処理をステップS40に戻して、新たな第1注目領域38を選択させる。一方、判定部25は、そうでない場合には、処理をステップS80に進める。
(Step S70: first area determination process)
The determination unit 25 determines whether or not all the regions 34 included in the determination region 35 are selected as the first attention region 38 in step S401.
When all the areas 34 are not selected as the first attention area 38, the determination unit 25 returns the process to step S40 to select a new first attention area 38. On the other hand, the determination part 25 advances a process to step S80, when that is not right.

(ステップS80:回転判定処理)
判定部25は、第1地図31を360度回転させたか否かを判定する。
判定部25は、第1地図31を360度回転させた場合には、第1地図31と第2地図32とは重なっていないと判定して、処理を終了する。一方、判定部25は、そうでない場合には、処理をステップS90に進める。
(Step S80: rotation determination process)
The determination unit 25 determines whether the first map 31 has been rotated 360 degrees.
When the first map 31 is rotated 360 degrees, the determination unit 25 determines that the first map 31 and the second map 32 do not overlap, and ends the process. On the other hand, the determination part 25 advances a process to step S90, when that is not right.

(ステップS90:地図回転処理)
判定部25は、第1地図31を基準角度だけ回転させる。そして、判定部25は、処理をステップS30に戻して、改めて第1地図31の1次ベクトル42を計算させる。
(Step S90: Map rotation processing)
The determination unit 25 rotates the first map 31 by a reference angle. And the determination part 25 returns a process to step S30, and calculates the primary vector 42 of the 1st map 31 anew.

図17を参照して第1地図31を回転させる処理について説明する。
ここでは、第1地図31が、領域33を規定する枠の層51と、存在確率が示された地図の層52とから構成されると考える。第1地図31を回転させるとは、枠の層51は回転させずに、地図の層52だけを回転させることである。
つまり、回転前の座標を(X0,Y0)とし、回転中心座標を(CX,CY)とし、回転後の座標を(X1,Y1)とし、回転角度をθとする。すると、第1地図31を回転させるとは、数4に示す計算になる。すなわち、第1地図31を回転させるとは、回転後の領域33の座標から、その領域33に対応する回転前の領域33の座標を計算して、その回転前の領域33の存在確率を回転後の領域33の存在確率として設定することである。

Figure 2018220787
The process of rotating the first map 31 will be described with reference to FIG.
Here, it is assumed that the first map 31 includes a frame layer 51 that defines the region 33 and a map layer 52 that indicates the existence probability. To rotate the first map 31 is to rotate only the map layer 52 without rotating the frame layer 51.
That is, the coordinates before rotation are (X0, Y0), the rotation center coordinates are (CX, CY), the coordinates after rotation are (X1, Y1), and the rotation angle is θ. Then, rotating the first map 31 is the calculation shown in Equation 4. That is, rotating the first map 31 calculates the coordinates of the area 33 before rotation corresponding to the area 33 from the coordinates of the area 33 after rotation, and rotates the existence probability of the area 33 before the rotation. It is to set as the existence probability of the subsequent area 33.
Figure 2018220787

***実施の形態1の効果***
以上のように、実施の形態1に係る地図処理装置10は、各領域34に物体が存在する存在確率の差をベクトル41として、ベクトル41をコサイン類似度により比較することにより、第1地図31と第2地図32との対応する点を特定する。
ベクトル41を用いた計算であるため、特許文献1のようにヒストグラムを用いた場合に比べ、処理時間を短くすることができる。また、移動する物体が存在する場合であっても、移動がベクトル41に与える影響は小さい。そのため、移動する物体が存在する場合にも精度よく第1地図31と第2地図32との対応する点を特定することが可能である。
*** Effects of Embodiment 1 ***
As described above, the map processing apparatus 10 according to the first embodiment uses the difference in the existence probability that an object exists in each region 34 as the vector 41, and compares the vector 41 with the cosine similarity, thereby comparing the first map 31. And a corresponding point between the second map 32 and the second map 32 are specified.
Since the calculation is performed using the vector 41, the processing time can be shortened compared to the case of using a histogram as in Patent Document 1. Even if there is a moving object, the influence of the movement on the vector 41 is small. Therefore, even when there is a moving object, it is possible to specify the corresponding points on the first map 31 and the second map 32 with high accuracy.

***他の構成***
<変形例1>
実施の形態1では、図2のステップS10で第1地図31と第2地図32との2つの地図が取得された。しかし、図2のステップS10では、3つ以上の地図が取得されてもよい。この場合、地図処理装置10は、2つの地図の各組合せについて図2のステップ2以降の処理を実行すればよい。
*** Other configurations ***
<Modification 1>
In the first embodiment, two maps of the first map 31 and the second map 32 are acquired in step S10 of FIG. However, in step S10 of FIG. 2, three or more maps may be acquired. In this case, the map processing apparatus 10 should just perform the process after step 2 of FIG. 2 about each combination of two maps.

<変形例2>
実施の形態1では、第1地図31及び第2地図32の各領域33には、“1”と“0”と“0.5”とのいずれかの存在確率が設定されていた。しかし、これに限らず、各領域33には、より細かな確率が設定されていてもよい。
この場合には、図2のステップS20で解像度変更部22は、新たな領域34の確率として、新たな領域34に含まれる領域33の確率のうち最も高い確率を設定すればよい。
<Modification 2>
In the first embodiment, the existence probability of “1”, “0”, and “0.5” is set in each region 33 of the first map 31 and the second map 32. However, the present invention is not limited to this, and a finer probability may be set for each region 33.
In this case, the resolution changing unit 22 may set the highest probability among the probabilities of the region 33 included in the new region 34 as the probability of the new region 34 in step S20 of FIG.

<変形例3>
実施の形態1では、地図処理装置10の各機能構成要素の機能がソフトウェアで実現された。変形例3として、地図処理装置10の各機能構成要素の機能はハードウェアで実現されてもよい。この変形例3について、実施の形態1と異なる点を説明する。
<Modification 3>
In the first embodiment, the function of each functional component of the map processing apparatus 10 is realized by software. As a third modification, the function of each functional component of the map processing apparatus 10 may be realized by hardware. The third modification will be described with respect to differences from the first embodiment.

図18を参照して、変形例3に係る地図処理装置10の構成を説明する。
各機能構成要素の機能がハードウェアで実現される場合、地図処理装置10は、通信インタフェース14と、電子回路15とを備える。電子回路15は、地図処理装置10の各機能構成要素の機能と、メモリ12及びストレージ13の機能とを実現する専用の電子回路である。
With reference to FIG. 18, the structure of the map processing apparatus 10 which concerns on the modification 3 is demonstrated.
When the function of each functional component is realized by hardware, the map processing apparatus 10 includes a communication interface 14 and an electronic circuit 15. The electronic circuit 15 is a dedicated electronic circuit that realizes the functions of the functional components of the map processing apparatus 10 and the functions of the memory 12 and the storage 13.

電子回路15は、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ロジックIC、GA(Gate Array)、ASIC(Application Specific Integrated Circuit)、FPGA(Field−Programmable Gate Array)が想定される。
各機能構成要素の機能を1つの電子回路15で実現してもよいし、各機能構成要素の機能を複数の電子回路15に分散させて実現してもよい。
The electronic circuit 15 is assumed to be a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, a logic IC, a GA (Gate Array), an ASIC (Application Specific Integrated Circuit), or an FPGA (Field-Programmable Gate Array). Is done.
The function of each functional component may be realized by one electronic circuit 15, or the function of each functional component may be distributed to a plurality of electronic circuits 15.

<変形例4>
変形例4として、一部の機能がハードウェアで実現され、他の機能がソフトウェアで実現されてもよい。つまり、地図処理装置10の各機能構成要素のうち、一部の機能がハードウェアで実現され、他の機能がソフトウェアで実現されてもよい。
<Modification 4>
As a fourth modification, some functions may be realized by hardware, and other functions may be realized by software. That is, some of the functional components of the map processing device 10 may be realized by hardware, and other functions may be realized by software.

プロセッサ11と記憶装置12と電子回路15とを処理回路という。つまり、地図処理装置10が図1と図18とのどちらに示される構成であっても、各機能構成要素の機能は、処理回路により実現される。   The processor 11, the storage device 12, and the electronic circuit 15 are referred to as a processing circuit. That is, regardless of whether the map processing apparatus 10 is configured as shown in FIG. 1 or FIG. 18, the functions of the functional components are realized by the processing circuit.

実施の形態2.
実施の形態2は、第1地図31と第2地図32とを合成する点が実施の形態1と異なる。実施の形態2では、この異なる点を説明し、同一の点については説明を省略する。
Embodiment 2. FIG.
The second embodiment is different from the first embodiment in that the first map 31 and the second map 32 are combined. In the second embodiment, this different point will be described, and the description of the same point will be omitted.

***構成の説明***
図19を参照して、実施の形態2に係る地図処理装置10の構成を説明する。
地図処理装置10は、地図合成部26を備える点が図1に示す地図処理装置10と異なる。地図合成部26は、他の機能構成要素と同様に、ソフトウェアで実現される。あるいは、地図合成部26は、ハードウェアで実現されてもよい。
*** Explanation of configuration ***
With reference to FIG. 19, the structure of the map processing apparatus 10 which concerns on Embodiment 2 is demonstrated.
The map processing apparatus 10 is different from the map processing apparatus 10 shown in FIG. The map synthesizing unit 26 is realized by software in the same manner as other functional components. Alternatively, the map composition unit 26 may be realized by hardware.

***動作の説明***
図20を参照して、実施の形態2に係る地図処理装置10の動作を説明する。
(ステップS1:地図比較処理)
地図処理装置10は、図2に基づき説明した処理を実行して、第1地図31と第2地図32とを合成するための変換量を計算する。
*** Explanation of operation ***
With reference to FIG. 20, operation | movement of the map processing apparatus 10 which concerns on Embodiment 2 is demonstrated.
(Step S1: Map comparison process)
The map processing device 10 executes the processing described based on FIG. 2 and calculates the conversion amount for synthesizing the first map 31 and the second map 32.

(ステップS2:合成処理)
地図合成部26は、ステップS1で計算された変換量に基づき、第1地図31と第2地図32とを合成して合成地図61を生成する。
具体的には、地図合成部26は、変換量に基づき第2地図32を変換する。そして、地図合成部26は、第1地図31と、変換後の第2地図32とを組み合わせて合成地図61を生成する。
地図合成部26は、第1地図31と、変換後の第2地図32とを組み合わせる際、第2地図32のうち第1地図31に含まれていない部分を、第1地図31に加える。地図合成部26は、第1地図31と第2地図32との両方に含まれる部分については、第1地図31と第2地図32とのいずれか一方を使用してもよいし、第1地図31と第2地図32との平均値をとる等してもよい。
(Step S2: Composition processing)
The map composition unit 26 composes the first map 31 and the second map 32 based on the conversion amount calculated in step S1, and generates a composite map 61.
Specifically, the map composition unit 26 converts the second map 32 based on the conversion amount. Then, the map composition unit 26 generates a composite map 61 by combining the first map 31 and the converted second map 32.
When combining the first map 31 and the converted second map 32, the map composition unit 26 adds a portion of the second map 32 that is not included in the first map 31 to the first map 31. The map composition unit 26 may use either the first map 31 or the second map 32 for the portion included in both the first map 31 and the second map 32, or the first map You may take the average value of 31 and the 2nd map 32, etc.

***実施の形態2の効果***
以上のように、実施の形態2に係る地図処理装置10は、第1地図31と第2地図32とを合成する。実施の形態1で説明したように、地図処理装置10は、短い処理時間で精度よく第1地図31と第2地図32との対応する点を特定可能である。そのため、地図処理装置10は、短い処理時間で精度よく第1地図31と第2地図32とを合成した合成地図61を生成することが可能である。
*** Effects of Embodiment 2 ***
As described above, the map processing apparatus 10 according to the second embodiment synthesizes the first map 31 and the second map 32. As described in the first embodiment, the map processing apparatus 10 can specify the corresponding points between the first map 31 and the second map 32 with high accuracy in a short processing time. Therefore, the map processing apparatus 10 can generate the composite map 61 in which the first map 31 and the second map 32 are synthesized with high accuracy in a short processing time.

実施の形態3.
実施の形態3は、合成地図61に基づき運転支援を行う点が実施の形態2と異なる。実施の形態3では、この異なる点を説明し、同一の点については説明を省略する。
Embodiment 3 FIG.
The third embodiment is different from the second embodiment in that driving assistance is performed based on the composite map 61. In the third embodiment, this different point will be described, and the description of the same point will be omitted.

***構成の説明***
図21を参照して、実施の形態3に係る地図処理装置10の構成を説明する。
地図処理装置10は、運転支援部27を備える点が図19に示す地図処理装置10と異なる。運転支援部27は、他の機能構成要素と同様に、ソフトウェアで実現される。あるいは、運転支援部27は、ハードウェアで実現されてもよい。
*** Explanation of configuration ***
With reference to FIG. 21, the structure of the map processing apparatus 10 which concerns on Embodiment 3 is demonstrated.
The map processing apparatus 10 is different from the map processing apparatus 10 shown in FIG. 19 in that the driving support unit 27 is provided. The driving support unit 27 is realized by software in the same manner as other functional components. Alternatively, the driving support unit 27 may be realized by hardware.

***動作の説明***
図22を参照して、実施の形態3に係る地図処理装置10の動作を説明する。
ステップS1からステップS2の処理は、実施の形態2と同じである。
*** Explanation of operation ***
With reference to FIG. 22, the operation of the map processing apparatus 10 according to the third embodiment will be described.
The processing from step S1 to step S2 is the same as in the second embodiment.

(ステップS3:運転支援処理)
運転支援部27は、合成地図61に基づき、移動体の運転支援を行う。具体的には、運転支援部27は、合成地図61に基づき移動体を制御して自動運転を実現する。又は、運転支援部27は、移動体の運転手に合成地図61の情報を提供する。例えば、運転支援部27は、移動体に搭載された表示装置に合成地図61の情報を表示することにより、移動体の運転手に合成地図61の情報を提供する。
(Step S3: Driving support process)
The driving support unit 27 provides driving support for the moving body based on the composite map 61. Specifically, the driving support unit 27 controls the moving body based on the composite map 61 to realize automatic driving. Alternatively, the driving support unit 27 provides information on the composite map 61 to the driver of the moving body. For example, the driving support unit 27 provides the information of the synthetic map 61 to the driver of the moving body by displaying the information of the synthetic map 61 on a display device mounted on the moving body.

***実施の形態3の効果***
以上のように、実施の形態3に係る地図処理装置10は、合成地図61に基づき運転支援を行う。実施の形態2で説明したように、地図処理装置10は、短い処理時間で精度よく合成地図61を生成することが可能である。そのため、地図処理装置10は、リアルタイム性の高い運転支援を、精度のよい合成地図61に基づき行うことが可能である。
*** Effects of Embodiment 3 ***
As described above, the map processing device 10 according to the third embodiment performs driving support based on the composite map 61. As described in the second embodiment, the map processing apparatus 10 can generate the composite map 61 with high accuracy in a short processing time. Therefore, the map processing apparatus 10 can perform driving support with high real-time characteristics based on the accurate composite map 61.

***他の構成***
<変形例5>
実施の形態3では、地図処理装置10が運転支援部27を備えた。しかし、運転支援部27は、地図処理装置10とは別の運転支援装置が備えていてもよい。この場合、運転支援装置は、図22のステップS2で生成された合成地図61を地図処理装置10から取得して、運転支援を行う。
*** Other configurations ***
<Modification 5>
In the third embodiment, the map processing apparatus 10 includes the driving support unit 27. However, the driving support unit 27 may be provided in a driving support device different from the map processing device 10. In this case, the driving support apparatus obtains the composite map 61 generated in step S2 of FIG. 22 from the map processing apparatus 10 and performs driving support.

10 地図処理装置、11 プロセッサ、12 メモリ、13 ストレージ、14 通信インタフェース、15 電子回路、21 取得部、22 解像度変更部、23 1次ベクトル計算部、24 2次ベクトル計算部、25 判定部、26 地図合成部、27 運転支援部、31 第1地図、32 第2地図、33 領域、34 領域、35 判定領域、36 対象領域、37 隣接領域、38 第1注目領域、39 第2注目領域、41 ベクトル、42 1次ベクトル、43 2次ベクトル、51 層、52 層、61 合成地図。   DESCRIPTION OF SYMBOLS 10 Map processing apparatus, 11 Processor, 12 Memory, 13 Storage, 14 Communication interface, 15 Electronic circuit, 21 Acquisition part, 22 Resolution change part, 23 Primary vector calculation part, 24 Secondary vector calculation part, 25 Determination part, 26 Map synthesis unit, 27 Driving support unit, 31 1st map, 32 2nd map, 33 region, 34 region, 35 determination region, 36 target region, 37 adjacent region, 38 1st region of interest, 39 2nd region of interest, 41 Vector, 42 Primary vector, 43 Secondary vector, 51 layers, 52 layers, 61 Composite map.

Claims (11)

各領域に物体が存在する存在確率を示す第1地図及び第2地図それぞれについて、少なくとも一部の領域を対象領域として、前記対象領域についての前記存在確率と、前記対象領域と隣接した隣接領域についての前記存在確率との差を、前記対象領域についての前記隣接領域に対するベクトルとし、前記対象領域についての周囲の領域に対するベクトルの和を、前記対象領域の1次ベクトルとして計算する1次ベクトル計算部と、
前記第1地図及び前記第2地図それぞれについて、2つ以上の領域を注目領域として、前記注目領域に含まれる各領域の前記1次ベクトルの和を、前記注目領域の2次ベクトルとして計算する2次ベクトル計算部と、
前記第1地図についての前記注目領域に対して計算された前記2次ベクトルと、前記第2地図ついての前記注目領域に対して計算された前記2次ベクトルとを比較して、前記第1地図についての前記注目領域と前記第2地図ついての前記注目領域とが対応するか否かを判定する判定部と
を備える地図処理装置。
For each of the first map and the second map indicating the existence probability that an object exists in each area, the existence probability for the target area and the adjacent area adjacent to the target area with at least a part of the area as the target area A first vector calculation unit that calculates a difference between the existence probability of the target region as a vector for the adjacent region with respect to the target region and a sum of vectors with respect to surrounding regions for the target region as a primary vector of the target region When,
For each of the first map and the second map, two or more regions are used as a region of interest, and the sum of the primary vectors of the regions included in the region of interest is calculated as a secondary vector of the region of interest 2 A next vector calculation unit;
Comparing the secondary vector calculated for the region of interest for the first map with the secondary vector calculated for the region of interest for the second map; A map processing apparatus comprising: a determination unit that determines whether or not the region of interest for and the region of interest for the second map correspond to each other.
前記判定部は、前記第1地図についての近接する基準個の前記注目領域と前記第2地図ついての近接する前記基準個の前記注目領域とが対応する場合に、前記第1地図についての近接する前記基準個の前記注目領域と前記第2地図ついての近接する前記基準個の前記注目領域とが同じ位置を示していると判定する
請求項1に記載の地図処理装置。
The determination unit approaches the first map when the adjacent reference region of interest for the first map corresponds to the adjacent reference region of interest for the second map. The map processing device according to claim 1, wherein the reference region of interest and the reference region of interest adjacent to the second map are determined to indicate the same position.
前記判定部は、前記第1地図について基準方向に近接する前記基準個の前記注目領域と前記第2地図ついての近接する前記基準個の前記注目領域とが対応するか否かを、前記第1地図を基準角度ずつ回転させながら判定する
請求項2に記載の地図処理装置。
The determination unit determines whether the reference region of interest close to the reference direction for the first map corresponds to the reference region of interest for the second map adjacent to the first map. The map processing device according to claim 2, wherein the map is determined while rotating the map by a reference angle.
前記判定部は、前記第1地図についての前記注目領域に対して計算された前記2次ベクトルと、前記第2地図ついての前記注目領域に対して計算された前記2次ベクトルとのコサイン類似度を計算することにより、比較する
請求項1から3までのいずれか1項に記載の地図処理装置。
The determination unit includes a cosine similarity between the secondary vector calculated for the region of interest for the first map and the secondary vector calculated for the region of interest for the second map. The map processing device according to any one of claims 1 to 3, wherein the map processing devices are compared by calculating.
前記1次ベクトル計算部は、前記第1地図及び前記第2地図それぞれについて、外側から2番目の領域から、内側の方に対象数の領域までを前記対象領域として選択する
請求項1から4までのいずれか1項に記載の地図処理装置。
The primary vector calculation unit selects, for each of the first map and the second map, from the second region from the outside to the region of the number of objects inward as the target region. The map processing device according to any one of the above.
前記1次ベクトル計算部は、前記対象領域についての周囲の領域に対するベクトルの和が第1閾値よりも小さい場合には、前記対象領域の前記1次ベクトルを0に設定し、
前記2次ベクトル計算部は、前記注目領域に含まれる各領域の前記1次ベクトルの和が第2閾値よりも小さい場合には、前記注目領域の前記2次ベクトルを0に設定し、
前記判定部は、前記2次ベクトルが0でない前記注目領域について比較する
請求項1から5までのいずれか1項に記載の地図処理装置。
The primary vector calculation unit sets the primary vector of the target area to 0 when the sum of vectors for the surrounding area of the target area is smaller than a first threshold;
The secondary vector calculation unit sets the secondary vector of the region of interest to 0 when the sum of the primary vectors of the regions included in the region of interest is smaller than a second threshold;
The map processing apparatus according to any one of claims 1 to 5, wherein the determination unit compares the attention areas whose secondary vectors are not zero.
前記地図処理装置は、さらに、
前記第1地図及び前記第2地図について、複数の領域を1つの領域にすることにより、前記第1地図及び前記第2地図を低解像度化する解像度変更部
を備え、
前記1次ベクトル計算部は、前記解像度変更部によって低解像度化された前記第1地図及び前記第2地図について、前記1次ベクトルを計算する
請求項1から6までのいずれか1項に記載の地図処理装置。
The map processing device further includes:
For the first map and the second map, a resolution changing unit for reducing the resolution of the first map and the second map by making a plurality of areas into one area,
7. The primary vector calculation unit according to claim 1, wherein the primary vector calculation unit calculates the primary vector for the first map and the second map that have been reduced in resolution by the resolution changing unit. Map processing device.
前記解像度変更部は、前記複数の領域それぞれについての前記存在確率のうち最も高い存在確率を、前記1つの領域についての前記存在確率として設定する
請求項7に記載の地図処理装置。
The map processing apparatus according to claim 7, wherein the resolution changing unit sets the highest existence probability among the existence probabilities for each of the plurality of areas as the existence probability for the one area.
前記地図処理装置は、さらに、
前記判定部によって対応すると判定された前記注目領域に基づき、前記第1地図と前記第2地図とを合成して合成地図を生成する地図合成部と、
前記地図合成部によって生成された前記合成地図に基づき、移動体を制御する、又は、前記移動体の運転手に情報を提供する運転支援部と
を備える請求項1から8までのいずれか1項に記載の地図処理装置。
The map processing device further includes:
A map combining unit that combines the first map and the second map to generate a combined map based on the attention area determined to be supported by the determination unit;
A driving support unit that controls a moving body or provides information to a driver of the moving body based on the synthetic map generated by the map combining unit. The map processing device described in 1.
コンピュータが、各領域に物体が存在する存在確率を示す第1地図及び第2地図それぞれについて、少なくとも一部の領域を対象領域として、前記対象領域についての前記存在確率と、前記対象領域と隣接した隣接領域についての前記存在確率との差を、前記対象領域についての前記隣接領域に対するベクトルとし、前記対象領域についての周囲の領域に対するベクトルの和を、前記対象領域の1次ベクトルとして計算し、
コンピュータが、前記第1地図及び前記第2地図それぞれについて、2つ以上の領域を注目領域として、前記注目領域に含まれる各領域の前記1次ベクトルの和を、前記注目領域の2次ベクトルとして計算し、
コンピュータが、前記第1地図についての前記注目領域に対して計算された前記2次ベクトルと、前記第2地図ついての前記注目領域に対して計算された前記2次ベクトルとを比較して、前記第1地図についての前記注目領域と前記第2地図ついての前記注目領域とが対応するか否かを判定する地図処理方法。
For each of the first map and the second map indicating the existence probability that an object exists in each area, the existence probability for the target area is adjacent to the target area, and at least a part of the area is adjacent to the target area. The difference between the existence probability for the adjacent region is a vector for the adjacent region for the target region, and the sum of the vectors for the surrounding regions for the target region is calculated as a primary vector of the target region,
For each of the first map and the second map, the computer uses two or more regions as a region of interest, and a sum of the primary vectors of the regions included in the region of interest as a secondary vector of the region of interest Calculate
The computer compares the secondary vector calculated for the region of interest for the first map with the secondary vector calculated for the region of interest for the second map, and A map processing method for determining whether or not the attention area for the first map corresponds to the attention area for the second map.
各領域に物体が存在する存在確率を示す第1地図及び第2地図それぞれについて、少なくとも一部の領域を対象領域として、前記対象領域についての前記存在確率と、前記対象領域と隣接した隣接領域についての前記存在確率との差を、前記対象領域についての前記隣接領域に対するベクトルとし、前記対象領域についての周囲の領域に対するベクトルの和を、前記対象領域の1次ベクトルとして計算する1次ベクトル計算処理と、
前記第1地図及び前記第2地図それぞれについて、2つ以上の領域を注目領域として、前記注目領域に含まれる各領域の前記1次ベクトルの和を、前記注目領域の2次ベクトルとして計算する2次ベクトル計算処理と、
前記第1地図についての前記注目領域に対して計算された前記2次ベクトルと、前記第2地図ついての前記注目領域に対して計算された前記2次ベクトルとを比較して、前記第1地図についての前記注目領域と前記第2地図ついての前記注目領域とが対応するか否かを判定する判定処理と
をコンピュータに実行させる地図処理プログラム。
For each of the first map and the second map indicating the existence probability that an object exists in each area, the existence probability for the target area and the adjacent area adjacent to the target area with at least a part of the area as the target area A first vector calculation process for calculating a difference between the existence probability of the target region as a vector for the adjacent region with respect to the target region and a sum of vectors with respect to surrounding regions for the target region as a primary vector of the target region When,
For each of the first map and the second map, two or more regions are used as a region of interest, and the sum of the primary vectors of the regions included in the region of interest is calculated as a secondary vector of the region of interest 2 Next-vector calculation processing,
Comparing the secondary vector calculated for the region of interest for the first map with the secondary vector calculated for the region of interest for the second map; The map processing program which makes a computer perform the determination process which determines whether the said attention area | region about 2 and the said attention area | region about the said 2nd map respond | correspond.
JP2019521869A 2017-06-01 2017-06-01 Map processing apparatus, map processing method, and map processing program Active JP6605180B2 (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/020450 WO2018220787A1 (en) 2017-06-01 2017-06-01 Map processing device, map processing method and map processing program

Publications (2)

Publication Number Publication Date
JPWO2018220787A1 true JPWO2018220787A1 (en) 2019-11-07
JP6605180B2 JP6605180B2 (en) 2019-11-13

Family

ID=64455652

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019521869A Active JP6605180B2 (en) 2017-06-01 2017-06-01 Map processing apparatus, map processing method, and map processing program

Country Status (5)

Country Link
US (1) US20200081452A1 (en)
JP (1) JP6605180B2 (en)
CN (1) CN110651315B (en)
DE (1) DE112017007479B4 (en)
WO (1) WO2018220787A1 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7342697B2 (en) * 2019-12-26 2023-09-12 株式会社豊田自動織機 route generation device
US11698270B2 (en) * 2021-03-30 2023-07-11 Argo AI, LLC Method, system, and computer program product for iterative warping of maps for autonomous vehicles and simulators
KR102631313B1 (en) * 2023-06-08 2024-01-31 (주)인티그리트 Device capable of correcting location errors using real-time analysis and contrast between vision data and lidar data for the implementation of simultaneous localization and map-building technology
KR102631315B1 (en) * 2023-06-08 2024-02-01 (주)인티그리트 System capable of correcting location errors using real-time analysis and contrast between vision data and lidar data for the implementation of simultaneous localization and map-building technology

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3003905B2 (en) * 1994-04-20 2000-01-31 三菱電機株式会社 Map display device and image processing method
JP3499357B2 (en) * 1996-01-31 2004-02-23 三菱電機株式会社 Atlas junction display method
KR100209348B1 (en) * 1996-05-27 1999-07-15 이계철 Electronic map
JP4533659B2 (en) 2004-05-12 2010-09-01 株式会社日立製作所 Apparatus and method for generating map image by laser measurement
JP5018458B2 (en) 2007-12-25 2012-09-05 トヨタ自動車株式会社 Coordinate correction method, coordinate correction program, and autonomous mobile robot
CN101413806B (en) * 2008-11-07 2011-05-25 湖南大学 Mobile robot grating map creating method of real-time data fusion
CN103389103B (en) * 2013-07-03 2015-11-18 北京理工大学 A kind of Characters of Geographical Environment map structuring based on data mining and air navigation aid
US9646318B2 (en) * 2014-05-30 2017-05-09 Apple Inc. Updating point of interest data using georeferenced transaction data
CN105760811B (en) * 2016-01-05 2019-03-22 福州华鹰重工机械有限公司 Global map closed loop matching process and device

Also Published As

Publication number Publication date
CN110651315A (en) 2020-01-03
US20200081452A1 (en) 2020-03-12
WO2018220787A1 (en) 2018-12-06
JP6605180B2 (en) 2019-11-13
DE112017007479T5 (en) 2020-01-09
DE112017007479B4 (en) 2021-05-20
CN110651315B (en) 2021-09-07

Similar Documents

Publication Publication Date Title
JP6605180B2 (en) Map processing apparatus, map processing method, and map processing program
US10643103B2 (en) Method and apparatus for representing a map element and method and apparatus for locating a vehicle/robot
US11321937B1 (en) Visual localization method and apparatus based on semantic error image
EP2993490B1 (en) Operating device, operating method, and program therefor
WO2018119606A1 (en) Method and apparatus for representing a map element and method and apparatus for locating vehicle/robot
US20110274343A1 (en) System and method for extraction of features from a 3-d point cloud
US20140153816A1 (en) Depth Map Stereo Correspondence Techniques
JP2012518223A (en) Image feature extraction method and system
WO2021052283A1 (en) Method for processing three-dimensional point cloud data and computing device
JP2019145085A (en) Method, device, and computer-readable medium for adjusting point cloud data acquisition trajectory
JP2013186902A (en) Vehicle detection method and apparatus
WO2021219023A1 (en) Positioning method and apparatus, electronic device, and storage medium
US20200349727A1 (en) Obstacle detection method, mobile platform, and computer readable storage medium
CN113302666A (en) Identifying planes in an artificial reality system
EP3321882A1 (en) Matching cost computation method and device
CN112989877A (en) Method and device for labeling object in point cloud data
JP6295556B2 (en) Object dividing apparatus and method
US20090213121A1 (en) Image processing method and apparatus
JP6685941B2 (en) Information processing apparatus, information processing method, and information processing program
US20190279384A1 (en) Image processing apparatus, image processing method, and driving support system
US11181618B2 (en) Sensor data integration device, sensor data integration method and computer readable medium
CN112799071B (en) Method and device for detecting underwater position
JP2016106684A (en) Skeleton model creating device, method and program
WO2017006577A1 (en) Device for selecting three-dimensional point group, and method for selecting three-dimensional point group
US10380463B2 (en) Image processing device, setting support method, and non-transitory computer-readable media

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190624

A871 Explanation of circumstances concerning accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A871

Effective date: 20190624

TRDD Decision of grant or rejection written
A975 Report on accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A971005

Effective date: 20190909

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20190917

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20191015

R150 Certificate of patent or registration of utility model

Ref document number: 6605180

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250