JP7414683B2 - 自車位置推定装置及び自車位置推定方法 - Google Patents
自車位置推定装置及び自車位置推定方法 Download PDFInfo
- Publication number
- JP7414683B2 JP7414683B2 JP2020163726A JP2020163726A JP7414683B2 JP 7414683 B2 JP7414683 B2 JP 7414683B2 JP 2020163726 A JP2020163726 A JP 2020163726A JP 2020163726 A JP2020163726 A JP 2020163726A JP 7414683 B2 JP7414683 B2 JP 7414683B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- map
- information
- road
- correction
- 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 title description 26
- 238000012937 correction Methods 0.000 claims description 76
- 238000012887 quadratic function Methods 0.000 claims description 3
- 230000004927 fusion Effects 0.000 description 32
- 238000004364 calculation method Methods 0.000 description 12
- 238000010586 diagram Methods 0.000 description 11
- 238000012545 processing Methods 0.000 description 7
- 238000001514 detection method Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 230000001133 acceleration Effects 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 238000013459 approach Methods 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000000717 retained effect 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
- G09—EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
- G09B—EDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
- G09B29/00—Maps; Plans; Charts; Diagrams, e.g. route diagram
- G09B29/10—Map spot or coordinate position indicators; Map reading aids
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Business, Economics & Management (AREA)
- Educational Administration (AREA)
- Educational Technology (AREA)
- Navigation (AREA)
- Instructional Devices (AREA)
Description
本実施例では、本発明である自車位置推定装置を自動運転車両に組み込んだ場合の構成について説明する。
自動運転車両200は、慣性センサ101と、車両情報102と、GNSS103と、カメラ104と、地図105と、周囲センサ106と、ナビゲーションシステム107と、自車位置推定装置100と、走行経路演算装置201と、車両制御装置202を有している。慣性センサ101は、車両に作用する加速度や角速度などを検知する加速度センサやジャイロセンサを含み、自車挙動の変化を計測する。車両情報102は、車両の車輪回転数や操舵角などの情報を含み、慣性センサ101の出力と合わせて自律航法位置を演算することができる。GNSS103は、GPS等の測位衛星からの電波に基づいて例えば地球座標上の絶対位置を計測し、測位位置として取得する。カメラ104は、車両の周囲を撮像し、画像処理により走行レーンに対する自車の走行状態を計測することができる。地図105には、自車が通行可能な道路の情報を含む地図情報が記憶されている。周囲センサ106は、例えばレーザやLidar、ミリ波レーダなどを含み、自車の周囲の障害物や道路の状況等の周囲情報を検出する。ナビゲーションシステム107は、目標位置に案内するための経路情報を作成する。慣性センサ101の出力と、車両情報102は、特許請求の範囲の第一のセンサ情報に対応する。GNSS103により計測される絶対位置の情報は、特許請求の範囲の第二のセンサ情報に対応する。そして、カメラ104で撮像された画像の情報は、特許請求の範囲の第三のセンサ情報に対応する。
図1は、自車位置推定装置100の構成図である。
図5は、本実施例に対する比較例を説明する模式図であり、GNSS非測位時に地図上の推定自車位置による補正を実施せずに自車位置の推定を行った場合の例を示す図である。
図3は、本実施形態の自車位置推定装置を用いた自車位置推定方法を説明するフローチャートである。
本実施例では、実施例1の構成に対してカメラからの情報をより多く採用した補正方法について説明する。本実施例では、実施例1との差分について記載し、重複する部分については説明を省略する。
自車位置推定を開始(S301)すると、GNSS103の測位情報が現在使用可能な状態かを判断する(S302)。GNSS103の測位情報が使用可能な状態であった場合は、GNSS測位位置を用いたセンサ融合(S303)を実施する。その後、地図上自車位置の推定を実施し(S307)、自車位置推定を終了する(S308)。
Claims (1)
- 1もしくは複数のセンサを組み合わせることにより自車挙動の変化を計測可能な第一のセンサ情報と、
自車の絶対位置を計測可能な第二のセンサ情報と、
1もしくは複数のセンサを組み合わせることにより走行レーンに対する前記自車の走行状態が計測可能な第三のセンサ情報と、
車両が走行可能な道路の地図情報と、を用いて、
前記自車が走行している地図上の自車位置を推定する自車位置推定装置であって、
前記第二のセンサ情報を使用可能なものである場合に、前記第一のセンサ情報と前記第二のセンサ情報と前記地図情報とを用いて前記地図上の自車位置を推定し、
前記第二のセンサ情報が使用不可能なものである場合に、前記第三のセンサ情報もしくは直前に推定した前記地図上の自車位置が所定の状況であったときは、
前記地図上の自車位置と、前記第三のセンサにより認識した前記走行レーンの車両区画線の形状変化を示す2次関数に基づいて、前記走行レーンの中心線から前記自車が横方向に平行にずれたずれ量と、前記走行レーンの進行方位と前記自車進行方位との差を算出して、前記地図上の自車位置及び進行方位を補正し、該補正後の前記地図上の自車位置と前記第一のセンサ情報と前記第三のセンサ情報を用いて前記地図上の自車位置を推定することを特徴とする自車位置推定装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020163726A JP7414683B2 (ja) | 2020-09-29 | 2020-09-29 | 自車位置推定装置及び自車位置推定方法 |
CN202180040548.7A CN115917253A (zh) | 2020-09-29 | 2021-02-24 | 自身车辆位置推断装置及自身车辆位置推断方法 |
US18/008,857 US20230221126A1 (en) | 2020-09-29 | 2021-02-24 | Vehicle position estimation device and vehicle position estimation method |
PCT/JP2021/006915 WO2022070458A1 (ja) | 2020-09-29 | 2021-02-24 | 自車位置推定装置及び自車位置推定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020163726A JP7414683B2 (ja) | 2020-09-29 | 2020-09-29 | 自車位置推定装置及び自車位置推定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2022055979A JP2022055979A (ja) | 2022-04-08 |
JP7414683B2 true JP7414683B2 (ja) | 2024-01-16 |
Family
ID=80950072
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020163726A Active JP7414683B2 (ja) | 2020-09-29 | 2020-09-29 | 自車位置推定装置及び自車位置推定方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20230221126A1 (ja) |
JP (1) | JP7414683B2 (ja) |
CN (1) | CN115917253A (ja) |
WO (1) | WO2022070458A1 (ja) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006189325A (ja) | 2005-01-06 | 2006-07-20 | Aisin Aw Co Ltd | 車両の現在地情報管理装置 |
JP2008267875A (ja) | 2007-04-17 | 2008-11-06 | Hitachi Ltd | デジタル道路地図の生成方法及び地図生成システム |
JP2019002764A (ja) | 2017-06-14 | 2019-01-10 | 本田技研工業株式会社 | 車両位置判定装置 |
-
2020
- 2020-09-29 JP JP2020163726A patent/JP7414683B2/ja active Active
-
2021
- 2021-02-24 US US18/008,857 patent/US20230221126A1/en active Pending
- 2021-02-24 CN CN202180040548.7A patent/CN115917253A/zh active Pending
- 2021-02-24 WO PCT/JP2021/006915 patent/WO2022070458A1/ja active Application Filing
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006189325A (ja) | 2005-01-06 | 2006-07-20 | Aisin Aw Co Ltd | 車両の現在地情報管理装置 |
JP2008267875A (ja) | 2007-04-17 | 2008-11-06 | Hitachi Ltd | デジタル道路地図の生成方法及び地図生成システム |
JP2019002764A (ja) | 2017-06-14 | 2019-01-10 | 本田技研工業株式会社 | 車両位置判定装置 |
Also Published As
Publication number | Publication date |
---|---|
CN115917253A (zh) | 2023-04-04 |
US20230221126A1 (en) | 2023-07-13 |
WO2022070458A1 (ja) | 2022-04-07 |
JP2022055979A (ja) | 2022-04-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6693496B2 (ja) | 自己位置推定装置 | |
US9283967B2 (en) | Accurate curvature estimation algorithm for path planning of autonomous driving vehicle | |
US8200424B2 (en) | Navigation device | |
CN111721285B (zh) | 在自动代客泊车***中用于估计位置的设备及方法 | |
CN111066071B (zh) | 驾驶辅助车辆的位置误差校正方法及位置误差校正装置 | |
EP2333484B1 (en) | Lane determining device and navigation system | |
KR101750186B1 (ko) | 차량 위치 추정 기기 및 차량 위치 추정 방법 | |
JP5747787B2 (ja) | 車線認識装置 | |
JP4752669B2 (ja) | 車両同定装置、位置算出装置 | |
WO2018179616A1 (ja) | 車両位置推定装置 | |
US10794709B2 (en) | Apparatus of compensating for a sensing value of a gyroscope sensor, a system having the same, and a method thereof | |
WO2018168956A1 (ja) | 自己位置推定装置 | |
CN111845740A (zh) | 动态偏航角速率偏差估计的方法和装置 | |
JP6521753B2 (ja) | 車両の測位システム | |
KR20190040818A (ko) | 차량 내부 센서, 카메라, 및 gnss 단말기를 이용한 3차원 차량 항법 시스템 | |
JP2019066193A (ja) | 自車位置検出装置 | |
JP6943127B2 (ja) | 位置補正方法、車両制御方法及び位置補正装置 | |
JP6539129B2 (ja) | 自車位置推定装置、及びそれを用いた操舵制御装置、並びに自車位置推定方法 | |
JP6836446B2 (ja) | 車両の走行車線推定装置 | |
CN113165661A (zh) | 用于确定车辆的修正轨迹的方法和*** | |
JP2019060814A (ja) | 自動運転の自車位置検出装置 | |
US9395448B2 (en) | Information indication apparatus | |
JP7414683B2 (ja) | 自車位置推定装置及び自車位置推定方法 | |
JP6948151B2 (ja) | 走行車線特定装置 | |
JP7378591B2 (ja) | 走行経路生成装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20220606 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20230309 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230718 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230912 |
|
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: 20231205 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20231228 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7414683 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |