JP7347301B2 - 走路生成装置、方法及びプログラム - Google Patents

走路生成装置、方法及びプログラム Download PDF

Info

Publication number
JP7347301B2
JP7347301B2 JP2020062621A JP2020062621A JP7347301B2 JP 7347301 B2 JP7347301 B2 JP 7347301B2 JP 2020062621 A JP2020062621 A JP 2020062621A JP 2020062621 A JP2020062621 A JP 2020062621A JP 7347301 B2 JP7347301 B2 JP 7347301B2
Authority
JP
Japan
Prior art keywords
route
map
autonomous
point sequence
integrated
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
Application number
JP2020062621A
Other languages
English (en)
Other versions
JP2021160464A (ja
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.)
Denso Corp
Original Assignee
Denso 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 Denso Corp filed Critical Denso Corp
Priority to JP2020062621A priority Critical patent/JP7347301B2/ja
Priority to PCT/JP2021/000170 priority patent/WO2021199555A1/ja
Publication of JP2021160464A publication Critical patent/JP2021160464A/ja
Priority to US17/936,275 priority patent/US20230014570A1/en
Application granted granted Critical
Publication of JP7347301B2 publication Critical patent/JP7347301B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • 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/28Navigation; 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/30Map- or contour-matching
    • 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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/0062Adapting control system settings
    • B60W2050/0075Automatic parameter input, automatic initialising or calibrating means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to data
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to data
    • B60W2556/40High definition maps

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)

Description

本発明は、自車両の走行予定の走路を生成する走路生成装置、方法及びプログラムに関する。
従来、車載検知部によって検知された自車両の周辺の周辺情報に基づいて、自車両の走行予定の走路を生成することが行われている。なお、自車両速度の自動制御においては、車載検知部としての車載カメラによって撮影されたカメラ情報と、地図データベースに蓄積された地図データとを用いた自動制御が行われている(例えば、特許文献1参照)。
米国特許第9090260号明細書
しかしながら、車載検知部によって検知された自車両の周辺の周辺情報のみに基づく走路生成では、車載検知部によって周辺情報を検知できなかった領域については走路を生成することができず、走路に欠落部分が発生することとなる。一方、地図データのみに基づく走路生成では、地図データの更新タイミングやエリアによっては、生成された走路の信頼度が欠ける場合が発生し得る。従って、いずれの場合の走路であっても、自車両を適切に制御することが困難となる。
本発明は上記課題に鑑みてなされたものであり、その目的は、自車両を適切に制御することができる走路を生成することが可能な走路生成装置、方法及びプログラムを提供することにある。
本発明は上記課題を解決するために以下の技術的手段を採用する。特許請求の範囲及びこの項に記載した括弧内の符号は、一つの態様として後述する実施の形態に記載の具体的手段との対応関係を示す一例であって、本発明の技術的範囲を限定するものではない。
本発明の第1実施態様は、車載検知部(12)によって検知された自車両(10)の周辺の周辺情報に基づいて前記自車両の走行予定の自律走路を生成する自律走路生成部(14)と、地図データに基づく前記自車両の走行予定の地図走路を取得する地図走路取得部(26)と、前記自律走路と前記地図走路とを用いて統合走路を生成する統合走路生成部(24)と、を具備する走路生成装置である。
本発明の第2実施態様は、車載検知部によって検知された自車両の周辺の周辺情報に基づいて前記自車両の走行予定の自律走路を生成するステップと、地図データに基づく前記自車両の走行予定の地図走路を取得するステップと、前記自律走路と前記地図走路とを用いて統合走路を生成するステップと、を具備する走路生成方法である。
本発明の第3実施態様は、コンピュータに、車載検知部によって検知された自車両の周辺の周辺情報に基づいて前記自車両の走行予定の自律走路を生成するステップと、地図データに基づく前記自車両の走行予定の地図走路を取得するステップと、前記自律走路と前記地図走路とを用いて統合走路を生成するステップと、を実行させる走路生成プログラムである。
本発明では、自車両を適切に制御することができる走路を生成することが可能となっている。
本発明の一実施形態の走路生成システムを示すブロック図。 本発明の一実施形態の走路生成方法を示すフロー図。 本発明の一実施形態の自律走路点列生成ステップを示す模式図。 本発明の一実施形態の地図走路点列生成ステップを示す模式図。 本発明の一実施形態の地図走路点列補正ステップを示す模式図。 本発明の一実施形態の統合走路点列生成ステップを示す模式図。 本発明の一実施形態の統合走路曲線生成ステップを示す模式図。
[第1実施形態]
図1乃至図7を参照して、本発明の第1実施形態について説明する。
本実施形態では、車載検知部によって検知された自車両の周辺の周辺情報に基づいて、信頼度の高い自律走路点列を生成し、また、地図データベース(以下、「地図DB」という。)から取得した地図データに基づいて、欠落部分が存在しない地図走路点列を生成する。そして、自律走路点列に地図走路点列をフィッティングすることによって信頼度の向上された補正地図走路点列を生成したうえで、自律走路点列の欠落部分を補正地図走路点列によって補完することで、信頼度が高くかつ欠落部分が存在しない統合走路点列を生成する。さらに、自律走路点列に対する地図走路点列の信頼度の低さに応じて、自律走路点列に対して補正地図走路点列の重み付けを軽くしたうえで、自律走路点列と補完された補正地図走路点列とからなる統合走路点列をつなげることで、統合走路曲線を生成する。
図1を参照して、本実施形態の走路生成システムについて概説する。
図1に示されるように、走路生成システムにおいて、自車両10は、車載検知部12と、コンピュータとしてのECU(Electronic Control Unit)28と、メモリ34とを有する。ECU28は、1つ以上のプロセッサを有し、自律走路生成部14、車両情報取得部16、地図走路取得部26(地図データ取得部18及び地図走路生成部20)、走路補正部22、並びに、統合走路生成部24としての機能を備える。メモリ34については、不揮発性記憶媒体であり、後述の図2のフローチャートに示す処理をECU28に実行させるプログラムが格納されている。また、地図データ取得部18が通信可能なクラウド30は、地図データベース30を有する。
車載検知部12は自車両10の周辺の周辺情報を検知し、本実施形態では、車載検知部12として車載カメラが用いられる。自律走路生成部14は、車載検知部12によって検知された自車両10の周辺の周辺情報に基づいて、自車両10の走行予定の自律走路を生成する。本実施形態において生成される自律走路は、自車両10の現時刻後の各時刻における走行予定位置を順次示す複数の点からなる自律走路点列である。
車両情報取得部16は、自車両10の状態を示す自車両情報を取得する。本実施形態では、自車両情報は、自車両10の位置、向き等を含む。地図走路取得部26は、地図データに基づく自車両10の走行予定の走路(第2走路)である地図走路を取得する。本実施形態では、地図走路取得部26は、地図データ取得部18と地図走路生成部20とを有する。地図データ取得部18は、クラウド30上の地図DB32から自車両10の周辺エリアの地図データを取得し、地図走路生成部20は、車両情報取得部16によって取得された自車両情報と、地図データ取得部18によって取得された地図データとに基づいて、地図走路を生成する。また、本実施形態において生成される地図走路は、自車両10の現時刻後の各時刻における走行予定位置を順次示す複数の点からなる地図走路点列である。ここで、地図走路点列は、車載カメラ12による検知結果を考慮することなく地図データに基づいて生成されたものであるのに対して、自律走路点列は略リアルタイムに検知された周辺情報に基づいて生成されたものであるため、地図走路点列よりも自律走路点列のほうが信頼度は高い。
走路補正部22は、自律走路生成部14によって生成された自律走路点列と、地図走路取得部26によって取得された地図走路点列とを用いて、地図走路点列を補正して、補正地図走路点列を生成する。なお、走路補正部22では、地図走路取得部26によって取得された地図走路点列を一部修正したうえで、修正された地図走路点列を補正して、補正地図走路点列を生成するようにしてもよい。本実施形態では、走路補正部22は、自律走路点列に地図走路点列をフィッティングすることにより、補正地図走路としての補正地図走路点列を生成する。
統合走路生成部24は、自律走路生成部14によって生成された自律走路点列に、走路補正部22によって生成された補正地図走路点列を統合して、統合走路点列を生成する。本実施形態では、統合走路生成部24は、自律走路点列の欠落部分を、補正地図走路点列によって補完することにより、統合走路点列を生成する。さらに、統合走路生成部24は、地図走路点列の信頼度に応じて、自律走路点列に対して補正地図走路点列を重み付けしたうえで、自律走路点列と補完された補正地図走路点列の一部とからなる統合走路点列をつなげることにより、統合走路曲線を生成する。ここで生成される統合走路曲線は、必ずしも統合走路点列に含まれる全ての点列を通過するものでなくてもよく、統合走路点列の各点の近傍を通過するものであればよい。
図2乃至図7を参照して、本実施形態の走路生成方法について説明する。
図2に示されるように、ECU28がメモリ34から読み出したプログラムを実行することにより、以下の各ステップで構成される走路生成方法を実行する。
周辺情報検知ステップS10
ステップS10では、車載検知部12によって、自車両10の周辺の周辺情報をリアルタイムで検知する。本実施形態では、車載カメラによって、自車両の前方のカメラ画像をリアルタイムで撮影する。
自律走路点列生成ステップS12
ステップS12では、ステップS10において検知された自車両10の周辺の周辺情報に基づいて、自車両10の走行予定の自律走路点列を生成する。ここで、周辺情報検知ステップS10において検知される自車両10の周辺の周辺情報については、自車両に搭載された車載検知部によってリアルタイムに検知された情報であり、情報精度が高いため、周辺情報に基づいて生成された自律走路点列についても信頼度が高くなる。一方で、車載検知部には検知不能な領域が存在し、検知不能な領域においては周辺情報が欠落するため、周辺情報に基づいて生成される自律走路点列についても欠落部分が発生することとなる。
図3を参照して、本実施形態のステップS12について、詳細に説明する。本実施形態では、車載カメラ12によってリアルタイム撮影された自車両の前方のカメラ画像を解析することにより、当該カメラ画像に写っている白線を認識し、認識された白線に基づいて自律走路点列を生成している。ここで、車載カメラ12によってリアルタイムで撮影されたカメラ画像については、情報精度が高いため、カメラ画像に基づいて生成された自律走路点列についても信頼度が高くなっている。一方で、車載カメラ12によっては、先行車両等によって視界が妨げられている領域や、曲率半径の小さな急カーブの進行方向前方等の視界から外れている領域については、視認することができず、本実施形態では進行方向遠方領域が視認不能となっている。このような視認不能な進行方向遠方領域においては、白線を認識することもできないため、認識された白線に基づいて生成される自律走路点列についても、欠落部分が発生している。
車両情報取得ステップS14
ステップS14では、自車両の位置、向き等の自車両情報を取得する。本実施形態では、GPSによって自車両10の位置情報、自車両10に搭載された加速度センサ(不図示)によって自車両10の向き情報を取得する。
地図データ取得ステップS16
ステップS16では、ステップS14において取得された自車両情報に基づいて、クラウド30上の地図DB32から自車両10の周辺エリアの地図データを取得する。なお、本実施形態における地図データは、広域エリアの道路の車線が区別できるような白線情報を少なくとも含むものである。
地図走路点列生成ステップS18
ステップS18では、ステップS14において取得された自車両情報と、ステップS16において取得された地図データとに基づいて、自車両10の走行予定の地図走路点列を生成する。ここで、ステップS10において、自車両に搭載された車載検知部によってリアルタイムで検知された自車両10の周辺の周辺情報に対して、自車両情報ないし地図データの情報精度は低くなっているため、ステップS12において周辺情報に基づいて生成された自律走路点列に対して、地図走路点列の信頼度も低くなっている。一方で、車載検知部によって検知不能な領域においては周辺情報が欠落し、周辺情報に基づいて生成される自律走路点列についても欠落部分が発生するのに対して、地図DB32に蓄積されている地図データに基づいて生成される地図走路点列については、通常は欠落部分が発生することはない。
図4を参照して、本実施形態のステップS18について、詳細に説明する。本実施形態では、GPS及び加速度センサによって夫々取得された自車両10の位置情報及び向き情報、並びに、地図DB32から取得された地図データに基づいて、地図走路点列を生成する。図4は、自律走路点列と地図走路点列とにずれが発生している部分があり、かつ、自律走路点列は地図走路点列に比べて手前側で途切れている様子を示している。ここで、車載カメラ12によってリアルタイムに撮影されたカメラ画像に対して、自車両情報並びに地図データの情報精度は低くなっているため、カメラ画像に基づいて生成された自律走路点列に対して、地図走路点列の信頼度は低くなっており、自律走路点列に対して地図走路点列には誤差が発生している。一方で、車載カメラ12によっては進行方向遠方領域については視認ができず、白線を認識することもできないため、認識された白線に基づいて生成される自律走路点列についても欠落部分が発生している。これに対して、地図DB32に蓄積されている地図データに基づいて生成される地図走路点列については、進行方向遠方領域においても欠落部分は発生していない。
地図走路点列補正ステップS20
ステップS20では、ステップS12において生成された自律走路点列に基づいて、ステップS18において生成された地図走路点列を補正して、補正地図走路点列を生成する。ここで、自律走路点列については地図走路点列よりも信頼度が高いことから、自律走路点列に基づいて地図走路点列を補正することにより、信頼度の向上された補正地図走路点列を得ることができる。なお、ステップ20では、ステップS18において生成された地図走路点列を一部修正したうえで、修正した地図走路点列を補正して、補正地図走路点列を生成するようにしてもよい。
図5を参照して、本実施形態のステップS20について、詳細に説明する。本実施形態では、自律走路点列に地図走路点列をフィッティングすることにより、補正地図走路点列を生成する。フィッティング手法としては、SVD(singular value decomposition)、ICP(interactive closest point)等を用い、式(1)に示されるように、地図走路点列{x}を補正地図走路点列{y}に変換する変換行列(R,t)を推定する。
Figure 0007347301000001
ここで、自律走路点列については地図走路点列よりも信頼度が高くなっているため、自律走路点列に地図走路点列をフィッティングすることによって補正地図走路点列を生成することで、信頼度の向上された補正地図走路点列を得ることができる。
なお、本実施形態では、ステップ18において生成された地図走路点列を一部修正した地図走路点列を、式(1)に代入する地図走路点列{x}としてもよい。地図走路点列を修正する例として、地図走路点列をつなげたときに形成される曲線が滑らかになるように、当該曲線の曲率が小さくなるように地図走路点列の各点の位置を修正することが挙げられる。
統合走路点列生成ステップS22
ステップS22では、自律走路点列に補正地図走路点列を統合して、統合走路点列を生成する。ここで、自律走路点列については、地図走路点列よりも信頼度が高いものの、欠落部分が存在するのに対して、地図走路点列については、自律走路点列よりも信頼度は低いものの、通常は欠落部分は存在しない。このため、自律走路点列に、自律走路点列に基づいて補正され信頼度の向上された補正地図走路点列を統合することで、信頼度が高くかつ欠落部分の存在しない統合走路点列を得ることができる。
図6を参照して、本実施形態のステップS22について、詳細に説明する。本実施形態では、自律走路点列の欠落部分を補正地図走路点列によって補完することにより、統合走路点列を生成する。ここで、自律走路点列については、地図走路点列よりも信頼度が高いものの、進行方向遠方領域において欠落部分が存在しているのに対して、地図走路点列については、自律走路点列よりも信頼度は低いものの、進行方向遠方領域においても欠落部分は存在していない。このため、自律走路点列の進行方向遠方領域における欠落部分を、自律走路点列にフィッティングされ信頼度の向上された補正地図走路点列によって補完することで、信頼度が高くかつ進行方向遠方領域においても欠落部分の存在しない統合走路点列を得ている。
統合走路曲線生成ステップS24
ステップS24では、地図走路点列の信頼度に応じて、自律走路点列に対して補正地図走路点列を重み付けしたうえで、自律走路点列と補完された補正地図走路点列の一部とからなる統合走路点列をつなげることにより統合走路曲線を生成する。ここで、自律走路点列に対する地図走路点列の信頼度の低さに応じて、自律走路点列に対して補正地図走路点列の重み付けを軽くしたうえで、自律走路点列と補完された補正地図走路点列の一部とからなる統合走路点列をつなげることで、信頼度の高い統合走路曲線を得ることができる。
図7を参照して、本実施形態のステップS24について、詳細に説明する。なお、図7(a)については、地図走路点列の信頼度が比較的高く誤差が小さい場合を示し、図7(b)については、図7(a)の場合に比べて地図走路点列の信頼度が比較的低く誤差が大きい場合について示している。本実施形態では、自車両情報の情報精度、地図データの情報精度等に基づく地図走路点列の信頼度に応じて、重み付き非線形最小二乗法等の最適化手法により、自律走路点列に対して補正地図走路点列を重み付けしたうえで、自律走路点列と補完された補正地図走路点列の一部とからなる統合走路点列をつなげるn次曲線を推定して、統合走路曲線を生成している。このように、自律走路点列に対する地図走路点列の信頼度の低さに応じて、自律走路点列に対して補正地図走路点列の重み付けを軽くしたうえで、自律走路点列と補完された補正地図走路点列の一部とからなる統合走路点列をつなげるn次曲線を推定することで、信頼度の高い統合走路曲線を得ている。
ここで、地図DB32に含まれる地図データは、エリアごとに更新タイミングが異なるため、エリアごとに情報精度が異なる。従って、地図走路点列の信頼度については、地図データ取得部18が地図データを取得した時点での取得したエリアの地図データの情報精度に基づいて決定される。
本実施形態の走路生成システム及び方法については以下の効果を奏する。
本実施形態の走路生成システム及び方法では、車載カメラ12によって検知された自車両10の周辺の周辺情報に基づいて、信頼度の高い自律走路点列を生成し、また、地図DB32から取得した地図データに基づいて、欠落部分が存在しない地図走路点列を生成している。そして、自律走路点列に地図走路点列をフィッティングすることによって、信頼度の向上された補正地図走路点列を生成したうえで、自律走路点列の欠落部分を補正地図走路点列によって補完することで、信頼度が高くかつ欠落部分が存在しない統合走路点列を生成している。さらに、自律走路点列に対する地図走路点列の信頼度の低さに応じて、自律走路点列に対して補正地図走路点列の重み付けを軽くしたうえで、自律走路点列と補完された補正地図走路点列とからなる統合走路点列を滑らかに連結することで、信頼度の高い統合走路曲線を生成している。このため、自車両10を適切に制御することができる走路を生成することが可能となっている。
[第2実施形態]
以下、本発明の第2実施形態について説明する。
本実施形態では、第1実施形態と異なり、自車両10は走路補正部22を有しておらず、地図走路点列を補正することなく、地図走路生成部20によって生成された地図走路点列と、自律走路生成部14によって生成された自律走路点列とを用いて、統合走路生成部24によって統合走路を生成する。
さらに、統合走路生成部24は、地図走路点列と自律走路点列との信頼度の関係性に基づいて統合走路点列を生成する。例えば、地図走路の信頼度に比べて自律走路の信頼度が2倍高い場合には、同時刻における地図走路点と自律走路点とを結ぶ線分を2:1で内分する点を各時刻について順次求めることにより統合走路点列を生成して、当該統合走路点列をつなぐことにより統合走路曲線を生成する。ここで、遠方について地図走路点列しか存在しない場合には、手前における地図走路点に対する統合走路点のずれに基づいて、遠方において地図走路点に対する統合走路点の位置を決定してもよい。
本実施形態においても、自律走路点列と地図走路点列とのいずれか一方のみを用いた場合に比べ、信頼度が高くかつ遠方まで欠落の少ない統合走路を生成することができる。これにより、自車両10を適切に制御することができる走路を生成することが可能となっている。
[その他の実施形態]
上記各実施形態では、車載検知部として、車載カメラが用いられている。代わって、車載検知部として、ミリ波レーダ、LiDAR(Light Detection and Ranging、Laser Imaging Detection and Ranging)、ソナー等の内の少なくとも1つのセンサ、又は当該少なくとも1つのセンサと車載カメラとを用いるようにしてもよい。
各実施形態では、クラウド30上の地図DB32に地図データを蓄積し、自車両10の地図走路取得部26において、地図データ取得部18によって地図DB32から地図データを取得し、地図走路生成部20によって地図データから地図走路を生成するようにしている。代わって、クラウド30上の地図DB32に地図走路を蓄積し、自車両10の地図走路取得部26によって地図DB32から地図走路を直接取得するようにしてもよい。この場合には、地図走路取得部26について、地図走路生成部20に相当する機能が不要となる。また、自車両10に充分なデータ容量を確保できる場合には、地図DB32に保存されるべき地図データ、地図走路等の地図情報を、自車両10のメモリ34に格納するようにしてもよい。
各実施形態では、自律走路点列の信頼度が地図走路点列の信頼度よりも高い場合について、自律走路点列に基づいて地図走路点列を補正することにより、補正地図走路点列を生成するようにしている。代わって、地図走路点列の信頼度が自律走路点列の信頼度よりも高い場合等には、地図走路点列に基づいて自律走路点列を補正することにより、補正走路としての補正自律走路点列を生成するようにしてもよい。
第1実施形態では、地図走路点列を一部修正したうえで、修正した地図走路点列を補正して、補正地図走路点列を生成してもよいとしたが、代わって又は加えて、自律走路点列及び/又は補正地図走路点列を修正したうえで、修正した自律走路点列及び/又は補正地図走路点列を用いて統合走路点列を生成するようにしてもよい。また、第2実施形態では、自律走路点列及び/又は地図走路点列を修正したうえで、修正した自律走路点列と地図走路点列とを用いて統合走路点列を生成するようにしてもよい。
各実施形態では、図4、図5等に示すように、自律走路、地図走路、補正地図走路、統合走路等の各種走路については、自車両の現時刻後の各時刻における走行予定位置を順次示す情報としたが、各種走路の表現方法はこれに限られない。各種走路については、自車両の走行を制御できるものであれば、自車両の現時刻後の各時刻における予定速度を順次示す情報であってもよいし、予定加速度を示す情報であってもよい。
各実施形態では、走路として走路点列を用いているが、代わって走路曲線を用いるようにしてもよい。即ち、本実施形態では、自律走路、地図走路、補正地図走路、並びに、統合走路として、夫々、自律走路点列、地図走路点列、補正地図走路点列、並びに、統合走路点列及び統合走路曲線を用いているが、代わって自律走路曲線、地図走路曲線、補正地図走路曲線、並びに、統合走路曲線を用いるようにしてもよい。
12…車載カメラ 14…自律走路生成部 20…地図走路生成部
22…走路補正部 24…統合走路生成部

Claims (6)

  1. 車載検知部(12)によって検知された自車両(10)の周辺の周辺情報と地図データとの内の前記地図データを除く前記周辺情報に基づいて前記自車両の走行予定の自律走路を生成する自律走路生成部(14)と、
    前記周辺情報と前記地図データとの内の前記周辺情報を除く前記地図データに基づく前記自車両の走行予定の地図走路を取得する地図走路取得部(26)と、
    前記自律走路と前記地図走路とを用いて統合走路を生成する統合走路生成部(24)と、
    を具備し、
    前記自律走路と前記地図走路とを用いて、前記地図走路及び前記自律走路の内の信頼度が低い方の走路である一方の走路を補正した補正走路を生成する走路補正部(22)をさらに具備し、
    前記統合走路生成部は、前記地図走路及び前記自律走路の内の他方の走路と、前記補正走路とを統合して、前記統合走路を生成する、
    走路生成装置。
  2. 前記走路補正部は、前記一方の走路を前記他方の走路にフィッティングすることにより前記補正走路を生成する、
    請求項1に記載の走路生成装置。
  3. 前記他方の走路は前記自律走路であり、
    前記統合走路生成部は、前記自律走路の欠落部分を前記補正走路によって補完することにより前記統合走路を生成する、
    請求項1又は2に記載の走路生成装置。
  4. 前記一方の走路は前記地図走路であり、
    前記統合走路生成部は、前記地図走路の信頼度に応じて前記自律走路に対して前記補正走路を重み付けしたうえで、前記自律走路の欠落部分の補完に用いた前記補正走路の一部と前記自律走路とをつなげることにより前記統合走路を生成する、
    請求項3に記載の走路生成装置。
  5. 車載検知部によって検知された自車両の周辺の周辺情報と地図データとの内の前記地図データを除く前記周辺情報に基づいて前記自車両の走行予定の自律走路を生成するステップと、
    前記周辺情報と前記地図データとの内の前記周辺情報を除く前記地図データに基づく前記自車両の走行予定の地図走路を取得するステップと、
    前記自律走路と前記地図走路とを用いて統合走路を生成するステップと、
    を具備し、
    前記自律走路と前記地図走路とを用いて、前記地図走路及び前記自律走路の内の信頼度が低い方の走路である一方の走路を補正した補正走路を生成するステップをさらに具備し、
    前記統合走路を生成するステップは、前記地図走路及び前記自律走路の内の他方の走路と、前記補正走路とを統合して、前記統合走路を生成する、
    走路生成方法。
  6. コンピュータに、
    車載検知部によって検知された自車両の周辺の周辺情報と地図データとの内の前記地図データを除く前記周辺情報に基づいて前記自車両の走行予定の自律走路を生成するステップと、
    前記周辺情報と前記地図データとの内の前記周辺情報を除く前記地図データに基づく前記自車両の走行予定の地図走路を取得するステップと、
    前記自律走路と前記地図走路とを用いて統合走路を生成するステップと、
    を実行させ、
    前記自律走路と前記地図走路とを用いて、前記地図走路及び前記自律走路の内の信頼度が低い方の走路である一方の走路を補正した補正走路を生成するステップをさらに実行させ、
    前記統合走路を生成するステップは、前記地図走路及び前記自律走路の内の他方の走路と、前記補正走路とを統合して、前記統合走路を生成する、
    走路生成プログラム。
JP2020062621A 2020-03-31 2020-03-31 走路生成装置、方法及びプログラム Active JP7347301B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2020062621A JP7347301B2 (ja) 2020-03-31 2020-03-31 走路生成装置、方法及びプログラム
PCT/JP2021/000170 WO2021199555A1 (ja) 2020-03-31 2021-01-06 走路生成装置、方法及びプログラム
US17/936,275 US20230014570A1 (en) 2020-03-31 2022-09-28 Route generation device, method, and program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020062621A JP7347301B2 (ja) 2020-03-31 2020-03-31 走路生成装置、方法及びプログラム

Publications (2)

Publication Number Publication Date
JP2021160464A JP2021160464A (ja) 2021-10-11
JP7347301B2 true JP7347301B2 (ja) 2023-09-20

Family

ID=77928418

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020062621A Active JP7347301B2 (ja) 2020-03-31 2020-03-31 走路生成装置、方法及びプログラム

Country Status (3)

Country Link
US (1) US20230014570A1 (ja)
JP (1) JP7347301B2 (ja)
WO (1) WO2021199555A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7498079B2 (ja) * 2020-10-02 2024-06-11 株式会社Subaru 車両制御システム

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017159539A1 (ja) 2016-03-15 2017-09-21 本田技研工業株式会社 車両制御装置、車両制御方法、および車両制御プログラム
JP2018024294A (ja) 2016-08-09 2018-02-15 日産自動車株式会社 自己位置推定方法及び自己位置推定装置
WO2018079069A1 (ja) 2016-10-25 2018-05-03 本田技研工業株式会社 車両制御装置
US20180247537A1 (en) 2017-02-28 2018-08-30 Hyundai Motor Company Apparatus and method for estimating a position of a vehicle and a vehicle using same
US20200094844A1 (en) 2018-09-26 2020-03-26 Toyota Jidosha Kabushiki Kaisha Vehicle control apparatus that is mounted in vehicle

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4054103B2 (ja) * 1998-04-09 2008-02-27 富士通テン株式会社 走行路形状認識装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017159539A1 (ja) 2016-03-15 2017-09-21 本田技研工業株式会社 車両制御装置、車両制御方法、および車両制御プログラム
JP2018024294A (ja) 2016-08-09 2018-02-15 日産自動車株式会社 自己位置推定方法及び自己位置推定装置
WO2018079069A1 (ja) 2016-10-25 2018-05-03 本田技研工業株式会社 車両制御装置
US20180247537A1 (en) 2017-02-28 2018-08-30 Hyundai Motor Company Apparatus and method for estimating a position of a vehicle and a vehicle using same
US20200094844A1 (en) 2018-09-26 2020-03-26 Toyota Jidosha Kabushiki Kaisha Vehicle control apparatus that is mounted in vehicle

Also Published As

Publication number Publication date
JP2021160464A (ja) 2021-10-11
WO2021199555A1 (ja) 2021-10-07
US20230014570A1 (en) 2023-01-19

Similar Documents

Publication Publication Date Title
JP7461720B2 (ja) 車両位置決定方法及び車両位置決定装置
KR100921427B1 (ko) 영상 기반 내비게이션을 위한 가상차선을 생성하는 방법 및그 장치
US20180173970A1 (en) Method for estimating traffic lanes
JP6520740B2 (ja) 物体検出方法、物体検出装置、およびプログラム
US10789488B2 (en) Information processing device, learned model, information processing method, and computer program product
JP4761156B2 (ja) 地物位置認識装置及び地物位置認識方法
RU2750243C2 (ru) Способ и система для формирования траектории для беспилотного автомобиля (sdc)
JP6984624B2 (ja) 表示制御装置および表示制御プログラム
CN110470309A (zh) 本车位置推断装置
US20220176989A1 (en) High precision position estimation method through road shape classification-based map matching and autonomous vehicle thereof
Shunsuke et al. GNSS/INS/on-board camera integration for vehicle self-localization in urban canyon
JP6038422B1 (ja) 車両判定装置、車両判定方法及び車両判定プログラム
JP6941178B2 (ja) 自動運転制御装置及び方法
US20220205804A1 (en) Vehicle localisation
CN115878494B (zh) 自动驾驶软件***的测试方法、装置、车辆及存储介质
JP7347301B2 (ja) 走路生成装置、方法及びプログラム
US20210224616A1 (en) System and method for fusion recognition using active stick filter
JP7081098B2 (ja) 走行環境認識装置、走行環境認識方法、プログラム
US20210190509A1 (en) Position estimating apparatus and position estimating method
JP7056379B2 (ja) 車両用走行制御装置
CN116890847A (zh) 车辆姿势评估
US11210535B1 (en) Sensor fusion
US20210142216A1 (en) Method of training a machine learning system for an object recognition device
KR101637298B1 (ko) 증강 현실을 이용한 차량용 헤드 업 디스플레이 장치
KR20220078811A (ko) 가상 주행 경로 제공 장치 및 방법

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20211222

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220207

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20221220

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230207

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230530

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230720

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: 20230808

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230821

R151 Written notification of patent or utility model registration

Ref document number: 7347301

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151