JP7051416B2 - 自己位置推定装置 - Google Patents
自己位置推定装置 Download PDFInfo
- Publication number
- JP7051416B2 JP7051416B2 JP2017241524A JP2017241524A JP7051416B2 JP 7051416 B2 JP7051416 B2 JP 7051416B2 JP 2017241524 A JP2017241524 A JP 2017241524A JP 2017241524 A JP2017241524 A JP 2017241524A JP 7051416 B2 JP7051416 B2 JP 7051416B2
- Authority
- JP
- Japan
- Prior art keywords
- information
- self
- normal
- normal map
- map information
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 claims description 30
- 239000013598 vector Substances 0.000 claims description 16
- 230000008569 process Effects 0.000 claims description 14
- 230000002093 peripheral effect Effects 0.000 claims description 12
- 238000013500 data storage Methods 0.000 description 9
- 238000004891 communication Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000002776 aggregation Effects 0.000 description 1
- 238000004220 aggregation Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000005192 partition Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
(1)地面に対して平行な法線は削除する。
(2)1ピクセルのグリッドに1つの法線しかない場合は、その法線のベクトルをそのまま格納する。
(3)1ピクセルのグリッドに複数の法線が存在する場合はそれらの法線ベクトルの平均値を格納する。
(4)1ピクセルのグリッドに1つも法線が無い場合は、一旦無視して次のピクセルの処理を行う。
(5)全てのピクセルについて、上記(1)~(4)の処理が終了した後、法線ベクトル値が格納されていないピクセルに対し、当該ピクセルに隣接する周囲8ピクセルを検索し有効ピクセル(既に解をもつ=法線ベクトル値が格納されている)があればそれらの平均値を格納する。
(6)(5)の方法で法線ベクトルが求められない場合は徐々に探索範囲を拡張していく。
(7)(6)の方法で全ピクセルを探索しても法線ベクトルが求められない場合はそのピクセルは「解なし」という値、例えば(0,0,0)等の所定値を格納する。
3 車両制御装置(地図データ記憶装置、自己位置推定装置)
4 センサ(ライダ)
13 記憶部
13a 地図データ(第1法線マップ情報)
31 制御部(第2取得部、生成部、照合部、推定部、位置情報取得部)
32 通信部(第1取得部)
33 記憶部(地図データ記憶装置)
33a 地図データ(第1法線マップ情報)
S101 ライダ点群情報取得(第2取得工程)
S104 生成工程(生成工程)
S105 経緯度から周辺の法線マップ画像を推定(第1取得工程)
S106 法線マップのマッチング処理(照合工程)
S107 推定処理(推定工程)
Claims (5)
- 第1法線マップ情報を取得する第1取得部と、
車両の周辺情報を取得する第2取得部と、
前記周辺情報をポリゴン化し、ポリゴン毎に法線を求め、前記ポリゴン毎の前記法線を示す法線ベクトルを含む第2法線マップ情報を生成する生成部と、
前記第1法線マップ情報と前記第2法線マップ情報とを照合する照合部と、
前記照合の結果に基づいて自己位置を推定する推定部と、
を備えることを特徴とする自己位置推定装置。 - 前記周辺情報は、ライダで得られた点群情報であることを特徴とする請求項1に記載の自己位置推定装置。
- 前記車両の位置情報を取得する位置情報取得部をさらに備え、
前記第1取得部は、前記位置情報に基づいて必要な領域の前記第1法線マップ情報を取得することを特徴とする請求項1または請求項2に記載の自己位置推定装置。 - 車両の自己位置を推定する自己位置推定装置で実行される自己位置推定方法であって、
第1法線マップ情報を取得する第1取得工程と、
車両の周辺情報を取得する第2取得工程と、
前記周辺情報をポリゴン化し、ポリゴン毎に法線を求め、前記ポリゴン毎の前記法線を示す法線ベクトルを含む第2法線マップ情報を生成する生成工程と、
前記第1法線マップ情報と前記第2法線マップ情報とを照合する照合工程と、
前記照合の結果に基づいて自己位置を推定する推定工程と、
を含むことを特徴とする自己位置推定方法。 - 請求項4に記載の自己位置推定方法を、コンピュータにより実行させることを特徴とする自己位置推定プログラム。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017241524A JP7051416B2 (ja) | 2017-12-18 | 2017-12-18 | 自己位置推定装置 |
JP2022056622A JP7216233B2 (ja) | 2017-12-18 | 2022-03-30 | 自己位置推定装置および車両位置推定システム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017241524A JP7051416B2 (ja) | 2017-12-18 | 2017-12-18 | 自己位置推定装置 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2022056622A Division JP7216233B2 (ja) | 2017-12-18 | 2022-03-30 | 自己位置推定装置および車両位置推定システム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019109653A JP2019109653A (ja) | 2019-07-04 |
JP7051416B2 true JP7051416B2 (ja) | 2022-04-11 |
Family
ID=67179816
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017241524A Active JP7051416B2 (ja) | 2017-12-18 | 2017-12-18 | 自己位置推定装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7051416B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114008409B (zh) | 2019-06-12 | 2024-08-20 | 株式会社电装 | 地图数据生成装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009193240A (ja) | 2008-02-13 | 2009-08-27 | Toyota Motor Corp | 移動ロボット及び環境地図の生成方法 |
JP2011008320A (ja) | 2009-06-23 | 2011-01-13 | Toyota Motor Corp | 自律移動体、自己位置推定装置、およびプログラム |
CN103123727A (zh) | 2011-11-21 | 2013-05-29 | 联想(北京)有限公司 | 即时定位与地图构建方法和设备 |
JP2017151148A (ja) | 2016-02-22 | 2017-08-31 | Necプラットフォームズ株式会社 | 位置推定装置、位置検出方法及びプログラム |
-
2017
- 2017-12-18 JP JP2017241524A patent/JP7051416B2/ja active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009193240A (ja) | 2008-02-13 | 2009-08-27 | Toyota Motor Corp | 移動ロボット及び環境地図の生成方法 |
JP2011008320A (ja) | 2009-06-23 | 2011-01-13 | Toyota Motor Corp | 自律移動体、自己位置推定装置、およびプログラム |
CN103123727A (zh) | 2011-11-21 | 2013-05-29 | 联想(北京)有限公司 | 即时定位与地图构建方法和设备 |
JP2017151148A (ja) | 2016-02-22 | 2017-08-31 | Necプラットフォームズ株式会社 | 位置推定装置、位置検出方法及びプログラム |
Also Published As
Publication number | Publication date |
---|---|
JP2019109653A (ja) | 2019-07-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7082545B2 (ja) | 情報処理方法、情報処理装置およびプログラム | |
US11113544B2 (en) | Method and apparatus providing information for driving vehicle | |
US9933268B2 (en) | Method and system for improving accuracy of digital map data utilized by a vehicle | |
JP6595182B2 (ja) | マッピング、位置特定、及び姿勢補正のためのシステム及び方法 | |
KR20200023865A (ko) | 차선 결정 방법 및 장치 | |
US20170359561A1 (en) | Disparity mapping for an autonomous vehicle | |
JP2017519973A (ja) | デジタル地図に対する位置を決定する方法およびシステム | |
EP3671623B1 (en) | Method, apparatus, and computer program product for generating an overhead view of an environment from a perspective image | |
JP6776707B2 (ja) | 自車位置推定装置 | |
JP7289470B2 (ja) | 三次元空間に対応するマップを生成する車両、及びその方法 | |
JP7293344B2 (ja) | 教師なし機械学習による道路オブジェクトの位置特定のためのシステムおよび方法 | |
US12061252B2 (en) | Environment model using cross-sensor feature point referencing | |
KR20180066618A (ko) | 자율주행차량을 위한 거리 데이터와 3차원 스캔 데이터의 정합 방법 및 그 장치 | |
JP2023541424A (ja) | 車両位置決定方法および車両位置決定装置 | |
US11315269B2 (en) | System and method for generating a point cloud that includes surface normal information | |
JP7051416B2 (ja) | 自己位置推定装置 | |
JP7234840B2 (ja) | 位置推定装置 | |
CN112712563A (zh) | 相机取向估计 | |
JP7216233B2 (ja) | 自己位置推定装置および車両位置推定システム | |
KR20130041698A (ko) | 무인 차량의 주행 정보 생성 장치, 이를 구비하는 무인 차량 및 그것의 제어 방법 | |
JP7251918B2 (ja) | 車両位置推定装置及び車両位置推定システム | |
JP2020101924A (ja) | 情報処理システム、プログラム、及び情報処理方法 | |
JP2019109332A (ja) | 地図データ構造 | |
JP6916438B2 (ja) | 動線特定システム、サーバ装置、端末装置、動線特定方法、及び動線特定プログラム | |
JP2018096935A (ja) | 自車位置推定装置、プログラム、記録媒体、および自車位置推定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20201029 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210720 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210721 |
|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A712 Effective date: 20210827 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20210916 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210917 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20211217 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20220315 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220330 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7051416 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |