JP7347301B2 - 走路生成装置、方法及びプログラム - Google Patents
走路生成装置、方法及びプログラム Download PDFInfo
- 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
Links
Images
Classifications
-
- 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
-
- 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
-
- 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
- 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/34—Route searching; Route guidance
-
- 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/0062—Adapting control system settings
- B60W2050/0075—Automatic parameter input, automatic initialising or calibrating means
-
- 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
-
- 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)
- 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乃至図7を参照して、本発明の第1実施形態について説明する。
本実施形態では、車載検知部によって検知された自車両の周辺の周辺情報に基づいて、信頼度の高い自律走路点列を生成し、また、地図データベース(以下、「地図DB」という。)から取得した地図データに基づいて、欠落部分が存在しない地図走路点列を生成する。そして、自律走路点列に地図走路点列をフィッティングすることによって信頼度の向上された補正地図走路点列を生成したうえで、自律走路点列の欠落部分を補正地図走路点列によって補完することで、信頼度が高くかつ欠落部分が存在しない統合走路点列を生成する。さらに、自律走路点列に対する地図走路点列の信頼度の低さに応じて、自律走路点列に対して補正地図走路点列の重み付けを軽くしたうえで、自律走路点列と補完された補正地図走路点列とからなる統合走路点列をつなげることで、統合走路曲線を生成する。
図2に示されるように、ECU28がメモリ34から読み出したプログラムを実行することにより、以下の各ステップで構成される走路生成方法を実行する。
ステップS10では、車載検知部12によって、自車両10の周辺の周辺情報をリアルタイムで検知する。本実施形態では、車載カメラによって、自車両の前方のカメラ画像をリアルタイムで撮影する。
ステップS12では、ステップS10において検知された自車両10の周辺の周辺情報に基づいて、自車両10の走行予定の自律走路点列を生成する。ここで、周辺情報検知ステップS10において検知される自車両10の周辺の周辺情報については、自車両に搭載された車載検知部によってリアルタイムに検知された情報であり、情報精度が高いため、周辺情報に基づいて生成された自律走路点列についても信頼度が高くなる。一方で、車載検知部には検知不能な領域が存在し、検知不能な領域においては周辺情報が欠落するため、周辺情報に基づいて生成される自律走路点列についても欠落部分が発生することとなる。
ステップS14では、自車両の位置、向き等の自車両情報を取得する。本実施形態では、GPSによって自車両10の位置情報、自車両10に搭載された加速度センサ(不図示)によって自車両10の向き情報を取得する。
ステップS16では、ステップS14において取得された自車両情報に基づいて、クラウド30上の地図DB32から自車両10の周辺エリアの地図データを取得する。なお、本実施形態における地図データは、広域エリアの道路の車線が区別できるような白線情報を少なくとも含むものである。
ステップS18では、ステップS14において取得された自車両情報と、ステップS16において取得された地図データとに基づいて、自車両10の走行予定の地図走路点列を生成する。ここで、ステップS10において、自車両に搭載された車載検知部によってリアルタイムで検知された自車両10の周辺の周辺情報に対して、自車両情報ないし地図データの情報精度は低くなっているため、ステップS12において周辺情報に基づいて生成された自律走路点列に対して、地図走路点列の信頼度も低くなっている。一方で、車載検知部によって検知不能な領域においては周辺情報が欠落し、周辺情報に基づいて生成される自律走路点列についても欠落部分が発生するのに対して、地図DB32に蓄積されている地図データに基づいて生成される地図走路点列については、通常は欠落部分が発生することはない。
ステップS20では、ステップS12において生成された自律走路点列に基づいて、ステップS18において生成された地図走路点列を補正して、補正地図走路点列を生成する。ここで、自律走路点列については地図走路点列よりも信頼度が高いことから、自律走路点列に基づいて地図走路点列を補正することにより、信頼度の向上された補正地図走路点列を得ることができる。なお、ステップ20では、ステップS18において生成された地図走路点列を一部修正したうえで、修正した地図走路点列を補正して、補正地図走路点列を生成するようにしてもよい。
ステップS22では、自律走路点列に補正地図走路点列を統合して、統合走路点列を生成する。ここで、自律走路点列については、地図走路点列よりも信頼度が高いものの、欠落部分が存在するのに対して、地図走路点列については、自律走路点列よりも信頼度は低いものの、通常は欠落部分は存在しない。このため、自律走路点列に、自律走路点列に基づいて補正され信頼度の向上された補正地図走路点列を統合することで、信頼度が高くかつ欠落部分の存在しない統合走路点列を得ることができる。
ステップS24では、地図走路点列の信頼度に応じて、自律走路点列に対して補正地図走路点列を重み付けしたうえで、自律走路点列と補完された補正地図走路点列の一部とからなる統合走路点列をつなげることにより統合走路曲線を生成する。ここで、自律走路点列に対する地図走路点列の信頼度の低さに応じて、自律走路点列に対して補正地図走路点列の重み付けを軽くしたうえで、自律走路点列と補完された補正地図走路点列の一部とからなる統合走路点列をつなげることで、信頼度の高い統合走路曲線を得ることができる。
本実施形態の走路生成システム及び方法では、車載カメラ12によって検知された自車両10の周辺の周辺情報に基づいて、信頼度の高い自律走路点列を生成し、また、地図DB32から取得した地図データに基づいて、欠落部分が存在しない地図走路点列を生成している。そして、自律走路点列に地図走路点列をフィッティングすることによって、信頼度の向上された補正地図走路点列を生成したうえで、自律走路点列の欠落部分を補正地図走路点列によって補完することで、信頼度が高くかつ欠落部分が存在しない統合走路点列を生成している。さらに、自律走路点列に対する地図走路点列の信頼度の低さに応じて、自律走路点列に対して補正地図走路点列の重み付けを軽くしたうえで、自律走路点列と補完された補正地図走路点列とからなる統合走路点列を滑らかに連結することで、信頼度の高い統合走路曲線を生成している。このため、自車両10を適切に制御することができる走路を生成することが可能となっている。
以下、本発明の第2実施形態について説明する。
本実施形態では、第1実施形態と異なり、自車両10は走路補正部22を有しておらず、地図走路点列を補正することなく、地図走路生成部20によって生成された地図走路点列と、自律走路生成部14によって生成された自律走路点列とを用いて、統合走路生成部24によって統合走路を生成する。
上記各実施形態では、車載検知部として、車載カメラが用いられている。代わって、車載検知部として、ミリ波レーダ、LiDAR(Light Detection and Ranging、Laser Imaging Detection and Ranging)、ソナー等の内の少なくとも1つのセンサ、又は当該少なくとも1つのセンサと車載カメラとを用いるようにしてもよい。
22…走路補正部 24…統合走路生成部
Claims (6)
- 車載検知部(12)によって検知された自車両(10)の周辺の周辺情報と地図データとの内の前記地図データを除く前記周辺情報に基づいて前記自車両の走行予定の自律走路を生成する自律走路生成部(14)と、
前記周辺情報と前記地図データとの内の前記周辺情報を除く前記地図データに基づく前記自車両の走行予定の地図走路を取得する地図走路取得部(26)と、
前記自律走路と前記地図走路とを用いて統合走路を生成する統合走路生成部(24)と、
を具備し、
前記自律走路と前記地図走路とを用いて、前記地図走路及び前記自律走路の内の信頼度が低い方の走路である一方の走路を補正した補正走路を生成する走路補正部(22)をさらに具備し、
前記統合走路生成部は、前記地図走路及び前記自律走路の内の他方の走路と、前記補正走路とを統合して、前記統合走路を生成する、
走路生成装置。 - 前記走路補正部は、前記一方の走路を前記他方の走路にフィッティングすることにより前記補正走路を生成する、
請求項1に記載の走路生成装置。 - 前記他方の走路は前記自律走路であり、
前記統合走路生成部は、前記自律走路の欠落部分を前記補正走路によって補完することにより前記統合走路を生成する、
請求項1又は2に記載の走路生成装置。 - 前記一方の走路は前記地図走路であり、
前記統合走路生成部は、前記地図走路の信頼度に応じて前記自律走路に対して前記補正走路を重み付けしたうえで、前記自律走路の欠落部分の補完に用いた前記補正走路の一部と前記自律走路とをつなげることにより前記統合走路を生成する、
請求項3に記載の走路生成装置。 - 車載検知部によって検知された自車両の周辺の周辺情報と地図データとの内の前記地図データを除く前記周辺情報に基づいて前記自車両の走行予定の自律走路を生成するステップと、
前記周辺情報と前記地図データとの内の前記周辺情報を除く前記地図データに基づく前記自車両の走行予定の地図走路を取得するステップと、
前記自律走路と前記地図走路とを用いて統合走路を生成するステップと、
を具備し、
前記自律走路と前記地図走路とを用いて、前記地図走路及び前記自律走路の内の信頼度が低い方の走路である一方の走路を補正した補正走路を生成するステップをさらに具備し、
前記統合走路を生成するステップは、前記地図走路及び前記自律走路の内の他方の走路と、前記補正走路とを統合して、前記統合走路を生成する、
走路生成方法。 - コンピュータに、
車載検知部によって検知された自車両の周辺の周辺情報と地図データとの内の前記地図データを除く前記周辺情報に基づいて前記自車両の走行予定の自律走路を生成するステップと、
前記周辺情報と前記地図データとの内の前記周辺情報を除く前記地図データに基づく前記自車両の走行予定の地図走路を取得するステップと、
前記自律走路と前記地図走路とを用いて統合走路を生成するステップと、
を実行させ、
前記自律走路と前記地図走路とを用いて、前記地図走路及び前記自律走路の内の信頼度が低い方の走路である一方の走路を補正した補正走路を生成するステップをさらに実行させ、
前記統合走路を生成するステップは、前記地図走路及び前記自律走路の内の他方の走路と、前記補正走路とを統合して、前記統合走路を生成する、
走路生成プログラム。
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7498079B2 (ja) * | 2020-10-02 | 2024-06-11 | 株式会社Subaru | 車両制御システム |
Citations (5)
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4054103B2 (ja) * | 1998-04-09 | 2008-02-27 | 富士通テン株式会社 | 走行路形状認識装置 |
-
2020
- 2020-03-31 JP JP2020062621A patent/JP7347301B2/ja active Active
-
2021
- 2021-01-06 WO PCT/JP2021/000170 patent/WO2021199555A1/ja active Application Filing
-
2022
- 2022-09-28 US US17/936,275 patent/US20230014570A1/en active Pending
Patent Citations (5)
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 |
---|---|
WO2021199555A1 (ja) | 2021-10-07 |
US20230014570A1 (en) | 2023-01-19 |
JP2021160464A (ja) | 2021-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111060094B (zh) | 车辆定位方法和装置 | |
KR100921427B1 (ko) | 영상 기반 내비게이션을 위한 가상차선을 생성하는 방법 및그 장치 | |
JP6520740B2 (ja) | 物体検出方法、物体検出装置、およびプログラム | |
US10789488B2 (en) | Information processing device, learned model, information processing method, and computer program product | |
JP6984624B2 (ja) | 表示制御装置および表示制御プログラム | |
JP4761156B2 (ja) | 地物位置認識装置及び地物位置認識方法 | |
CN110470309A (zh) | 本车位置推断装置 | |
RU2750243C2 (ru) | Способ и система для формирования траектории для беспилотного автомобиля (sdc) | |
Shunsuke et al. | GNSS/INS/on-board camera integration for vehicle self-localization in urban canyon | |
US20220176989A1 (en) | High precision position estimation method through road shape classification-based map matching and autonomous vehicle thereof | |
JP6038422B1 (ja) | 車両判定装置、車両判定方法及び車両判定プログラム | |
JP6941178B2 (ja) | 自動運転制御装置及び方法 | |
US12085403B2 (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) | 车辆姿势评估 | |
JP7400708B2 (ja) | センサ評価システム、センサ評価装置、車両 | |
US20210142216A1 (en) | Method of training a machine learning system for an object recognition device | |
JP7378591B2 (ja) | 走行経路生成装置 | |
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 |