JP2022129719A - 地図生成装置 - Google Patents
地図生成装置 Download PDFInfo
- Publication number
- JP2022129719A JP2022129719A JP2021028504A JP2021028504A JP2022129719A JP 2022129719 A JP2022129719 A JP 2022129719A JP 2021028504 A JP2021028504 A JP 2021028504A JP 2021028504 A JP2021028504 A JP 2021028504A JP 2022129719 A JP2022129719 A JP 2022129719A
- Authority
- JP
- Japan
- Prior art keywords
- map
- vehicle
- lane
- unit
- camera
- 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
Links
- 238000001514 detection method Methods 0.000 claims description 33
- 230000009471 action Effects 0.000 description 15
- 230000007613 environmental effect Effects 0.000 description 15
- 238000004891 communication Methods 0.000 description 13
- 230000001133 acceleration Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 8
- 238000000034 method Methods 0.000 description 6
- 238000012545 processing Methods 0.000 description 6
- 230000006870 function Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 238000012986 modification Methods 0.000 description 4
- 230000004048 modification Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 238000003384 imaging method Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 239000000284 extract Substances 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 238000002485 combustion reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000001771 impaired effect Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000004065 semiconductor Substances 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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3807—Creation or updating of map data characterised by the type of data
- G01C21/3815—Road data
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- 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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3833—Creation or updating of map data characterised by the source of data
- G01C21/3848—Data obtained from both position sensors and additional sensors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0004—In digital systems, e.g. discrete-time systems involving sampling
- B60W2050/0005—Processor details or data handling, e.g. memory registers or chip architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/40—High definition maps
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- General Physics & Mathematics (AREA)
- Human Computer Interaction (AREA)
- Mathematical Physics (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
- Instructional Devices (AREA)
Abstract
【課題】自車両が走行していない車線の地図の生成を効率的に行う。【解決手段】地図生成装置50は、自車両の周囲の外部状況を検出するカメラ1aと、自車両が第1車線を走行するときにカメラ1aにより検出された外部状況に基づいて往路地図を生成する往路地図生成部171と、カメラ1aにより取得された第2車線についてのカメラ画像または往路地図を第2車線側に反転することにより、第1車線に対向する第2車線についての復路地図を生成する復路地図生成部172と、を備える。【選択図】図3
Description
本発明は、自車両の周辺の地図を生成する地図生成装置に関する。
従来より、車両に搭載されたカメラにより撮像された画像を利用して、自車両の走行車線における白線や駐車場枠の白線を認識し、これらの白線の認識結果を車両の走行制御や駐車支援に利用するようにした装置が知られている(例えば特許文献1参照)。特許文献1記載の装置では、撮像された画像の輝度の変化が閾値以上であるエッジ点を抽出し、エッジ点に基づいて白線を認識する。
上記特許文献1記載の装置では、自車両が実際に走行した車線について白線の認識が行われる。したがって、白線の位置情報を含む地図を生成するためには、自車両が各車線を実際に走行する必要があり、地図生成を効率的に行うことが困難である。
本発明の一態様である地図生成装置は、自車両の周囲の外部状況を検出する検出部と、検出部により検出された外部状況に基づいて、自車両が走行する自車線についての第1地図と自車線に対向する対向車線についての第2地図とを同時に生成する地図生成部と、を備える。
本発明によれば、自車両が走行していない車線についての地図も作成することができ、地図作成を効率的に行うことができる。
以下、図1~図5を参照して本発明の実施形態について説明する。本発明の実施形態に係る地図生成装置は、例えば自動運転機能を有する車両、すなわち自動運転車両に搭載される。なお、本実施形態に係る地図生成装置が搭載される車両を、他車両と区別して自車両と呼ぶことがある。自車両は、内燃機関(エンジン)を走行駆動源として有するエンジン車両、走行モータを走行駆動源として有する電気自動車、エンジンと走行モータとを走行駆動源として有するハイブリッド車両のいずれであってもよい。自車両は、ドライバによる運転操作が不要な自動運転モードでの走行だけでなく、ドライバの運転操作による手動運転モードでの走行も可能である。
まず、自動運転に係る自車両の概略構成について説明する。図1は、本発明の実施形態に係る地図生成装置を有する自車両の車両制御システム100の全体構成を概略的に示すブロック図である。図1に示すように、車両制御システム100は、コントローラ10と、コントローラ10にそれぞれ通信可能に接続された外部センサ群1と、内部センサ群2と、入出力装置3と、測位ユニット4と、地図データベース5と、ナビゲーション装置6と、通信ユニット7と、走行用のアクチュエータACとを主に有する。
外部センサ群1は、自車両の周辺情報である外部状況を検出する複数のセンサ(外部センサ)の総称である。例えば外部センサ群1には、自車両の全方位の照射光に対する散乱光を測定して自車両から周辺の障害物までの距離を測定するライダ、電磁波を照射し反射波を検出することで自車両の周辺の他車両や障害物等を検出するレーダ、自車両に搭載され、CCDやCMOS等の撮像素子を有して自車両の周辺(前方、後方および側方)を撮像するカメラなどが含まれる。
内部センサ群2は、自車両の走行状態を検出する複数のセンサ(内部センサ)の総称である。例えば内部センサ群2には、自車両の車速を検出する車速センサ、自車両の前後方向の加速度および左右方向の加速度(横加速度)をそれぞれ検出する加速度センサ、走行駆動源の回転数を検出する回転数センサ、自車両の重心の鉛直軸回りの回転角速度を検出するヨーレートセンサなどが含まれる。手動運転モードでのドライバの運転操作、例えばアクセルペダルの操作、ブレーキペダルの操作、ステアリングホイールの操作等を検出するセンサも内部センサ群2に含まれる。
入出力装置3は、ドライバから指令が入力されたり、ドライバに対し情報が出力されたりする装置の総称である。例えば入出力装置3には、操作部材の操作によりドライバが各種指令を入力する各種スイッチ、ドライバが音声で指令を入力するマイク、ドライバに表示画像を介して情報を提供するディスプレイ、ドライバに音声で情報を提供するスピーカなどが含まれる。
測位ユニット(GNSSユニット)4は、測位衛星から送信された測位用の信号を受信する測位センサを有する。測位衛星は、GPS衛星や準天頂衛星などの人工衛星である。測位ユニット4は、測位センサが受信した測位情報を利用して、自車両の現在位置(緯度、経度、高度)を測定する。
地図データベース5は、ナビゲーション装置6に用いられる一般的な地図情報を記憶する装置であり、例えば磁気ディスクや半導体素子により構成される。地図情報には、道路の位置情報、道路形状(曲率など)の情報、交差点や分岐点の位置情報が含まれる。なお、地図データベース5に記憶される地図情報は、コントローラ10の記憶部12に記憶される高精度な地図情報とは異なる。
ナビゲーション装置6は、ドライバにより入力された目的地までの道路上の目標経路を探索するとともに、目標経路に沿った案内を行う装置である。目的地の入力および目標経路に沿った案内は、入出力装置3を介して行われる。目標経路は、測位ユニット4により測定された自車両の現在位置と、地図データベース5に記憶された地図情報とに基づいて演算される。外部センサ群1の検出値を用いて自車両の現在位置を測定することもでき、この現在位置と記憶部12に記憶される高精度な地図情報とに基づいて目標経路を演算するようにしてもよい。
通信ユニット7は、インターネット網や携帯電話網倒に代表される無線通信網を含むネットワークを介して図示しない各種サーバと通信し、地図情報、走行履歴情報および交通情報などを定期的に、あるいは任意のタイミングでサーバから取得する。走行履歴情報を取得するだけでなく、通信ユニット7を介して自車両の走行履歴情報をサーバに送信するようにしてもよい。ネットワークには、公衆無線通信網だけでなく、所定の管理地域ごとに設けられた閉鎖的な通信網、例えば無線LAN、Wi-Fi(登録商標)、Bluetooth(登録商標)等も含まれる。取得した地図情報は、地図データベース5や記憶部12に出力され、地図情報が更新される。
アクチュエータACは、自車両の走行を制御するための走行用アクチュエータである。走行駆動源がエンジンである場合、アクチュエータACには、エンジンのスロットルバルブの開度(スロットル開度)を調整するスロットル用アクチュエータが含まれる。走行駆動源が走行モータである場合、走行モータがアクチュエータACに含まれる。自車両の制動装置を作動するブレーキ用アクチュエータと転舵装置を駆動する転舵用アクチュエータもアクチュエータACに含まれる。
コントローラ10は、電子制御ユニット(ECU)により構成される。より具体的には、コントローラ10は、CPU(マイクロプロセッサ)等の演算部11と、ROM,RAM等の記憶部12と、I/Oインターフェース等の図示しないその他の周辺回路とを有するコンピュータを含んで構成される。なお、エンジン制御用ECU、走行モータ制御用ECU、制動装置用ECU等、機能の異なる複数のECUを別々に設けることができるが、図1では、便宜上、これらECUの集合としてコントローラ10が示される。
記憶部12には、自動走行用の高精度の詳細な道路地図情報が記憶される。道路地図情報には、道路の位置情報、道路形状(曲率など)の情報、道路の勾配の情報、交差点や分岐点の位置情報、白線などの区画線の種別やその位置情報、車線数の情報、車線の幅員および車線毎の位置情報(車線の中央位置や車線位置の境界線の情報)、地図上の目印としてのランドマーク(信号機、標識、建物等)の位置情報、路面の凹凸などの路面プロファイルの情報が含まれる。記憶部12に記憶される地図情報には、通信ユニット7を介して取得した自車両の外部から取得した地図情報(外部地図情報と呼ぶ)と、外部センサ群1の検出値あるいは外部センサ群1と内部センサ群2との検出値を用いて自車両自体で作成される地図情報(内部地図情報と呼ぶ)とが含まれる。
外部地図情報は、例えばクラウドサーバを介して取得した地図(クラウド地図と呼ぶ)の情報であり、内部地図情報は、例えばSLAM(Simultaneous Localization and Mapping)等の技術を用いてマッピングにより生成される点群データからなる地図(環境地図と呼ぶ)の情報である。外部地図情報は、自車両と他車両とで共有されるのに対し、内部地図情報は、自車両の独自の地図情報(例えば自車両が単独で有する地図情報)である。新設された道路等、外部地図情報が存在しない領域においては、自車両自らによって環境地図が作成される。なお、内部地図情報を、通信ユニット7を介してサーバ装置や他車両に提供するようにしてもよい。記憶部12には、各種制御のプログラム、プログラムで用いられる閾値等の情報についての情報も記憶される。
演算部11は、機能的構成として、自車位置認識部13と、外界認識部14と、行動計画生成部15と、走行制御部16と、地図生成部17とを有する。
自車位置認識部13は、測位ユニット4で得られた自車両の位置情報および地図データベース5の地図情報に基づいて、地図上の自車両の位置(自車位置)を認識する。記憶部12に記憶された地図情報と、外部センサ群1が検出した自車両の周辺情報とを用いて自車位置を認識してもよく、これにより自車位置を高精度に認識することができる。内部センサ群2の検出値に基づいて自車両の移動情報(移動方向、移動距離)を算出し、これにより自車両の位置を認識することもできる。なお、道路上や道路脇の外部に設置されたセンサで自車位置を測定可能であるとき、そのセンサと通信ユニット7を介して通信することにより、自車位置を認識することもできる。
外界認識部14は、ライダ、レーダ、カメラ等の外部センサ群1からの信号に基づいて自車両の周囲の外部状況を認識する。例えば自車両の周辺を走行する周辺車両(前方車両や後方車両)の位置や速度や加速度、自車両の周囲に停車または駐車している周辺車両の位置、および他の物体の位置や状態などを認識する。他の物体には、標識、信号機、道路、建物、ガードレール、電柱、看板、歩行者、自転車等が含まれる。路面上の区画線(白線など)や停止線等の標示も他の物体(道路)に含まれる。他の物体の状態には、信号機の色(赤、青、黄)、歩行者や自転車の移動速度や向きなどが含まれる。他の物体のうち静止している物体の一部は、地図上の位置の指標となるランドマークを構成し、外界認識部14は、ランドマークの位置と種別も認識する。
行動計画生成部15は、例えばナビゲーション装置6で演算された目標経路と、記憶部12に記憶された地図情報と、自車位置認識部13で認識された自車位置と、外界認識部14で認識された外部状況とに基づいて、現時点から所定時間先までの自車両の走行軌道(目標軌道)を生成する。目標経路上に目標軌道の候補となる複数の軌道が存在するときには、行動計画生成部15は、その中から法令を順守し、かつ効率よく安全に走行する等の基準を満たす最適な軌道を選択し、選択した軌道を目標軌道とする。そして、行動計画生成部15は、生成した目標軌道に応じた行動計画を生成する。行動計画生成部15は、先行車両を追い越すための追い越し走行、走行車線を変更する車線変更走行、先行車両に追従する追従走行、走行車線を逸脱しないように車線を維持するレーンキープ走行、減速走行または加速走行等に対応した種々の行動計画を生成する。行動計画生成部15は、目標軌道を生成する際に、まず走行態様を決定し、走行態様に基づいて目標軌道を生成する。
走行制御部16は、自動運転モードにおいて、行動計画生成部15で生成された目標軌道に沿って自車両が走行するように各アクチュエータACを制御する。より具体的には、走行制御部16は、自動運転モードにおいて道路勾配などにより定まる走行抵抗を考慮して、行動計画生成部15で算出された単位時間毎の目標加速度を得るための要求駆動力を算出する。そして、例えば内部センサ群2により検出された実加速度が目標加速度となるようにアクチュエータACをフィードバック制御する。すなわち、自車両が目標車速および目標加速度で走行するようにアクチュエータACを制御する。なお、手動運転モードでは、走行制御部16は、内部センサ群2により取得されたドライバからの走行指令(ステアリング操作等)に応じて各アクチュエータACを制御する。
地図生成部17は、手動運転モードで走行しながら、外部センサ群1により検出された検出値を用いて、3次元の点群データからなる環境地図を生成する。具体的には、カメラにより取得されたカメラ画像から、画素ごとの輝度や色の情報に基づいて物体の輪郭を示すエッジを抽出するとともに、そのエッジ情報を用いて特徴点を抽出する。特徴点は例えばエッジの点やエッジの交点であり、路面上の区画線、建物の角、道路標識の角などに対応する。地図生成部17は、抽出された特徴点までの距離を求めて、特徴点を順次、環境地図上にプロットし、これにより自車両が走行した道路周辺の環境地図が生成される。カメラに代えて、レーダやライダにより取得されたデータを用いて自車両の周囲の物体の特徴点を抽出し、環境地図を生成するようにしてもよい。
自車位置認識部13は、地図生成部17による地図生成処理と並行して、自車両の位置推定処理を行う。すなわち、特徴点の時間経過に伴う位置の変化に基づいて、自車両の位置を推定する。地図作成処理と位置推定処理とは、例えばカメラやライダからの信号を用いてSLAMのアルゴリズムにしたがって同時に行われる。地図生成部17は、手動運転モードで走行するときだけでなく、自動運転モードで走行するときにも同様に環境地図を生成することができる。既に環境地図が生成されて記憶部12に記憶されている場合、地図生成部17は、新たに得られた特徴点により環境地図を更新してもよい。
本実施形態に係る地図生成装置の構成について説明する。図2Aは、本実施形態に係る地図生成装置が適用される走行シーンの一例を示す図であり、手動運転モードで環境地図を生成しながら自車両101が走行するシーン、すなわち左右の区画線L1,L2によって規定された自車線(第1車線LN1)を走行するシーンを示す。図2Aには、自車線に対向する対向車線、すなわち左右の区画線L2,L3によって規定された対向車線(第2車線LN2)を他車両102が走行するシーンを併せて示す。なお、自車両101が第1車線LN1に沿って目的地まで走行した後、第2車線LN2に沿って戻ることを想定し、第1車線LN1を往路と呼び、第2車線LN2を復路と呼ぶこともある。
図2Aに示すように、自車両101の前部にはカメラ1aが搭載される。カメラ1aは、カメラ自体の性能によって定まる固有の視野角θと、最大検知距離rとを有する。カメラ1aを中心とする半径rかつ中心角θの扇形の範囲AR1の内側が、カメラ1aにより検出可能な外部空間の範囲、すなわち検出可能範囲AR1となる。この検出可能範囲AR1には、例えば複数の区画線(例えば白線)L1~L3が含まれる。すなわち、自車線の区画線L1,L2だけでなく、対向車線の区画線L2,L3も含まれる。なお、カメラ1aの視野角の一部がカメラ1aの周囲に配置された部品の存在によって遮られる場合、検出可能範囲AR1が図示のものと異なる場合がある。
図2Bは、本実施形態に係る地図生成装置が適用される走行シーンの他の例を示す図である。図2Bに示すように、第1車線LN1と第2車線LN2との間には、車線LN1,LN2の境界で示す境界線L0に沿って、自車両101のカメラ1aによる撮像を妨げるような障害物103が配置される。障害物103は、例えば樹木や、中央分離帯、ガードレール、看板などである。障害物103が配置されることにより、検出可能範囲AR1のうち、ハッチングで示す点線の範囲AR2のカメラ画像を取得することが不能となる。
なお、図2Bでは、区画線L2が境界線L0と一致しているが、実際には区画線L2と境界線L0とが一致していると限らない。境界線L0は、第1車線LN1の車幅方向中心を通って第1車線LN1に沿って延在する第1中心線LN1aと、第2車線LN2の車幅方向中心を通って第2車線LN2に沿って延在する第2中心線LN2aとの中央に位置する。したがって、例えば中央分離帯がある道路においては、第1車線LN1の車幅方向内側(中央分離帯側)の区画線と第2車線LN2の車幅方向内側(中央分離帯側)の区画線との間に境界線L0があり、区画線L2と境界線L0とは異なる。図2A,図2Bでは、往路と復路とがそれぞれ単一の車線LN1,LN2により構成される例を示すが、往路と復路の両方が複数の車線により構成されることもある。この場合、車幅方向の最も内側の往路の車線と復路の車線との間に境界線L0が存在する。
このような走行シーンにおいて、自車両101が自車線を走行しながら取得したカメラ画像からエッジ点を抽出することにより、検出可能範囲AR1に含まれる自車線(第1車線LN1)の地図を生成することができる。一方、対向車線(第2車線LN2)の地図を生成するために、自車両101が対向車線を走行しなければならないとすると、地図生成を効率的に行うことが困難である。そこで、自車線と対向車線の双方の地図を効率よく生成することができるよう、本実施形態は以下のように地図生成装置を構成する。
図3は、本実施形態に係る地図生成装置50の要部構成を示すブロック図である。この地図生成装置50は、図1の車両制御システム100の一部を構成する。図3に示すように、地図生成装置50は、コントローラ10と、カメラ1aと、センサ2aとを有する。
カメラ1aは、CCDやCMOS等の撮像素子(イメージセンサ)を有する単眼カメラであり、図1の外部センサ群1の一部を構成する。カメラ1aはステレオカメラであってもよい。カメラ1aは、例えば自車両101の前部の所定位置に取り付けられ(図2A)、自車両101の前方空間を連続的に撮像して対象物の画像(カメラ画像)を取得する。対象物には、道路上の区画線(例えば図2Aの区画線L1~L3)が含まれる。なお、カメラ1aに代えて、あるいはカメラ1aとともに、ライダなどにより対象物を検出するようにしてもよい。
センサ2aは、自車両101の移動量と移動方向とを算出するために用いられる検出器である。センサ2aは、内部センサ群2の一部であり、例えば車速センサとヨーレートセンサとにより構成される。すなわち、コントローラ10(例えば図1の自車位置認識部13)は、車速センサにより検出された車速を積分して自車両101の移動量を算出するとともに、ヨーレートセンサにより検出されたヨーレートを積分してヨー角を算出し、オドメトリにより自車両101の位置を推定する。例えば手動運転モードでの走行時に、環境地図を作成する際にオドメトリにより自車位置を推定する。なお、センサ2aの構成はこれに限らず、他のセンサの情報を用いて自己位置を推定するようにしてもよい。
図3のコントローラ10は、演算部11(図1)が担う機能的構成として、行動計画生成部15と地図生成部17の他に、精度判定部141を有する。精度判定部141は、外界を認識するために用いられ、図1の外界認識部14の一部を構成する。なお、精度判定部141は、地図生成の機能も有するため、これを地図生成部17に含めることもできる。
精度判定部141は、第1車線LN1の走行時に、カメラ1aにより取得されたカメラ画像に基づいて、第2車線LN2についてのカメラ1aによる検出精度が所定値以上であるか否かを判定する。この判定は、第2車線LN2の区画線L2,L3がカメラ1aの検出可能範囲AR1に含まれるか否かの判定である。例えば図2Aに示すように、境界線L0に障害物が存在しない場合には、第1車線LN1の区画線L1,L2だけでなく第2車線LN2の区画線L2,L3もカメラ1aの検出可能範囲AR1に含まれる。この場合、取得されたカメラ画像には、区画線L2,L3に対応するエッジが認識される。このため、精度判定部141は、検出精度が所定値以上であると判定する。
一方、図2Bに示すように、境界線L0に沿って障害物103が存在する場合、カメラ1aによる撮像が障害物103により遮られ、カメラ1aの検出可能範囲AR1に第2車線LN2の区画線L2,L3が含まれない。この場合、取得されたカメラ画像には、区画線L2,L3に対応するエッジが認識されないため、精度判定部141は、検出精度が所定値未満であると判定する。取得されたカメラ画像における区画線L2,L3のエッジが所定長さ以上認識されたときに、検出精度が所定値以上であると判定してもよい。環境地図には車線LN1,LN2の周囲の建物等の情報も含まれる。したがって、取得されたカメラ画像に、第2車線LN2の周囲の建物等の画像が所定範囲以上含まれないとき、検出精度が所定値未満であると判定してもよい。
地図生成部17は、第1車線LN1である往路の環境地図(往路地図)を生成する往路地図生成部171と、第2車線LN2である復路の環境地図(復路地図)を生成する復路地図生成部172とを有する。往路地図生成部171は、手動運転モードでの往路の走行時に、カメラ1aにより取得されたカメラ画像に基づいて自車両101の周囲の物体(建物や区画線L1,L2等)の特徴点を抽出するとともに、センサ2aにより自車位置を推定し、これにより往路の環境地図を生成する。生成された往路地図は、記憶部12に記憶される。このとき、往路地図生成部171は、カメラ1aの検出可能範囲AR1内の区画線L1,L2(図2A)の位置を認識し、区画線L1,L2の情報を地図情報(例えば内部地図情報)に含めて記憶する。
復路地図生成部172は、手動運転モードでの往路の走行時に、精度判定部141により第2車線LN2についてのカメラ1aによる検出精度が所定値以上であると判定されると、復路の環境地図を生成する。すなわち、この場合には、図2Aに示すように、第2車線LN2の区画線L2,L3が検出可能範囲AR1に含まれるため、カメラ画像に基づいて自車両101の周囲の物体の特徴点を抽出するとともに、センサ2aにより自車位置を推定し、これにより復路の環境地図を生成する。生成された復路地図は、記憶部12に記憶される。このとき、復路地図生成部172は、カメラ1aの検出可能範囲AR1内の区画線L2,L3(図2A)の位置を認識し、区画線L2,L3の情報を地図情報に含めて記憶する。
一方、手動運転モードでの往路の走行時に、精度判定部141により検出精度が所定値未満であると判定されると、復路地図生成部172は、以下のように復路地図を生成する。まず、カメラ画像に基づいて第1車線LN1と第2車線LN2との境界線L0を設定する。次いで、境界線L0を対称軸として、往路の環境地図を対称移動する。すなわち、往路地図をミラーリングにより左右対称に反転させる。換言すると、往路地図とは正反対の方向に、かつ、対称となるように反転させる。これにより、図4Aの点線で示すように、検出可能範囲AR1を対称移動した範囲(ミラーリング範囲と呼ぶ)AR2における、復路の環境地図が得られる。ミラーリング範囲AR2には、第2車線LN2の区画線L2,L3が含まれる。したがって、ミラーリングにより区画線情報を含む地図情報が得られる。この地図情報は、記憶部12に記憶される。
ミラーリングによって得られた復路地図は、実際に第2車線LN2を撮像したことによって得られたものではなく、第1車線LN1と第2車線LN2とが対称であることを前提として予測される地図である。したがって、簡易的な地図であり、仮地図に相当する。復路地図生成部172は、仮地図を生成した後、例えば自車両101が手動運転モードで復路を走行するときに得られたカメラ画像により、仮地図の地図情報を更新する。つまり、図4Bに示すように、ミラーリングにより仮地図が生成されたミラーリング範囲AR2と、復路走行時のカメラ1aの検出可能範囲AR1とは重なるため、復路地図生成部172は、仮地図の地図データに、復路の走行時に得られたカメラ画像による地図データを結合またはマッチングして、地図情報を更新する。更新後の地図情報は、記憶部12に記憶される。
更新後の地図は、復路走行時にカメラ画像によって得られる環境地図に相当するものであり、復路の完全なる環境地図である。但し、復路走行時には、予め復路の仮地図が生成されているので、復路地図を初めから生成する必要がない。このため、効率よく復路地図を生成することができ、コントローラ10の処理負荷を低減することができる。このようにして本実施形態では、往路の環境地図が生成されるとき、復路の環境地図が同時に生成される。
行動計画生成部15は、往路(第1車線LN1)の走行時に得られた復路(第2車線LN2)の環境地図の地図情報を用いて、自車両101が復路を走行するときの目標経路を設定する。走行制御部16(図1)は、この目標経路に沿って自車両101で自動走行するようにアクチュエータACを制御する。これにより、手動運転モードで復路を走行したことがなくても、つまり初めて復路を走行する場合においても、自動運転モードで走行することができる。
図5は、予め定められたプログラムに従い図3のコントローラ10で実行される処理の一例を示すフローチャートである。このフローチャートに示す処理は、手動運転モードで第1車線LN1を走行するときに開始され、所定周期で繰り返される。
図5に示すように、まず、ステップS1で、カメラ1aとセンサ2aとからの信号を読み込む。次いで、ステップS2で、読み込まれた信号(カメラ画像等)に基づいて往路(第1車線LN1)の環境地図を生成する。次いで、ステップS3で、ステップS1で読み込まれたカメラ画像に基づいて、往路走行時における第2車線LN2についてのカメラ1aによる検出精度が所定値以上であるか否かを判定する。ステップS3で肯定されるとステップS4に進み、否定されるとステップS5に進む。
ステップS4では、ステップS1で読み込まれたカメラ画像に基づいて、復路(第2車線LN2)の環境地図を生成する。例えば図2Aに示すように、カメラ1aの検出可能範囲AR1内のカメラ画像のうち、第2車線LN2のカメラ画像に基づいて復路地図を生成する。一方、ステップS5では、往路地図のミラーリングにより復路地図を生成する。例えば図4Aの点線で示すミラーリング範囲AR2内の復路地図を生成する。次いで、ステップS6で、ステップS2で生成された往路地図とステップS4で生成された復路地図、またはステップS2で生成された往路地図とステップS5で生成された復路地図の地図情報を記憶部12に記憶し、処理を終了する。
本実施形態に係る地図生成装置50の動作をまとめると以下のようになる。図2Aに示すように、自車両101が手動運転モードで目的地までの往路(第1車線LN1)を走行するとき、カメラ画像に基づいて、区画線L1,L2の位置情報を含むカメラ1aの検出可能範囲AR1内の往路の環境地図が生成される(ステップS2)。このとき、カメラ画像に第2車線LN2が含まれ、第2車線LN2についてのカメラ1aによる検出精度が所定値以上であると判定されると、往路走行におけるカメラ画像に基づいて、復路(第2車線LN2)の環境地図が同時に生成される(ステップS4)。
一方、図2Bに示すように、第1車線LN1と第2車線LN2との境界線L0に障害物103が存在して、第2車線LN2についてのカメラ1aによる検出精度が所定値未満であると判定されると、往路地図のミラーリングにより、図4Bに点線で示すミラーリング範囲AR2内における復路の環境地図が生成される(ステップS5)。このように本実施形態では、第1車線LN1を走行しながら往路地図を生成するときに、境界線L0上の障害物103の有無に拘わらず、第2車線LN2についての復路地図も同時に生成される。
これにより、手動運転モードで復路を実際に走行する前であっても、復路地図を生成することができる。したがって、復路地図に基づいて復路を自動運転モードで走行する際の目標経路を設定することができ、自動運転モードでの復路の走行が可能である。この場合、第2車線LN2についてのカメラ1aによる検出精度が所定値以上であるとき、ミラーリングによる地図生成に優先して実際のカメラ画像を用いて地図生成を行うので、復路地図を精度よく作成することができる。
本実施形態によれば以下のような作用効果を奏することができる。
(1)地図生成装置50は、自車両101の周囲の外部状況を検出するカメラ1aと、カメラ1aにより検出された外部状況に基づいて、自車両101が走行する自車線(第1車線LN1)についての往路地図と自車線に対向する対向車線(第2車線LN2)についての復路地図とを同時に生成する地図生成部17と、を備える(図1)。これにより、往路走行時に往路地図と同時に復路地図が生成されるので、復路走行を行うまで復路地図が生成されないということを防止することができ、効率的な地図生成を行うことができる。
(1)地図生成装置50は、自車両101の周囲の外部状況を検出するカメラ1aと、カメラ1aにより検出された外部状況に基づいて、自車両101が走行する自車線(第1車線LN1)についての往路地図と自車線に対向する対向車線(第2車線LN2)についての復路地図とを同時に生成する地図生成部17と、を備える(図1)。これにより、往路走行時に往路地図と同時に復路地図が生成されるので、復路走行を行うまで復路地図が生成されないということを防止することができ、効率的な地図生成を行うことができる。
(2)地図生成装置50は、カメラ1aにより検出される第2車線LN2についての外部状況の検出精度が所定値以上であるか否かを判定する精度判定部141をさらに備える(図3)。地図生成部17(復路地図生成部172)は、精度判定部141により検出精度が所定値以上であると判定されると、カメラ1aにより検出される第2車線LN2についての外部状況に基づいて復路地図を生成する一方、検出精度が所定値未満であると判定されると、往路地図を反転することにより復路地図を生成する(図5)。これにより検出精度が悪いと、カメラ画像をそのまま用いて復路地図を生成することが困難であるが、往路地図を反転することにより、自車両101が走行していない第2車線LN2の復路地図も容易に作成することができ、地図生成を効率的に行うことができる。
(3)復路地図生成部172は、精度判定部141により検出精度が所定値未満であると判定されると、第1車線LN1と第2車線LN2との境界線L0を対称軸として往路地図を対称移動(線対称の態様で移動)することにより復路地図を生成する(図4A)。これにより、往路地図を用いて復路地図を良好に生成することができる。すなわち、往路と復路とは対称に形成されることが多いため、ミラーリングにより復路地図を良好に生成することができる。
(4)復路地図生成部172は、自車両101が第1車線LN1を走行するときにカメラ1aにより検出された外部状況に基づいて、自車両101が第1車線LN1を走行しながら往路地図と復路地図とを同時に生成する(図5)。これによりSLAMなどのアルゴリズムを用いて往路を走行しながら往路地図を生成するとき、復路地図も生成され、早期に往路と復路の地図を生成することができる。
(5)地図生成装置50は、地図生成部17により生成された復路地図に基づいて、自車両101が第2車線LN2を走行するときの目標経路を設定する行動計画生成部(経路設定部)をさらに備える(図3)。これにより、環境地図を生成するための手動運転モードでの走行を行う前であっても、自動運転モードでの走行が可能となる。
上記実施形態は種々の形態に変形することができる。以下、いくつかの変形例について説明する。上記実施形態では、カメラ1a等の車載検出器である外部センサ群1により自車両101の周囲の外部状況を検出するようにしたが、ライダ等、カメラ1a以外の車載検出器や車載検出器以外の検出部を用いてこれを検出するようにしてもよい。対向車線を走行する対向車両に搭載された車載検出器(カメラ等)からの情報を、通信ユニット7を介して取得して、往路地図や復路地図を生成するようにしてもよい。上記実施形態では、自車両101が第1車線LN1(自車線)を走行するときにカメラ1aにより検出された外部状況に基づいて、往路地図生成部171が往路地図(第1地図)を生成するとともに、精度判定部141の判定結果に基づいて異なる態様で復路地図(第2地図)を生成するようにしたが、第1地図を第2地図とを同時に生成するのであれば、地図生成部の構成はいかなるものでもよい。
上記実施形態では、カメラ1aにより検出される対向車線についての検出精度が所定値未満と判定されると、自車線と対向車線との境界線L0を対称軸として往路地図を対称移動(線対称移動)することにより復路地図を生成するようにしたが、往路地図の反転の態様は境界線を対称とした線対称とは限らない。上記実施形態では、カメラ1aにより検出される対向車線についての検出精度が所定値未満と判定されると、経路設定部としての行動計画生成部15が、ミラーリングにより生成された地図(仮地図)を用いて復路走行における自動運転用の目標経路を設定するようにしたが、自動運転用の目標経路の設定は、仮地図を用いて行うのではなく、完全なる復路地図を用いて行うようにしてもよい。
上記実施形態では、自車両101の往路走行時に得られた往路地図と復路地図とを記憶部12に記憶するようにしたが、これらの地図情報を、さらに通信ユニット7を介してサーバに送信するようにしてもよい。本実施形態と同様の地図生成の機能を有する他車両が存在する場合、すなわち検出部の外部状況に基づいて地図を生成する他車両が存在する場合、通信ユニット7を介して他車両との間で地図情報を送受信するようにしてもよい。
上記実施形態では、自動運転車両に地図生成装置を適用する例を説明した。すなわち、自動運転車両が環境地図を生成する例を説明したが、本発明は、運転支援機能を有するまたは有しない手動運転車両が環境地図を生成する場合にも同様に適用することができる。
以上の説明はあくまで一例であり、本発明の特徴を損なわない限り、上述した実施形態および変形例により本発明が限定されるものではない。上記実施形態と変形例の1つまたは複数を任意に組み合わせることも可能であり、変形例同士を組み合わせることも可能である。
1a カメラ、10 コントローラ、12 記憶部、15 行動計画生成部、17 地図生成部、50 地図生成装置、141 精度判定部、171 往路地図生成部、172 復路地図生成部
Claims (5)
- 自車両の周囲の外部状況を検出する検出部と、
前記検出部により検出された外部状況に基づいて、自車両が走行する自車線についての第1地図と前記自車線に対向する対向車線についての第2地図とを同時に生成する地図生成部と、を備えることを特徴とする地図生成装置。 - 請求項1に記載の地図生成装置において、
前記検出部により検出される前記対向車線についての外部状況の検出精度が所定値以上であるか否かを判定する精度判定部をさらに備え、
前記地図生成部は、前記精度判定部により前記検出精度が前記所定値以上であると判定されると、前記検出部により検出される前記対向車線についての外部状況に基づいて前記第2地図を生成する一方、前記検出精度が前記所定値未満であると判定されると、前記第1地図を反転することにより前記第2地図を生成することを特徴とする地図生成装置。 - 請求項2に記載の地図生成装置において、
前記地図生成部は、前記精度判定部により前記検出精度が前記所定値未満であると判定されると、前記自車線と前記対向車線との境界線を対称軸として前記第1地図を対称移動することにより前記第2地図を生成することを特徴とする地図生成装置。 - 請求項1~3のいずれか1項に記載の地図生成装置において、
前記検出部は、自車両に搭載された車載検出器であり、
前記地図生成部は、自車両が前記自車線を走行するときに前記車載検出器により検出された外部状況に基づいて、自車両が前記自車線を走行しながら前記第1地図と前記第2地図とを同時に生成することを特徴とする地図生成装置。 - 請求項1~4のいずれか1項に記載の地図生成装置において、
前記地図生成部により生成された前記第2地図に基づいて、前記自車両が前記対向車線を走行するときの目標経路を設定する経路設定部をさらに備えることを特徴とする地図生成装置。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021028504A JP7141479B2 (ja) | 2021-02-25 | 2021-02-25 | 地図生成装置 |
CN202210136710.1A CN114987530A (zh) | 2021-02-25 | 2022-02-15 | 地图生成装置 |
US17/676,187 US20220268596A1 (en) | 2021-02-25 | 2022-02-20 | Map generation apparatus |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021028504A JP7141479B2 (ja) | 2021-02-25 | 2021-02-25 | 地図生成装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2022129719A true JP2022129719A (ja) | 2022-09-06 |
JP7141479B2 JP7141479B2 (ja) | 2022-09-22 |
Family
ID=82900482
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021028504A Active JP7141479B2 (ja) | 2021-02-25 | 2021-02-25 | 地図生成装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20220268596A1 (ja) |
JP (1) | JP7141479B2 (ja) |
CN (1) | CN114987530A (ja) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008076090A (ja) * | 2006-09-19 | 2008-04-03 | Mitsubishi Electric Corp | 地図情報処理装置 |
JP2008157880A (ja) * | 2006-12-26 | 2008-07-10 | Victor Co Of Japan Ltd | 車載カメラ装置を用いた運転支援装置 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6846630B2 (ja) * | 2015-02-16 | 2021-03-24 | パナソニックIpマネジメント株式会社 | 走行レーン検出装置、走行レーン検出方法、併走車検出装置及び隣接するレーンを走行する併走車の検出方法 |
CN107662558B (zh) * | 2016-07-27 | 2020-04-03 | 上海博泰悦臻网络技术服务有限公司 | 一种基于车外环境数据的辅助驾驶方法及装置 |
CN110654372B (zh) * | 2018-06-29 | 2021-09-03 | 比亚迪股份有限公司 | 车辆驾驶控制方法、装置、车辆和存储介质 |
EP3822945B1 (en) * | 2018-07-11 | 2023-05-31 | Nissan Motor Co., Ltd. | Driving environment information generation method, driving control method, driving environment information generation device |
US20200307590A1 (en) * | 2019-03-29 | 2020-10-01 | Robert Bosch Gmbh | Highway exit detection and line mirroring for vehicle trajectory determination |
KR102164800B1 (ko) * | 2019-10-21 | 2020-10-14 | 인천대학교 산학협력단 | 어라운드 뷰 모니터링 시스템을 이용한 인공지능 기반의 자율 주행 차량용 이동 경로 생성 장치 및 그 동작 방법 |
-
2021
- 2021-02-25 JP JP2021028504A patent/JP7141479B2/ja active Active
-
2022
- 2022-02-15 CN CN202210136710.1A patent/CN114987530A/zh active Pending
- 2022-02-20 US US17/676,187 patent/US20220268596A1/en active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008076090A (ja) * | 2006-09-19 | 2008-04-03 | Mitsubishi Electric Corp | 地図情報処理装置 |
JP2008157880A (ja) * | 2006-12-26 | 2008-07-10 | Victor Co Of Japan Ltd | 車載カメラ装置を用いた運転支援装置 |
Also Published As
Publication number | Publication date |
---|---|
CN114987530A (zh) | 2022-09-02 |
JP7141479B2 (ja) | 2022-09-22 |
US20220268596A1 (en) | 2022-08-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11874135B2 (en) | Map generation apparatus | |
US20220258737A1 (en) | Map generation apparatus and vehicle control apparatus | |
JP2022142825A (ja) | 地図情報生成装置および自車位置推定装置 | |
JP2022142826A (ja) | 自車位置推定装置 | |
JP2022128712A (ja) | 道路情報生成装置 | |
JP7141479B2 (ja) | 地図生成装置 | |
JP7141478B2 (ja) | 地図生成装置 | |
JP7141477B2 (ja) | 地図生成装置 | |
JP7141480B2 (ja) | 地図生成装置 | |
US11867526B2 (en) | Map generation apparatus | |
JP7301897B2 (ja) | 地図生成装置 | |
US20220291015A1 (en) | Map generation apparatus and vehicle position recognition apparatus | |
US20220268587A1 (en) | Vehicle position recognition apparatus | |
JP2022123238A (ja) | 区画線認識装置 | |
JP2022123239A (ja) | 区画線認識装置 | |
JP2022123988A (ja) | 区画線認識装置 | |
JP2023147576A (ja) | 地図生成装置 | |
JP2023149356A (ja) | 地図生成装置 | |
JP2022123940A (ja) | 車両制御装置 | |
JP2022151012A (ja) | 地図生成装置 | |
JP2022152051A (ja) | 走行制御装置 | |
JP2022121836A (ja) | 車両制御装置 | |
JP2023146579A (ja) | 地図生成装置 | |
JP2022150534A (ja) | 走行制御装置 | |
JP2023149511A (ja) | 地図生成装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210928 |
|
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: 20220823 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220909 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7141479 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |