JP2019182093A - 挙動予測装置 - Google Patents

挙動予測装置 Download PDF

Info

Publication number
JP2019182093A
JP2019182093A JP2018073209A JP2018073209A JP2019182093A JP 2019182093 A JP2019182093 A JP 2019182093A JP 2018073209 A JP2018073209 A JP 2018073209A JP 2018073209 A JP2018073209 A JP 2018073209A JP 2019182093 A JP2019182093 A JP 2019182093A
Authority
JP
Japan
Prior art keywords
behavior prediction
behavior
prediction
divergence
moving body
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
Application number
JP2018073209A
Other languages
English (en)
Other versions
JP6985203B2 (ja
Inventor
展秀 鎌田
Nobuhide Kamata
展秀 鎌田
将弘 原田
Masahiro Harada
将弘 原田
直樹 長坂
Naoki Nagasaka
直樹 長坂
文洋 奥村
Fumihiro Okumura
文洋 奥村
清水 司
Tsukasa Shimizu
司 清水
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.)
Toyota Motor Corp
Toyota Central R&D Labs Inc
Original Assignee
Toyota Motor Corp
Toyota Central R&D Labs Inc
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 Toyota Motor Corp, Toyota Central R&D Labs Inc filed Critical Toyota Motor Corp
Priority to JP2018073209A priority Critical patent/JP6985203B2/ja
Priority to US16/375,232 priority patent/US11498577B2/en
Publication of JP2019182093A publication Critical patent/JP2019182093A/ja
Application granted granted Critical
Publication of JP6985203B2 publication Critical patent/JP6985203B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0088Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • 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
    • B60W50/0097Predicting future conditions
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N5/00Computing arrangements using knowledge-based models
    • G06N5/02Knowledge representation; Symbolic representation
    • 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/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • 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
    • B60W2050/0083Setting, resetting, calibration
    • 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
    • B60W2554/00Input parameters relating to objects
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/027Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N20/00Machine learning

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Theoretical Computer Science (AREA)
  • Game Theory and Decision Science (AREA)
  • Medical Informatics (AREA)
  • Health & Medical Sciences (AREA)
  • Business, Economics & Management (AREA)
  • Electromagnetism (AREA)
  • Computing Systems (AREA)
  • Transportation (AREA)
  • Data Mining & Analysis (AREA)
  • Human Computer Interaction (AREA)
  • General Engineering & Computer Science (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Computational Linguistics (AREA)
  • Mechanical Engineering (AREA)
  • Multimedia (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Optics & Photonics (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

【課題】挙動予測モデルデータベースの更新の要否を適切に判定することができる挙動予測装置を提供する。【解決手段】自車両の周囲の移動体挙動を検出する移動体挙動検出部12と、移動体挙動を予測するための挙動予測モデルを記憶する挙動予測モデルデータベース5と、挙動予測モデルを利用して移動体の挙動予測を演算する挙動予測演算部14と、挙動予測と挙動予測に対応する移動体挙動の検出結果とに基づいて予測乖離が生じているか否かを判定する予測乖離判定部15と、予測乖離が生じていると判定された場合に乖離発生理由を推定する乖離発生理由推定部16と、予測乖離判定部により予測乖離が生じていると判定された場合に、乖離発生理由に基づいて、挙動予測モデルデータベースの更新の要否を判定する更新要否判定部18と、を備える。【選択図】図1

Description

本発明は、挙動予測装置に関する。
従来、挙動予測装置に関する技術文献として、米国特許第8948955号明細書が知られている。この明細書には、自車両の外部にある物体を検出し、メモリに格納された挙動データを用いて移動体(車両、バイク、歩行者など)の挙動を予測するシステムが記載されている。このシステムでは、移動体の挙動の検出結果を挙動データとして保存することで次回の挙動予測に利用する。
米国特許第8948955号明細書
しかしながら、上述した従来のシステムでは挙動データに誤りがあると、物体の挙動予測を正しく行うことができない。このため、挙動データに誤りがある場合にはデータ内容を更新する必要がある。そこで、本技術分野では、移動体の挙動を予測するためのデータの更新の要否を適切に判定することが望まれている。
上記課題を解決するため、本発明の一態様の挙動予測装置は、自車両の周囲の移動体の位置、進行方向、及び速度を少なくとも含む移動体挙動を検出する移動体挙動検出部と、移動体挙動を予測するための挙動予測モデルを記憶する挙動予測モデルデータベースと、移動体挙動の検出結果に基づいて、挙動予測モデルを利用して移動体の挙動予測を演算する挙動予測演算部と、挙動予測と挙動予測に対応する移動体挙動の検出結果とに基づいて、予測乖離が生じているか否かを判定する予測乖離判定部と、予測乖離判定部により予測乖離が生じていると判定された場合に、挙動予測と挙動予測に対応する移動体挙動の検出結果とに基づいて、乖離発生理由を推定する乖離発生理由推定部と、予測乖離判定部により予測乖離が生じていると判定された場合に、乖離発生理由に基づいて、挙動予測モデルデータベースの更新の要否を判定する更新要否判定部と、を備える。
本発明の一態様の挙動予測装置によれば、移動体の挙動予測と挙動予測に対応する移動体挙動の検出結果との予測乖離が生じていると判定された場合に、移動体の挙動予測と検出結果とから乖離発生理由を推定し、乖離発生理由に基づいて挙動予測モデルデータベースの更新の要否を判定するので、乖離発生理由を考慮しない場合と比べて挙動予測モデルデータベースの更新の要否を適切に判定することができる。
本発明の一態様の挙動予測装置において、更新要否判定部は、予測乖離判定部により予測乖離が生じていると判定された場合に、乖離発生理由に基づいて挙動予測モデルデータベースの更新必要度を演算し、更新必要度が更新閾値以上であるとき挙動予測モデルデータベースの更新が必要であると判定してもよい。
この挙動予測装置によれば、乖離発生理由に基づいて挙動予測モデルデータベースの更新必要度を演算することで、更新必要度を用いて挙動予測モデルデータベースの更新の要否を判定することができる。
本発明の一態様の挙動予測装置において、挙動予測演算部は、予め設定された短期予測時点における移動体の挙動予測である短期挙動予測と、短期予測時点より後の時点として予め設定された長期予測時点における移動体の挙動予測である長期挙動予測とを少なくとも演算し、更新要否判定部は、同じ乖離発生理由に基づいた更新必要度の演算において、予測乖離判定部により短期挙動予測の予測乖離が生じていると判定された場合、短期挙動予測の予測乖離が生じておらず長期挙動予測の予測乖離のみが生じていると判定された場合と比べて、更新必要度を大きい値として演算してもよい。
この挙動予測装置によれば、挙動予測の予測時点が先の時点であるほど挙動予測モデル以外の影響により予測乖離が生じた可能性が高まっていくことから、短期挙動予測の予測乖離が生じていると判定された場合には、長期挙動予測の予測乖離が生じていると判定された場合と比べて挙動予測モデルデータベースの更新必要度を大きい値とすることで、挙動予測モデルデータベースの更新の要否を適切に判定することができる。
本発明の一態様の挙動予測装置において、車線毎の位置情報を含む地図情報を記憶する地図データベースと、自車両の地図上の位置を認識する車両位置認識部と、を更に備え、挙動予測モデルデータベースには、地図情報における地図上の位置と関連付けて挙動予測モデルが記憶されており、挙動予測演算部は、移動体挙動の検出結果と挙動予測モデルと地図情報と自車両の地図上の位置とに基づいて移動体の挙動予測を演算してもよい。
この挙動予測装置によれば、地図情報を考慮して挙動予測モデルを利用した移動体の挙動予測を演算することができるので、地図情報を用いない場合と比べて挙動予測の精度向上を図ることが可能になる。
本発明の一態様の挙動予測装置において、乖離発生理由推定部は、挙動予測における移動体の位置が地図上の移動体進入不能領域に含まれず、挙動予測に対応する移動体挙動の検出結果における移動体の位置が地図上の移動体進入不能領域に含まれる場合、乖離発生理由として地図情報の異常を推定し、更新要否判定部は、乖離発生理由推定部により乖離発生理由として地図情報の異常が推定された場合、挙動予測モデルデータベースの更新を不要と判定してもよい。
この挙動予測装置によれば、挙動予測における移動体の位置が川などの移動体進入不能領域に含まれないにも関わらず、移動体挙動の検出結果における移動体の位置が移動体進入不能領域に含まれる場合には、地図情報の異常により予測乖離が生じたと考えられるので、乖離発生理由として地図情報の異常を推定して挙動予測モデルデータベースの更新を不要とすることができる。
本発明の一態様の挙動予測装置において、移動体の種類を認識する種類認識部を更に備え、挙動予測モデルデータベースには、移動体の種類と関連付けて挙動予測モデルが記憶されており、挙動予測演算部は、移動体挙動の検出結果と挙動予測モデルと移動体の種類とに基づいて、移動体の挙動予測を演算してもよい。
この挙動予測装置によれば、車両、歩行者などの移動体の種類を考慮して挙動予測モデルを利用した移動体の挙動予測を演算することができるので、移動体の種類を考慮しない場合と比べて挙動予測の精度向上を図ることが可能になる。
以上説明したように、本発明の一態様の挙動予測装置によれば、移動体の挙動を予測するための挙動予測モデルデータベースの更新の要否を適切に判定することできる。
第1実施形態の挙動予測装置を示すブロック図である。 挙動予測処理の一例を示すフローチャートである。 更新要否判定処理の一例を示すフローチャートである。 (a)車間マージン設定処理の一例を示すフローチャートである。(b)車間マージン設定処理の他の例を示すフローチャートである。 第2実施形態の挙動予測装置を示すブロック図である。 第2実施形態における更新必要度演算処理の一例を示すフローチャートである。
以下、本発明の実施形態について図面を参照して説明する。
[第1実施形態]
図1に示す第1実施形態の挙動予測装置100は、乗用車などの車両(自車両)に搭載され、自車両の周囲の移動体の挙動予測を行う装置である。移動体とは、他車両(四輪車、二輪車など)である。移動体には、歩行者、自転車を含んでもよい。移動体は、道路上に位置するものに限られてもよい。
〈第1実施形態の挙動予測装置の構成〉
図1に示すように、第1実施形態の挙動予測装置100は、装置を統括的に管理する挙動予測ECU[Electronic Control Unit]10を備えている。挙動予測ECU10は、CPU[Central Processing Unit]、ROM[Read Only Memory]、RAM[Random Access Memory]、CAN[Controller Area Network]通信回路などを有する電子制御ユニットである。挙動予測ECU10では、例えば、ROMに記憶されているプログラムをRAMにロードし、RAMにロードされたプログラムをCPUで実行することにより各種の機能を実現する。挙動予測ECU10は、複数の電子ユニットから構成されていてもよい。
挙動予測ECU10は、GPS受信部1、外部センサ2、内部センサ3、地図DB(地図データベース)4、挙動予測モデルDB(挙動予測モデルデータベース)5、及び自動運転ECU6と接続されている。なお、挙動予測ECU10は、自動運転ECU6と一体であってもよい。
GPS受信部1は、3個以上のGPS衛星から信号を受信することにより、自車両の位置(例えば自車両の緯度及び経度)を測定する。GPS受信部1は、測定した自車両の位置情報を挙動予測ECU10へ送信する。
外部センサ2は、自車両の周辺の状況を検出する検出機器である。外部センサ2は、カメラ、レーダセンサのうち少なくとも一つを含む。
カメラは、自車両の外部状況を撮像する撮像機器である。カメラは、自車両のフロントガラスの裏側に設けられ、車両前方を撮像する。カメラは、自車両の外部状況に関する撮像情報を挙動予測ECU10へ送信する。カメラは、単眼カメラであってもよく、ステレオカメラであってもよい。
レーダセンサは、電波(例えばミリ波)又は光を利用して車両の周辺の物体を検出する検出機器である。レーダセンサには、例えば、ミリ波レーダ又はライダー[LIDAR:Light Detection and Ranging]が含まれる。レーダセンサは、電波又は光を自車両の周辺に送信し、物体で反射された電波又は光を受信することで物体を検出する。レーダセンサは、検出した物体情報を挙動予測ECU10へ送信する。物体には、移動体の他、ガードレール、建物などの固定物が含まれる。
内部センサ3は、自車両の走行状態を検出する検出機器である。内部センサ3は、車速センサ、加速度センサ、及びヨーレートセンサを含む。車速センサは、自車両の速度を検出する検出器である。車速センサとしては、例えば、自車両の車輪又は車輪と一体に回転するドライブシャフトなどに対して設けられ、車輪の回転速度を検出する車輪速センサが用いられる。車速センサは、検出した車速情報(車輪速情報)を挙動予測ECU10に送信する。
加速度センサは、自車両の加速度を検出する検出器である。加速度センサは、例えば、自車両の前後方向の加速度を検出する前後加速度センサと、自車両の横加速度を検出する横加速度センサとを含んでいる。加速度センサは、例えば、自車両の加速度情報を挙動予測ECU10に送信する。ヨーレートセンサは、自車両の重心の鉛直軸周りのヨーレート(回転角速度)を検出する検出器である。ヨーレートセンサとしては、例えばジャイロセンサを用いることができる。ヨーレートセンサは、検出した自車両のヨーレート情報を挙動予測ECU10へ送信する。
地図DB4は、地図情報を記憶するデータベースである。地図DB4は、例えば、自車両に搭載されたHDD[Hard Disk Drive]内に形成されている。地図情報には、道路の位置情報、交差点及び分岐点の位置情報などが含まれる。地図情報には、車線毎の位置情報が含まれていてもよく、道路の曲率情報が含まれていてもよい。また、地図情報には、地図上の位置と関連付けられた法定最高速度などの交通規則情報も含まれていてもよい。なお、地図DB4は、自車両と通信可能な管理センターのサーバなどに形成されていてもよい。
挙動予測モデルDB5は、挙動予測モデルを記憶するデータベースである。挙動予測モデルDB5は、例えば、自車両に搭載されたHDD[Hard Disk Drive]内に形成されている。挙動予測モデルとは、移動体挙動を予測するためのモデルである。移動体挙動には、移動体の位置、進行方向、及び速度が少なくとも含まれる。予測される移動体挙動は、地図情報を基準とした挙動(地図上の位置、進行方向、速度など)であってもよく、自車両を基準とした相対的な挙動(相対位置、相対進行方向、相対速度など)であってもよい。なお、挙動予測モデルDB5は、自車両と通信可能な管理センターのサーバなどに形成されていてもよい。
挙動予測モデルは、外部センサ2による移動体挙動の検出結果から、移動体の挙動予測を演算できるように構成されていればよい。挙動予測モデルには、移動体の運動特性を示す周知のモデルを含むことができる。挙動予測モデルは、例えば車両(四輪車、二輪車)の運動特性を示す周知の車両モデルを含んでもよい。挙動予測モデルには、各種運動パラメータの制約条件が付与されていてもよい。運動パラメータとは、速度、回転角速度(ヨーレート)などである。運動パラメータには加速度が含まれていてもよい。運動パラメータの制約条件とは、速度上限、回転角速度上限などである。
挙動予測モデルは、地図上の位置と関連付けて記憶されていてもよい。挙動予測モデルは、例えば、未舗装路においては車両モデルの加速度特性を低下させるなど、地図上の位置に応じて運動特性が変更されてもよい。また、挙動予測モデルは、法定最高速度に応じた速度限界の設定など、地図上の位置に対応する交通規則に応じて制約条件が付与されてもよい。
挙動予測モデルは、移動体の種類と関連付けて記憶されていてもよい。移動体の種類とは、四輪車、二輪車、歩行者、自転車などの種別の分類である。四輪車は、バスなどの大型車両と乗用車などの小型車両とに分類されていてもよい。また、移動体の種類には犬、猫などの動物が含まれていてもよい。
挙動予測モデルは、四輪車モデル及び二輪車モデルを含むことができる。挙動予測モデルは、歩行者モデルを含んでいてもよく、自転車モデルを含んでいてもよい。この場合、移動体の種類に応じて各モデルの運動特性及び/又は制約条件が異なる。例えば、歩行者モデルは、四輪車モデル及び二輪車モデルと異なり、横方向に移動可能である。二輪車モデルは、四輪車モデルより小さい回転半径で向きを変更することができる。歩行者モデルの速度上限は、四輪車モデル及び二輪車モデルより小さい。このような移動体の種類に応じた各モデルの運動特性及び制約条件については周知の態様を採用することができる。また、挙動予測モデルは、先行車モデル、対向車モデル、後続車モデルなど自車両に対する移動体の相対的な交通関係に応じて分けられていてもよい。
挙動予測モデルは、機械学習によって作成されてもよい。挙動予測モデルは、移動体挙動の検出結果、移動体の周囲の状況などの入力から、正確な挙動予測を出力できるように機械学習で最適化される。移動体の周囲の状況とは、挙動予測の対象となる移動体の周囲に存在する他の移動体及び自車両の状況である。移動体の周囲の状況には、他の移動体の位置及び進行方向と自車両の位置及び進行方向とが含まれる。移動体の周囲の状況には、他の移動体の加速度及び/又は回転角速度と自車両の加速度及び/又は回転角速度とが含まれてもよい。
挙動予測モデルへの入力には、更に地図情報を含めてもよい。この場合には、地図上の車線に対する移動体の位置(車線中心に対する移動体の位置及び/又は白線に対する移動体の位置)を挙動予測に用いることができる。この場合には、地図上の位置に応じて挙動予測モデルが選択されてもよい。
挙動予測モデルへの入力には、更に移動体の種類を含めてもよい。この場合には、移動体の種類に応じて挙動予測モデルが選択されてもよい。挙動予測モデルは、一例として、移動体挙動の検出結果、移動体の周囲の状況、地図情報、移動体の種類を入力することで、移動体の挙動予測を出力できるように作成されていればよい。機械学習の手法は特に限定されない。例えば、過去の移動体挙動の検出履歴を利用した教師有り学習を採用することができる。
自動運転ECU6は、自車両に搭載され、自車両の自動運転を実行するための電子制御ユニットである。自動運転とは、運転者が運転操作をすることなく、自動で自車両を走行させる車両制御である。自動運転ECU6は、複数の電子ユニットから構成されていてもよい。自動運転ECU6の機能の一部は、自車両と通信可能なサーバ(センター)で行われてもよい。
自動運転ECU6は、例えば、GPS受信部1の測定した自車両の地図上の位置、地図DB4の地図情報、自車両の周辺の状況、車両状態(車速、ヨーレート等)、及び挙動予測ECU10による自車両の周辺の移動体の挙動予測に基づいて、予め設定された目標ルートに沿った行動計画及び走行計画を生成する。目標ルートは、車両の乗員により手動で設定されてもよく、周知のナビゲーションシステム又は自動運転ECU6により自動で設定されてもよい。
自動運転ECU6は、行動計画及び走行計画に沿って自動運転を実行する。自動運転ECU6は、車両のアクチュエータ(エンジンアクチュエータ、操舵アクチュエータ、ブレーキアクチュエータ等)に制御信号を送信することで自動運転を実行する。自動運転ECU6は周知の手法により行動計画及び走行計画の生成と自動運転とを実行可能である。
次に、挙動予測ECU10の機能的構成について説明する。挙動予測ECU10は、車両位置認識部11、移動体挙動検出部12、種類認識部13、挙動予測演算部14、予測乖離判定部15、乖離発生理由推定部16、車間マージン設定部17、及び更新要否判定部18を有している。なお、以下に説明する挙動予測ECU10の機能の一部は、自車両と通信可能な管理センターのサーバなどにおいて実行される態様であってもよい。
車両位置認識部11は、GPS受信部1の位置情報及び地図DB4の地図情報に基づいて、自車両の地図上の位置を認識する。また、車両位置認識部11は、地図DB4の地図情報に含まれた電柱等の固定障害物の位置情報及び外部センサ2の検出結果を利用して、SLAM[Simultaneous Localization and Mapping]技術により自車両の位置を認識してもよい。車両位置認識部11は、自車両の地図上の位置の変化から自車両の地図上の進行方向(向き)を認識してもよい。
移動体挙動検出部12は、外部センサ2の検出結果に基づいて、自車両の周囲の移動体挙動(例えば先行車の挙動)を検出する。移動体挙動検出部12は、例えば、レーダセンサの検出した物体情報から、自車両に対する移動体の相対位置、相対進行方向、相対速度などの移動体挙動を検出する。移動体挙動検出部12は、カメラの撮像画像の画像処理により移動体挙動を検出してもよい。また、移動体挙動検出部12は、自車両の地図上の位置及び地図情報を更に用いて、地図情報を基準とした移動体挙動(地図上の位置、進行方向、速度など)を検出してもよい。
種類認識部13は、外部センサ2の検出結果に基づいて、移動体の種類を認識する。種類認識部13は、例えば、レーダセンサの検出した物体情報から、移動体の形状及び大きさを認識し、予め記憶された移動体の種類の分類データを参照することで移動体の種類を認識する。種類認識部13は、カメラの撮像画像から、画像パターンのマッチングなどによって移動体の種類を認識してもよい。
挙動予測演算部14は、予め設定された予測時点における移動体の挙動予測を演算する。予測時点は特に限定されず、任意の時点を採用することができる。予測時点は、一例として現時点から1秒後、2秒後、3秒後、4秒後、5秒後、10秒後、15秒後、20秒後とすることができる。予測時点は一つの時点のみであってもよい。
挙動予測演算部14は、挙動予測に利用可能な地図情報が存在する場合には、地図情報を利用して移動体の挙動予測を演算する。挙動予測に利用可能な地図情報とは、少なくとも車線ごとの位置情報を含む地図情報である。
挙動予測演算部14は、地図DB4の地図情報及び車両位置認識部11の認識した自車両の地図上の位置に基づいて、挙動予測に利用可能な地図情報が存在するか否かを判定する。挙動予測演算部14は、例えば、自車両の地図上の位置における地図情報に車線ごとの位置情報が含まれている場合、挙動予測に利用可能な地図情報が存在すると判定する。なお、挙動予測演算部14は、更に移動体挙動検出部12による移動体挙動の検出結果に基づいて、挙動予測の対象となる移動体の位置における地図情報に車線ごとの位置情報が含まれている場合に、挙動予測に利用可能な地図情報が存在すると判定してもよい。
挙動予測演算部14は、挙動予測に利用可能な地図情報が存在すると判定した場合、地図情報、自車両の地図上の位置、移動体挙動の検出結果、及び移動体の種類の認識結果に基づいて挙動予測モデルDB5の挙動予測モデルを利用することで移動体の挙動予測を演算する。なお、挙動予測における入力としての移動体挙動の検出結果には、挙動予測の対象となる移動体以外の他の移動体(挙動予測の対象となる移動体の付近に位置する移動体など)の検出結果も含まれている。
具体的に、挙動予測演算部14は、移動体挙動の検出結果、地図情報、及び自車両の地図上の位置から、地図上の車線に対する移動体の位置(車線中心に対する移動体の位置及び/又は白線に対する移動体の位置)を認識する。挙動予測演算部14は、移動体挙動の検出結果、地図上の車線に対する移動体の位置、地図情報(車線の位置情報、車線の形状、交差点及び分岐点の位置情報など)、及び移動体の種類を入力として、挙動予測モデルを利用することで、移動体の挙動予測を演算する。挙動予測演算部14は、種類認識部13の認識した移動体の種類に応じた挙動予測モデルを用いて移動体の挙動予測を演算する。なお、挙動予測演算部14は、更に自車両の車速、進行方向などを挙動予測における入力として用いてもよい。
一方、挙動予測演算部14は、挙動予測に利用可能な地図情報が存在しないと判定した場合、移動体挙動の検出結果及び移動体の種類の認識結果に基づいて挙動予測モデルDB5の挙動予測モデルを利用することで移動体の挙動予測を演算する。挙動予測演算部14は、種類認識部13の認識した移動体の種類に応じた挙動予測モデルを用いて移動体の挙動予測を演算する。
挙動予測演算部14は、移動体の挙動予測を演算した場合、挙動予測の結果を自動運転ECU6に送信する。具体的に、挙動予測演算部14は、例えば、移動体として自車両の前を走行する先行車が交差点を左折する挙動予測を行った場合、その挙動予測の結果を自動運転ECU6に送信する。挙動予測演算部14は、左折する先行車の減速量の予測の結果も自動運転ECU6に送信する。この場合、自動運転ECU6は、自動運転中の自車両と先行車との車間を広げると共に、先行車が減速しても自車両の速度変化量が少なくなるように自車両の速度を調整する自動運転を行う。
予測乖離判定部15は、挙動予測演算部14による移動体の挙動予測と当該挙動予測に対応する移動体挙動の検出結果とに基づいて、予測乖離が生じているか否かを判定する。挙動予測に対応する移動体挙動の検出結果とは、挙動予測の予測時点における実際の移動体挙動を検出した結果である。予測乖離判定部15は、予測時点ごとに予測乖離が生じているか否かを判定する。
予測乖離判定部15は、例えば、挙動予測における移動体の位置と当該挙動予測に対応する移動体挙動の検出結果における移動体の位置とが距離閾値以上に離れている場合、予測乖離が生じていると判定する。距離閾値は予め設定された閾値である。
予測乖離判定部15は、挙動予測における移動体の進行方向と当該挙動予測に対応する移動体挙動の検出結果における移動体の進行方向とのなす鋭角の角度差が角度閾値以上である場合、予測乖離が生じていると判定してもよい。角度閾値は予め設定された閾値である。また、予測乖離判定部15は、挙動予測における移動体の速度と当該挙動予測に対応する移動体挙動の検出結果における移動体の速度との絶対値の差が速度閾値以上である場合、予測乖離が生じていると判定してもよい。速度閾値は予め設定された閾値である。
予測乖離判定部15は、移動体の位置、移動体の進行方向、移動体の速度に関して挙動予測と検出結果との差を総合的に評価して、予測乖離が生じているか否かの判定を行ってもよい。予測乖離判定部15は、更に、移動体の加速度及び回転角速度などを利用した総合的な評価から予測乖離が生じているか否かの判定を行ってもよい。
乖離発生理由推定部16は、予測乖離判定部15により予測乖離が生じていると判定された場合に、移動体の挙動予測と当該挙動予測に対応する移動体挙動の検出結果とに基づいて、乖離発生理由を推定する。当該挙動予測に対応する移動体挙動の検出結果とは、当該挙動予測の予測時点において実際に移動体挙動検出部12が検出した移動体挙動の検出結果である。乖離発生理由とは、予測乖離の発生の理由である。乖離発生理由には、挙動予測モデルの精度不足などが含まれる。乖離発生理由には、予測対象の移動体の挙動異常が含まれていてもよく、地図情報の異常が含まれていてもよく、移動体の種類の認識異常が含まれていてもよい。
乖離発生理由推定部16は、例えば、移動体の挙動予測及び当該挙動予測に対応する移動体挙動の検出結果を入力することで乖離発生理由を出力する機械学習プログラムを用いて、乖離発生理由を推定する。乖離発生理由推定部16は、移動体の挙動予測及び当該挙動予測に対応する移動体挙動の検出結果の組み合わせと乖離発生理由とを予め関連付けたテーブルデータを用いることにより、乖離発生理由を推定してもよい。
乖離発生理由推定部16は、移動体挙動の検出結果から予測対象の移動体の挙動が異常と判定した場合、乖離発生理由として予測対象の移動体の挙動異常を推定してもよい。挙動異常とは、例えば移動体の故障(車輪の脱輪、走行制御システムの異常など)に起因して移動体が行う異常な挙動である。この場合の挙動異常には、急旋回、急停止、急加速などが考えられる。また、挙動異常には、移動体の運転者の不適切な運転操作などにより、通常では予測されない蛇行運転、急加速、急減速などを含めてもよい。挙動異常には、予測対象の移動体が他の移動体又は構造物(壁、電柱など)に向かって急接近する挙動を含めてもよく、予測対象の移動体が急に車線を逸脱する挙動を含めてもよい。
乖離発生理由推定部16は、予測対象の移動体挙動の検出結果から、予め設定された正常な挙動の範囲を逸脱した挙動異常を認識した場合、乖離発生理由として予測対象の移動体の挙動異常を推定してもよい。正常な挙動の範囲としては、操舵角速度の範囲、加速度の範囲、減速度の範囲などを予め設定することができる。その他、乖離発生理由推定部16は、予測対象の移動体挙動の検出結果から、予測対象の移動体が他の移動体に向かって急接近する挙動を行ったと認識した場合、乖離発生理由として予測対象の移動体の挙動異常を推定してもよい。
乖離発生理由推定部16は、乖離発生理由として移動体の種類の認識異常を推定してもよい。乖離発生理由推定部16は、例えば、挙動予測モデルの種類を変更し、挙動予測に用いた入力値としての移動体挙動の検出結果を用いて移動体の挙動予測の再演算を行う。乖離発生理由推定部16は、再演算による挙動予測と当該挙動予測に対応する移動体挙動の検出結果とでは予測乖離が生じないと判定される場合、予測乖離の原因は挙動予測モデルの種類の誤認識であると考えられることから、乖離発生理由として移動体の種類の認識異常を推定する。
乖離発生理由推定部16は、移動体の挙動予測及び当該挙動予測に対応する移動体挙動の検出結果の他、地図情報を用いて乖離発生理由を推定してもよい。この場合において、乖離発生理由推定部16は、地図情報から移動体進入不能領域を設定してもよい。移動体進入不能領域とは、道路脇の壁の上、川の中、海の中など移動体が進入できないと考えられる領域である。移動体進入不能領域は移動体の種類ごとに区別されていてもよい。移動体が車両である場合の移動体進入不能領域には、中央分離帯、歩道のうち車両通行帯とガードレールで仕切られた領域などを含めてもよい。移動体が歩行者である場合の移動体進入不能領域には、少なくとも歩道を含まない。移動体進入不能領域は地図情報に対して予め設定されていてもよい。
乖離発生理由推定部16は、挙動予測における移動体の位置が地図上の移動体進入不能領域に含まれず、挙動予測に対応する移動体挙動の検出結果における移動体の位置が地図上の移動体進入不能領域に含まれる場合、乖離発生理由として地図情報の異常を推定する。乖離発生理由推定部16は、車両などの移動体の位置が川などの移動体進入不能領域に含まれる場合、地図情報の異常に起因して予測乖離が生じたと考えられることから、乖離発生理由として地図情報の異常を推定する。
その他、乖離発生理由推定部16は、地図情報の異常などの他の乖離発生理由が推定されなかった場合、乖離発生理由として挙動予測モデルの精度不足を推定してもよい。乖離発生理由推定部16は、乖離発生理由として挙動予測モデルの精度不足を推定した場合において、挙動予測モデルの精度不足だけではなく、移動体の挙動にも予測乖離の原因が含まれる可能性があることから、当該移動体の特徴(形状など)を記憶してもよい。乖離発生理由推定部16は、記憶した移動体に関する情報をセンターに送信してもよい。これにより、挙動予測モデルによる挙動予測が合わない移動体(十分な挙動予測の精度を確保しにくい移動体)に関する情報を集めることができる。なお、挙動予測演算部14は、このような移動体に対する挙動予測において前回と異なる挙動予測モデルを用いるようにしてもよく、挙動予測モデルを用いない従来の挙動の推定を行ってもよい。
乖離発生理由推定部16は、乖離発生理由として地図情報の異常を推定した場合、地図DB4へ更新用情報を提供してもよい。乖離発生理由推定部16は、地図情報の異常が発生したときの自車両の地図上の位置などを更新用情報として地図DB4に提供する。なお、地図DB4への更新用情報の提供とは、地図DB4自体への情報提供の意味に限られず、地図DB4の更新をコントロールするサーバ又は電子制御ユニットへの情報提供も含まれる。乖離発生理由推定部16により乖離発生理由として地図情報の異常を推定した場合、挙動予測演算部14は、地図情報の異常が推定された自車両の地図上の位置(及び当該位置の周囲)において、地図情報を挙動予測に用いることを禁止してもよい。
車間マージン設定部17は、自車両の自動運転における車間マージンを設定する。車間マージンとは、自動運転中の自車両と先行車との車間の余裕である。車間マージン設定部17は、例えば予測乖離判定部15により予測乖離が生じていると判定された場合に、予測誤差に応じた車間マージンを設定する。予測誤差とは、移動体の挙動予測と当該挙動予測に対応する移動体挙動の検出結果との差である。
予測誤差は、予測乖離判定部15における予測乖離判定と同じ基準で演算することができる。すなわち、車間マージン設定部17は、予測乖離判定部15が挙動予測における移動体の位置と当該挙動予測に対応する移動体挙動の検出結果における移動体の位置に基づいて予測乖離が生じていると判定した場合、挙動予測における移動体の位置と当該挙動予測に対応する移動体挙動の検出結果における移動体の位置との差(離間距離)を予測誤差として演算する。その他、車間マージン設定部17は、挙動予測における移動体の進行方向と当該挙動予測に対応する移動体挙動の検出結果における移動体の進行方向との角度差を用いて予測誤差を演算してもよい。
車間マージン設定部17は、予測誤差が大きいほど車間マージンを大きい値として連続的に設定する。車間マージン設定部17は、段階的に車間マージンを設定してもよい。すなわち、車間マージン設定部17は、予測誤差が閾値以上である場合、予測誤差が閾値未満である場合と比べて、車間マージンを大きい値として設定してもよい。車間マージン設定部17は、設定した車間マージンを自動運転ECU6に送信する。自動運転ECU6は、自車両と先行車などの移動体との距離が設定された車間マージン以上となるように自車両の自動運転を行う。
車間マージン設定部17は、挙動予測が困難な状況である場合、車間マージンを設定してもよい。挙動予測が困難な状況とは、例えば道路構造が複雑である状況である。道路構造が複雑である状況には、例えば自車両が信号機のない右左折が可能な交差点に進入する状況が含まれる。挙動予測が困難な状況には、歩行者が多数存在する状況が含まれてもよく、動物などの予測困難な移動体が存在する状況を含んでもよい。
車間マージン設定部17は、地図情報及び自車両の地図上の位置、又は移動体挙動の検出結果から、挙動予測が困難な状況であるか否かを判定する。車間マージン設定部17は、挙動予測が困難な状況であると判定した場合、予め決められた車間マージンを設定する。予め決められた車間マージンは、固定値であってもよく、上述した挙動予測が困難な状況の種類に応じて異なる値であってもよい。車間マージン設定部17は、設定した車間マージンを自動運転ECU6に送信する。
更新要否判定部18は、予測乖離判定部15により予測乖離が生じていると判定された場合に、乖離発生理由推定部16の推定した乖離発生理由に基づいて、挙動予測モデルDB5の更新の要否を判定する。
まず、更新要否判定部18は、乖離発生理由と挙動予測及び挙動予測に対応する移動体挙動の検出結果に基づいて、挙動予測モデルDB5の更新必要度を演算する。更新要否判定部18は、例えば、挙動予測と挙動予測に対応する移動体挙動の検出結果と乖離発生理由とを入力することで更新必要度を出力する機械学習プログラムを用いて、挙動予測モデルDB5の更新必要度を演算する。更新要否判定部18は、挙動予測、挙動予測に対応する移動体挙動の検出結果、及び乖離発生理由と挙動予測モデルDB5の更新必要度とを予め関連付けたテーブルデータを用いて、更新必要度を演算してもよい。
また、更新要否判定部18は、上述した予測誤差(移動体の挙動予測と当該挙動予測に対応する移動体挙動の検出結果との差)が大きいほど、更新必要度を大きい値として連続的に演算してもよい。更新要否判定部18は、更新必要度を段階的に大きな値とするように演算してもよい。すなわち、更新要否判定部18は、予測誤差が閾値以上である場合、予測誤差が当該閾値未満である場合と比べて、更新必要度を大きな値とするように演算してもよい。
更新要否判定部18は、挙動予測モデルDB5の更新必要度が更新閾値以上である場合、挙動予測モデルDB5の更新が必要であると判定する。更新要否判定部18は、挙動予測モデルDB5の更新必要度が更新閾値未満である場合、挙動予測モデルDB5の更新が不要であると判定する。更新閾値は予め設定された値である。
なお、更新要否判定部18は、乖離発生理由のみから更新必要度を演算してもよい。更新要否判定部18は、例えば乖離発生理由と更新必要度とを予め関連付けたテーブルデータを用いて、乖離発生理由から更新必要度を演算する。
更新要否判定部18は、乖離発生理由として地図情報の異常が推定された場合には、挙動予測モデルに精度不足がある可能性が比較的小さいことから、更新必要度をゼロとしてもよい。同様に、更新要否判定部18は、乖離発生理由として移動体の種類の認識異常が推定された場合には、挙動予測モデルに精度不足がある可能性が比較的小さいことから、更新必要度をゼロとしてもよい。
更新要否判定部18は、乖離発生理由として予測対象の移動体の挙動異常が推定された場合、更新必要度をゼロとしてもよい。或いは、更新要否判定部18は、移動体の挙動異常にも対応する挙動予測を可能とするため、更新必要度を大きい値(後述する挙動予測モデルDB5の更新を必要と判定する値)としてもよい。更新要否判定部18は、乖離発生理由として挙動予測モデルの精度不足が推定された場合、更新必要度を大きい値(後述する挙動予測モデルDB5の更新を必要と判定する値)とする。
更新要否判定部18は、挙動予測モデルDB5の更新が必要と判定した場合、挙動予測モデルDB5へ更新用情報の提供を行う。更新要否判定部18は、例えば、今回の判定に関連する挙動予測及び挙動予測に対応する移動体挙動の検出結果を更新用情報として挙動予測モデルDB5へ提供する。挙動予測モデルDB5への更新用情報には、乖離発生理由を含めてもよく、更新必要度を含めてもよい。挙動予測モデルDB5への更新用情報には、挙動予測モデルによる挙動予測が対応できていない移動体として、移動体の種類の情報を含んでもよく、移動体が車両である場合には車種の情報を含んでもよい。挙動予測モデルDB5への更新用情報には、移動体の挙動予測を行ったときの自車両の周辺環境の情報を含んでもよい。
なお、挙動予測モデルDB5への更新用情報の提供とは、挙動予測モデルDB5自体への情報提供の意味に限られず、挙動予測モデルDB5の更新をコントロールするサーバ又は電子制御ユニットへの情報提供も含まれる。
また、挙動予測演算部14は、更新要否判定部18により挙動予測モデルDB5の更新が必要と判定された場合、予測乖離に関係する挙動予測モデルの使用を禁止する。挙動予測演算部14は、例えば当該挙動予測モデルが更新されるまで移動体の挙動予測に当該挙動予測モデルを用いない。なお、挙動予測演算部14は、更新要否判定部18により挙動予測モデルDB5の更新が必要と判定された場合に、必ずしも一回の判定で予測乖離に関係する挙動予測モデルの使用を禁止する必要はなく、更新が必要との判定が一定回数以上行われた場合に挙動予測モデルの使用を禁止する態様であってもよい。
〈第1実施形態の挙動予測装置の処理〉
次に、第1実施形態の挙動予測装置100の処理について図面を参照して説明する。
《挙動予測処理》
図2は、挙動予測処理の一例を示すフローチャートである。図2に示すフローチャートの処理は、例えば自車両のエンジン駆動中又は自車両の自動運転中に実行される。
図2に示すように、挙動予測装置100の挙動予測ECU10は、S10として、移動体挙動検出部12による移動体挙動の検出及び種類認識部13による移動体の種類の認識を行う。移動体挙動検出部12は、外部センサ2の検出結果に基づいて、自車両の周囲の移動体挙動を検出する。種類認識部13は、外部センサ2の検出結果に基づいて、移動体の種類を認識する。その後、挙動予測ECU10は、S12に移行する。
S12において、挙動予測ECU10は、挙動予測演算部14により移動体の挙動予測に利用可能な地図情報が存在するか否かを判定する。挙動予測演算部14は、地図DB4の地図情報及び車両位置認識部11の認識した自車両の地図上の位置に基づいて、移動体の挙動予測に利用可能な地図情報が存在するか否かの判定を行う。挙動予測ECU10は、移動体の挙動予測に利用可能な地図情報が存在すると判定された場合(S12:YES)、S14に移行する。挙動予測ECU10は、移動体の挙動予測に利用可能な地図情報が存在しないと判定された場合(S12:NO)、S16に移行する。
S14において、挙動予測ECU10は、挙動予測演算部14により移動体の挙動予測を行う。S14では、挙動予測演算部14は、地図情報、自車両の地図上の位置、移動体挙動の検出結果、及び移動体の種類の認識結果に基づいて挙動予測モデルDB5の挙動予測モデルを利用することで移動体の挙動予測を演算する。その後、挙動予測ECU10は、今回の処理を終了する。
S16において、挙動予測ECU10は、挙動予測演算部14により移動体の挙動予測を行う。S16では、挙動予測演算部14は、地図情報を用いず、自車両の地図上の位置、移動体挙動の検出結果、及び移動体の種類の認識結果に基づいて挙動予測モデルDB5の挙動予測モデルを利用することで移動体の挙動予測を演算する。その後、挙動予測ECU10は、今回の処理を終了する。
《更新要否判定処理》
図3は、更新要否判定処理の一例を示すフローチャートである。図3に示すフローチャートは、図2に示される挙動予測が行われる度に実行される。
図3に示すように、挙動予測ECU10は、S20として、予測乖離判定部15により予測乖離が生じているか否かを判定する。予測乖離判定部15は、挙動予測演算部14による移動体の挙動予測と当該挙動予測に対応する移動体挙動の検出結果とに基づいて、予測乖離が生じているか否かの判定を行う。挙動予測ECU10は、予測乖離が生じていると判定されなかった場合(S20:NO)、今回の処理を終了する。挙動予測ECU10は、予測乖離が生じていると判定された場合(S20:YES)、S22に移行する。
S22において、挙動予測ECU10は、乖離発生理由推定部16により乖離発生理由を推定する。乖離発生理由推定部16は、移動体の挙動予測と当該挙動予測に対応する移動体挙動の検出結果と地図情報とに基づいて、乖離発生理由を推定する。乖離発生理由推定部16は、例えば、挙動予測における移動体の位置が地図上の移動体進入不能領域に含まれず、挙動予測に対応する移動体挙動の検出結果における移動体の位置が地図上の移動体進入不能領域に含まれる場合、乖離発生理由として地図情報の異常を推定する。乖離発生理由推定部16は、地図情報の異常などの他の乖離発生理由が推定されなかった場合、乖離発生理由として挙動予測モデルの精度不足を推定してもよい。その後、挙動予測ECU10は、S24に移行する。
S24において、挙動予測ECU10は、更新要否判定部18により挙動予測モデルDB5の更新必要度を演算する。更新要否判定部18は、乖離発生理由と挙動予測と挙動予測に対応する移動体挙動の検出結果とに基づいて更新必要度を演算する。更新要否判定部18は、乖離発生理由のみに基づいて更新必要度を演算してもよい。その後、挙動予測ECU10は、S26に移行する。
S26において、挙動予測ECU10は、更新要否判定部18により挙動予測モデルDB5の更新の要否を判定する。更新要否判定部18は、更新必要度が更新閾値以上である場合、挙動予測モデルDB5の更新が必要であると判定する。更新要否判定部18は、更新必要度が更新閾値未満である場合、挙動予測モデルDB5の更新が不要であると判定する。挙動予測ECU10は、挙動予測モデルDB5の更新が必要であると判定した場合(S26:YES)、S28に移行する。挙動予測ECU10は、挙動予測モデルDB5の更新が不要であると判定した場合(S26:NO)、S32に移行する。
S28において、挙動予測ECU10は、挙動予測演算部14により予測乖離に関係する挙動予測モデルの使用を禁止する。挙動予測演算部14は、例えば当該挙動予測モデルが更新されるまで移動体の挙動予測に当該挙動予測モデルを用いない。挙動予測ECU10は、挙動予測モデルの使用を禁止した場合、S30に移行する。
S30において、挙動予測ECU10は、更新要否判定部18により挙動予測モデルDB5への更新用情報の提供を行う。更新要否判定部18は、例えば、今回の判定に関連する挙動予測及び挙動予測に対応する移動体挙動の検出結果を更新用情報として挙動予測モデルDB5へ提供する。その後、挙動予測ECU10は、今回の処理を終了する。
S32において、挙動予測ECU10は、乖離発生理由推定部16により乖離発生理由が地図情報の異常であるか否かを判定する。挙動予測ECU10は、乖離発生理由が地図情報の異常であると判定した場合(S32:YES)、S34に移行する。挙動予測ECU10は、乖離発生理由が地図情報の異常ではないと判定した場合(S32:NO)、今回の処理を終了する。
S34において、挙動予測ECU10は、乖離発生理由推定部16により地図DB4へ更新用情報を提供する。乖離発生理由推定部16は、地図情報の異常が発生したときの自車両の地図上の位置などを更新用情報として地図DB4に提供する。その後、挙動予測ECU10は、今回の処理を終了する。
《車間マージン設定処理》
図4(a)は、車間マージン設定処理の一例を示すフローチャートである。図4(a)に示すフローチャートの処理は、自車両の自動運転開始時に開始される。
図4(a)に示すように、挙動予測ECU10は、S40として、車間マージン設定部17により挙動予測が困難な状況であるか否かを判定する。車間マージン設定部17は、例えば自車両が信号機のない右左折が可能な交差点に進入する状況である場合、挙動予測が困難な状況であると判定する。挙動予測ECU10は、挙動予測が困難な状況であると判定されなかった場合(S40:NO)、今回の処理を終了する。その後、挙動予測ECU10は、自車両が自動運転中である場合、一定時間の経過後に再びS40から処理を繰り返す。挙動予測ECU10は、挙動予測が困難な状況であると判定された場合(S40:YES)、S42に移行する。
S42において、挙動予測ECU10は、車間マージン設定部17により車間マージンを設定する。車間マージン設定部17は、例えば挙動予測が困難な状況の種類に応じて予め決められた車間マージンを設定する。車間マージン設定部17は、設定した車間マージンを自動運転ECU6に送信する。その後、挙動予測ECU10は、自車両が自動運転中である場合、一定時間の経過後に再びS40から処理を繰り返す。
図4(b)は、車間マージン設定処理の他の例を示すフローチャートである。図4(b)に示すフローチャートの処理は、自車両の自動運転中に予測乖離判定部15により予測乖離が生じていると判定される度に実行される。
図4(b)に示すように、挙動予測ECU10は、S50として、車間マージン設定部17により予測誤差の演算を行う。車間マージン設定部17は、例えば、挙動予測における移動体の位置と当該挙動予測に対応する移動体挙動の検出結果における移動体の位置との差(離間距離)を予測誤差として演算する。その後、挙動予測ECU10は、S52に移行する。
S52において、挙動予測ECU10は、車間マージン設定部17により予測誤差に応じた車間マージンの設定を行う。車間マージン設定部17は、例えば予測誤差が大きいほど車間マージンを大きい値として連続的に設定する。車間マージン設定部17は、設定した車間マージンを自動運転ECU6に送信する。その後、挙動予測ECU10は今回の処理を終了する。
〈第1実施形態の挙動予測装置の作用効果〉
以上説明した第1実施形態の挙動予測装置100によれば、移動体の挙動予測と挙動予測に対応する移動体挙動の検出結果との予測乖離が生じていると判定された場合に、移動体の挙動予測と検出結果とから乖離発生理由を推定し、乖離発生理由に基づいて挙動予測モデルDB5の更新の要否を判定するので、乖離発生理由を考慮しない場合と比べて挙動予測モデルDB5の更新の要否を適切に判定することができる。
また、挙動予測装置100によれば、乖離発生理由に基づいて挙動予測モデルDB5の更新必要度を演算することで、更新必要度を用いて挙動予測モデルDB5の更新の要否を判定することができる。
更に、挙動予測装置100によれば、地図情報を考慮して挙動予測モデルを利用した移動体の挙動予測を演算することができるので、地図情報を用いない場合と比べて挙動予測の精度向上を図ることが可能になる。また、挙動予測装置100では、挙動予測における移動体の位置が川などの移動体進入不能領域に含まれないにも関わらず、挙動予測に対応する移動体挙動の検出結果における移動体の位置が移動体進入不能領域に含まれる場合には、地図情報の異常により予測乖離が生じたと考えられるので、乖離発生理由として地図情報の異常を推定して挙動予測モデルDB5の更新を不要とすることができる。
また、挙動予測装置100では、車両、歩行者などの移動体の種類を考慮して挙動予測モデルを利用した移動体の挙動予測を演算することができるので、移動体の種類を考慮しない場合と比べて挙動予測の精度向上を図ることが可能になる。
[第2実施形態]
次に、第2実施形態の挙動予測装置について図面を参照して説明する。図5は、第2実施形態の挙動予測装置を示すブロック図である。図5に示す第2実施形態の挙動予測装置200は、第1実施形態と比べて、挙動予測として短期挙動予測と長期挙動予測とを行い、短期挙動予測の予測乖離の場合と長期挙動予測の予測乖離の場合とで処理を変える機能を更に有している点が異なっている。
〈第2実施形態の挙動予測装置の構成〉
図5に示すように、第2実施形態の挙動予測装置200は、第1実施形態と比べて、挙動予測演算部21、予測乖離判定部22、乖離発生理由推定部23、車間マージン設定部24、及び更新要否判定部25の機能が異なっている。
挙動予測演算部21は、短期挙動予測及び長期挙動予測を行う。短期挙動予測とは、予め設定された短期予測時点(例えば現時点から5秒以内の時点)における挙動予測である。長期挙動予測とは、予め設定された長期予測時点(例えば現時点から5秒より後の時点)における挙動予測である。短期予測時点は、例えば1秒後、2秒後、3秒後、4秒後、5秒後の時点である。長期予測時点は、例えば現時点から10秒後、15秒後、20秒後の時点である。
なお、短期予測時点は、予め設定された第1基準時点より前の予測時点であればよく、第1基準時点は必ずしも5秒である必要はない。長期予測時点も、予め設定された第2基準時点より後の予測時点であればよく、第2基準時点は必ずしも第1基準時点と同じである必要はない。第2基準時点は、第1基準時点より前の時点であってもよい。本実施形態では説明の簡素化のため、挙動予測の予測時点は短期予測時点と長期挙動予測との何れかに分けられることとする。
予測乖離判定部22は、挙動予測演算部21による移動体の短期挙動予測と当該短期挙動予測に対応する移動体挙動の検出結果とに基づいて、予測乖離が生じているか否かを判定する。予測乖離判定部22は、予測時点ごとに予測乖離が生じているか否かを判定する。同様に、予測乖離判定部22は、挙動予測演算部21による移動体の長期挙動予測と当該長期挙動予測に対応する移動体挙動の検出結果とに基づいて、予測乖離が生じているか否かを判定する。予測乖離判定部22は、短期挙動予測と長期挙動予測とで、予測乖離の判定に用いる閾値(距離閾値、角度閾値など)を異なる値としてもよい。
乖離発生理由推定部23は、予測乖離判定部15により短期挙動予測に予測乖離が生じていると判定された場合、移動体の短期挙動予測と当該短期挙動予測に対応する移動体挙動の検出結果とに基づいて、短期挙動予測の乖離発生理由を推定する。また、乖離発生理由推定部23は、予測乖離判定部22により長期挙動予測に予測乖離が生じていると判定された場合、移動体の短期挙動予測と当該短期挙動予測に対応する移動体挙動の検出結果とに基づいて、短期挙動予測の乖離発生理由を推定する。
ここで、乖離発生理由推定部23は、短期挙動予測においては地図情報の異常などの外的な要因ではなく、挙動予測モデルの精度不足が予測乖離を招いている可能性が高いことから、短期挙動予測の予測乖離が生じていると判定された場合、長期挙動予測の予測乖離が生じていると判定された場合と比べて、挙動予測モデルの精度不足が乖離発生理由であると推定しやすくする。乖離発生理由推定部23は、短期挙動予測の予測乖離が生じていると判定された場合には、常に乖離発生理由として挙動予測モデルの精度不足を推定してもよい。
一方で、乖離発生理由推定部23は、短期挙動予測の予測乖離が生じていると判定されず、長期挙動予測の予測乖離が生じていると判定された場合には、地図情報の異常などの外的な要因が予測乖離を招いている可能性が高くなることから、短期挙動予測の予測乖離が生じていると判定された場合と比べて、挙動予測モデルの精度不足が乖離発生理由であると推定しにくくする。乖離発生理由推定部23は、短期挙動予測の予測乖離が生じていると判定されず、長期挙動予測の予測乖離が生じていると判定された場合には、挙動予測モデルの精度不足以外の乖離発生理由を推定する態様としてもよい。
車間マージン設定部24は、予測乖離判定部22により短期挙動予測の予測乖離が生じていると判定されず、長期挙動予測に予測乖離が生じていると判定された場合(長期挙動予測の予測乖離のみが生じていると判定された場合)、予め決められた車間マージンを設定する。車間マージン設定部24は、予測誤差に応じた大きさの車間マージンを設定してもよい。
車間マージン設定部24は、現時点に近い短期予測時点ではなく長期予測時点の予測乖離のみであることから、自車両の減速などではなく、車間マージンを予め設定することにより長期挙動予測の予測乖離の影響が自動運転に与える影響を少なくする。車間マージン設定部24は、設定した車間マージンを自動運転ECU6に送信する。
更新要否判定部25は、同じ乖離発生理由に基づいた更新必要度の演算において、短期挙動予測の予測乖離と長期挙動予測の予測乖離とで更新必要度を異なる値として演算する。すなわち、更新要否判定部25は、同じ乖離発生理由に基づいた更新必要度の演算において、予測乖離判定部22により短期挙動予測の予測乖離が生じていると判定された場合、短期挙動予測の予測乖離が生じておらず長期挙動予測の予測乖離のみが生じていると判定された場合と比べて、挙動予測モデルDB5の更新必要度を大きい値として演算する。
具体的に、更新要否判定部25は、予測乖離判定部22により短期挙動予測の予測乖離が生じていると判定された場合、更新必要度を第一の値として演算する。更新要否判定部25は、同じ乖離発生理由に基づいた更新必要度の演算において、予測乖離判定部22により短期挙動予測の予測乖離が生じていると判定されておらず長期挙動予測の予測乖離のみが生じていると判定された場合、更新必要度を第二の値として演算する。第二の値は、第一の値より大きい値を意味する。更新要否判定部25は、短期挙動予測においては地図情報の異常などの外的な要因ではなく、挙動予測モデルの精度不足が予測乖離を招いている可能性が高くなることから更新必要度を大きい値として演算する。
なお、更新要否判定部25は、短期挙動予測の予測乖離が生じていると判定された場合、短期挙動予測に基づいて生成された自車両の自動運転の走行計画を継続すると、移動体と急接近するなどの影響が生じる可能性があることから、自動運転ECU6に減速要求を行ってもよい。自動運転ECU6は、自動運転中の自車両の減速を行う。
一方、更新要否判定部25は、長期挙動予測の予測乖離のみが生じていると判定された場合、自車両の自動運転の走行計画を継続すると、10秒後や20秒後などに自車両と移動体との接近が生じるなどの影響が生じる可能性があることから、車間マージン設定部17により車間マージンを設定して自動運転ECU6に送信してもよい。この場合において、更新要否判定部25は、予測乖離が生じていると判定された移動体が先行車又は後続車である場合には、自車両のレーンチェンジ要求を自動運転ECU6に送信してもよい。自動運転ECU6は、予測乖離が生じていると判定された移動体と自車両との距離を取るように又は移動体と自車両とが異なる車線となるように自車両の自動運転を行う。
〈第2実施形態の挙動予測装置の更新必要度演算処理〉
続いて、第2実施形態の挙動予測装置200の更新必要度演算処理の一例について図6を参照して説明する。図6は、第2実施形態における更新必要度演算処理の一例を示すフローチャートである。
図6に示す更新必要度演算処理は、第1実施形態における図3のフローチャートのS24の処理に対応する。すなわち、図6に示す更新必要度演算処理は、図3のフローチャートのS20で既に予測乖離が生じていると判定された後の処理である。図3のフローチャートのその他の処理は、第1実施形態と同様であるため説明を省略する。なお、ここでは移動体が自車両の前方を走行する先行車である場合の例とし、予測乖離の判定結果に応じた自車両の自動運転ECU6への要求についても言及する。
図6に示すように、挙動予測ECU20は、S60として、予測乖離判定部22により先行車の短期挙動予測の予測乖離が生じているか否かを判定する。予測乖離判定部22は、例えば、一つの短期予測時点に対応する短期挙動予測における先行車の位置と当該短期予測時点において検出された先行車の位置(移動体挙動の検出結果の位置)とが距離閾値以上に離れている場合、先行車の短期挙動予測の予測乖離が生じていると判定する。
挙動予測ECU20は、先行車の短期挙動予測の予測乖離が生じていると判定された場合(S60:YES)、S62に移行する。挙動予測ECU20は、先行車の短期挙動予測の予測乖離が生じていると判定されなかった場合(S60:NO)、S66に移行する。なお、本フローチャートにおいては、先行車の短期挙動予測の予測乖離が生じていると判定されなかった場合とは、先行車の短期挙動予測の予測乖離が生じておらず長期挙動予測の予測乖離が生じている場合を意味する。
S62において、挙動予測ECU20は、更新要否判定部25により更新必要度を第一の値として演算する。更新要否判定部25は、予測乖離判定部22により短期挙動予測の予測乖離が生じていると判定された場合、乖離発生理由に基づいて更新必要度を第一の値として演算する。第一の値は、乖離発生理由ごとに予め設定された値であってもよい。その後、挙動予測ECU20は、S64に移行する。
S64において、挙動予測ECU20は、更新要否判定部25により自車両の減速要求を行う。更新要否判定部25は、短期挙動予測の予測乖離に起因して自車両及び移動体が急接近するなどの影響が生じる可能性があることから、自動運転ECU6に減速要求を行う。その後、挙動予測ECU20は、今回の処理を終了する。
S66において、挙動予測ECU20は、更新要否判定部25により更新必要度を第二の値として演算する。すなわち、更新要否判定部25は、先行車の短期挙動予測の予測乖離が生じておらず長期挙動予測の予測乖離が生じている場合、乖離発生理由に基づいて更新必要度を第二の値として演算する。第二の値は、乖離発生理由が同じである場合には第一の値より大きい値となる。第二の値は、乖離発生理由ごとに予め設定された値であってもよい。その後、挙動予測ECU20は、S68に移行する。
S68において、挙動予測ECU20は、車間マージン設定部24により車間マージンの設定を行う。車間マージン設定部24は、設定した車間マージンを自動運転ECU6に送信する。その後、挙動予測ECU20は、今回の処理を終了する。なお、図6に示すフローチャートにおけるS64及びS68の処理は必ずしも行う必要はない。
[第2実施形態の挙動予測装置の作用効果]
以上説明した第2実施形態の挙動予測装置200によれば、挙動予測の予測時点が先の時点であるほど挙動予測モデル以外の影響により予測乖離が生じた可能性が高まっていくことから、短期挙動予測の予測乖離が生じていると判定された場合には、長期挙動予測の予測乖離が生じていると判定された場合と比べて挙動予測モデルDBの更新必要度を大きい値とすることで、挙動予測モデルDBの更新の要否を適切に判定することができる。
以上、本発明の好適な実施形態について説明したが、本発明は上述した実施形態に限定されるものではない。本発明は、上述した実施形態を始めとして、当業者の知識に基づいて種々の変更、改良を施した様々な形態で実施することができる。
挙動予測装置100、200は、自動運転システムの一部であってもよい。この場合、挙動予測ECU10、20は、自動運転ECU6と一体であってもよい。
一方で、挙動予測装置100、200は、必ずしも自動運転ECU6と接続されている必要はない。挙動予測装置100、200の挙動予測の結果の用い方は特に限定されない。挙動予測装置100、200は、運転者に対する移動体の注意喚起などの運転支援制御を行う運転支援ECUと接続されていてもよい。
挙動予測装置100、200は、移動体の挙動予測に必ずしも地図情報を用いる必要はない。この場合には、乖離発生理由の推定においても地図情報を用いることはなく、地図DB4は必須ではない。
挙動予測装置100、200は、乖離発生理由推定部16、23により乖離発生理由として予測対象の移動体の挙動異常が推定された場合、当該移動体の特徴情報(形状、追跡結果など)を記憶してもよい。同様に、挙動予測装置100、200は、乖離発生理由推定部16、23により乖離発生理由として挙動予測モデルの精度不足と推定された場合であっても、挙動予測モデルの精度不足だけではなく挙動予測モデルと移動体との相性(挙動予測モデルによる挙動予測が苦手とする移動体などの相性)も影響すると考えられることから、当該移動体の特徴情報を記憶してもよい。
この場合、挙動予測演算部14、21は、特徴情報を記憶した移動体に対して、挙動予測モデルを変えた挙動予測、挙動予測モデルを用いない従来の挙動予測など別な方法による挙動予測を行ってもよい。挙動予測演算部14、21は、挙動予測の予測時点の間隔を短くしてもよい(例えば1秒間隔の挙動予測ではなく0.5秒間隔の挙動予測を行う)。その他、挙動予測装置100、200は、移動体の特徴情報をセンターに送信してもよい。
また、挙動予測装置100、200は、特徴情報を記憶した移動体から自動運転中の自車両が離れるように自動運転ECU6に車両制御を要求する。挙動予測装置100、200は、車間マージンの設定又はレーンチェンジを自動運転ECU6に要求してもよい。自動運転ECU6は、自車両が移動体から離れるように車間距離の調整又はレーンチェンジを行う。
また、挙動予測装置100、200は、移動体の挙動予測に必ずしも移動体の種類を用いる必要はない。この場合、挙動予測ECU10,20は、種類認識部13を有する必要はない。挙動予測装置100、200は、必ずしも車間マージンの設定を行う必須ではない。この場合、車間マージン設定部17、24は不要である。
また、挙動予測装置100、200は、必ずしも更新必要度を演算する必要はない。挙動予測装置100、200は、乖離発生理由から直接的に挙動予測モデルDB5の更新の要否を判定してもよい。更新要否判定部18、25は、例えば、乖離発生理由が挙動予測モデルの精度不足である場合には、挙動予測モデルDB5の更新が必要であると判定してもよい。更新要否判定部18、25は、乖離発生理由が地図情報の異常である場合又は移動体の種類の認識異常である場合には、挙動予測モデルDB5の更新が不要であると判定してもよい。同様に、更新要否判定部18、25は、乖離発生理由が予測対象の移動体の挙動異常である場合にも、挙動予測モデルDB5の更新が不要であると判定してもよい。
その他、挙動予測装置100、200は、移動体の挙動予測の予測乖離が生じていない場合、自動運転の行動計画及び/又は走行計画について異常判定を行ってもよい。自動運転の行動計画について、一定時間前の行動計画から変更があり一致していない場合には、行動計画の異常と判定することができる。自動運転の走行計画について、運転者が自動運転を中断させた場合には走行計画の異常と判定することができる。挙動予測装置100、200は、異常判定結果を運転者に通知する。
また、挙動予測装置100、200は、物体追跡ロジックの異常検知を行ってもよい。挙動予測装置100、200は、移動体の挙動予測の予測乖離が生じていると判定した場合であっても、物体追跡ロジックの異常を検知した場合には、挙動予測モデルDB5の更新を不要と判定してもよい。挙動予測装置100、200は、物体追跡ロジックの異常を運転者に通知する。挙動予測装置100、200は、自車両の自動運転中に、物体追跡ロジックの異常によって自車両の周囲の移動体をロストした場合(例えば直進路にもかかわらず先行車をロストした場合)には、運転者に手動運転への切り換え(ハンドオーバ)を要求してもよい。
1…GPS受信部、2…外部センサ、3…内部センサ、4…地図DB、5…挙動予測モデルDB、6…自動運転ECU、10,20…挙動予測ECU、11…車両位置認識部、12…移動体挙動検出部、13…種類認識部、14,21…挙動予測演算部、15,22…予測乖離判定部、16,23…乖離発生理由推定部、17,24…車間マージン設定部、18、25…更新要否判定部、100、200…挙動予測装置。

Claims (6)

  1. 自車両の周囲の移動体の位置、進行方向、及び速度を少なくとも含む移動体挙動を検出する移動体挙動検出部と、
    前記移動体挙動を予測するための挙動予測モデルを記憶する挙動予測モデルデータベースと、
    前記移動体挙動の検出結果に基づいて、前記挙動予測モデルを利用して前記移動体の挙動予測を演算する挙動予測演算部と、
    前記挙動予測と当該挙動予測に対応する前記移動体挙動の検出結果とに基づいて、予測乖離が生じているか否かを判定する予測乖離判定部と、
    前記予測乖離判定部により前記予測乖離が生じていると判定された場合に、前記挙動予測と前記挙動予測に対応する前記移動体挙動の検出結果とに基づいて、乖離発生理由を推定する乖離発生理由推定部と、
    前記予測乖離判定部により前記予測乖離が生じていると判定された場合に、前記乖離発生理由に基づいて、前記挙動予測モデルデータベースの更新の要否を判定する更新要否判定部と、
    を備える挙動予測装置。
  2. 前記更新要否判定部は、前記予測乖離判定部により前記予測乖離が生じていると判定された場合に、前記乖離発生理由に基づいて前記挙動予測モデルデータベースの更新必要度を演算し、前記更新必要度が更新閾値以上であるとき前記挙動予測モデルデータベースの更新が必要であると判定する、請求項1に記載の挙動予測装置。
  3. 前記挙動予測演算部は、予め設定された短期予測時点における前記移動体の挙動予測である短期挙動予測と、前記短期予測時点より後の時点として予め設定された長期予測時点における前記移動体の挙動予測である長期挙動予測とを少なくとも演算し、
    前記更新要否判定部は、同じ前記乖離発生理由に基づいた前記更新必要度の演算において、前記予測乖離判定部により前記短期挙動予測の前記予測乖離が生じていると判定された場合、前記短期挙動予測の前記予測乖離が生じておらず前記長期挙動予測の前記予測乖離のみが生じていると判定された場合と比べて、前記更新必要度を大きい値として演算する、請求項2に記載の挙動予測装置。
  4. 車線毎の位置情報を含む地図情報を記憶する地図データベースと、
    前記自車両の地図上の位置を認識する車両位置認識部と、を更に備え、
    前記挙動予測モデルデータベースには、前記地図情報における地図上の位置と関連付けて前記挙動予測モデルが記憶されており、
    前記挙動予測演算部は、前記移動体挙動の検出結果と前記挙動予測モデルと前記地図情報と前記自車両の地図上の位置とに基づいて前記移動体の挙動予測を演算する、請求項1〜3のうち何れか一項に記載の挙動予測装置。
  5. 前記乖離発生理由推定部は、前記挙動予測における前記移動体の位置が地図上の移動体進入不能領域に含まれず、前記挙動予測に対応する前記移動体挙動の検出結果における前記移動体の位置が地図上の前記移動体進入不能領域に含まれる場合、前記乖離発生理由として前記地図情報の異常を推定し、
    前記更新要否判定部は、前記乖離発生理由推定部により前記乖離発生理由として前記地図情報の異常が推定された場合、前記挙動予測モデルデータベースの更新を不要と判定する、請求項4に記載の挙動予測装置。
  6. 前記移動体の種類を認識する種類認識部を更に備え、
    前記挙動予測モデルデータベースには、前記移動体の種類と関連付けて前記挙動予測モデルが記憶されており、
    前記挙動予測演算部は、前記移動体挙動の検出結果と前記挙動予測モデルと前記移動体の種類とに基づいて、前記移動体の挙動予測を演算する、請求項1〜5のうち何れか一項に記載の挙動予測装置。
JP2018073209A 2018-04-05 2018-04-05 挙動予測装置 Active JP6985203B2 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2018073209A JP6985203B2 (ja) 2018-04-05 2018-04-05 挙動予測装置
US16/375,232 US11498577B2 (en) 2018-04-05 2019-04-04 Behavior prediction device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018073209A JP6985203B2 (ja) 2018-04-05 2018-04-05 挙動予測装置

Publications (2)

Publication Number Publication Date
JP2019182093A true JP2019182093A (ja) 2019-10-24
JP6985203B2 JP6985203B2 (ja) 2021-12-22

Family

ID=68097255

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018073209A Active JP6985203B2 (ja) 2018-04-05 2018-04-05 挙動予測装置

Country Status (2)

Country Link
US (1) US11498577B2 (ja)
JP (1) JP6985203B2 (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021205276A1 (ja) * 2020-04-10 2021-10-14 株式会社半導体エネルギー研究所 位置推定システム、位置推定装置、及び移動体
WO2022113772A1 (ja) * 2020-11-27 2022-06-02 ソニーグループ株式会社 情報処理装置、情報処理方法、及び、情報処理システム
JP2022086680A (ja) * 2020-11-30 2022-06-09 トヨタ自動車株式会社 挙動予測装置
US11814036B2 (en) 2020-10-29 2023-11-14 Toyota Jidosha Kabushiki Kaisha Control method of vehicle and control apparatus thereof
WO2024038501A1 (ja) * 2022-08-16 2024-02-22 日本電気株式会社 移動体追跡装置、方法、及びコンピュータ可読媒体

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102018214551A1 (de) * 2018-08-28 2020-03-05 Bayerische Motoren Werke Aktiengesellschaft Abbiegeassistent im Fahrzeug
US11447130B2 (en) * 2019-03-28 2022-09-20 Nissan Motor Co., Ltd. Behavior prediction method, behavior prediction apparatus and vehicle control apparatus
DE102019205802A1 (de) * 2019-04-23 2020-10-29 Robert Bosch Gmbh Verfahren zum Betreiben eines Fahrassistenzsystems und Fahrassistenzsystem
US11787407B2 (en) * 2019-07-24 2023-10-17 Pony Ai Inc. System and method for sensing vehicles and street
JP7212607B2 (ja) * 2019-09-26 2023-01-25 ペンタ・セキュリティ・システムズ・インコーポレーテッド 車両can bus信号を利用した機械学習基盤運転者異常感知方法および装置
US11868136B2 (en) * 2019-12-19 2024-01-09 Woven By Toyota, U.S., Inc. Geolocalized models for perception, prediction, or planning
DE102020200176A1 (de) * 2020-01-09 2021-07-15 Robert Bosch Gesellschaft mit beschränkter Haftung Verwertung eines ortsüblichen Verhaltens für automatisierte Fahrfunktionen

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010182236A (ja) * 2009-02-09 2010-08-19 Toyota Motor Corp 移動領域予測装置
JP2012164158A (ja) * 2011-02-07 2012-08-30 Toyota Motor Corp 可動物予測装置、可動物予測プログラム及び可動物予測方法
US20170166123A1 (en) * 2015-12-10 2017-06-15 International Business Machines Corporation Vehicle accident avoidance system

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8509982B2 (en) 2010-10-05 2013-08-13 Google Inc. Zone driving
US9381916B1 (en) * 2012-02-06 2016-07-05 Google Inc. System and method for predicting behaviors of detected objects through environment representation
US8718861B1 (en) * 2012-04-11 2014-05-06 Google Inc. Determining when to drive autonomously
JP6269552B2 (ja) * 2015-03-31 2018-01-31 トヨタ自動車株式会社 車両走行制御装置
US9764736B2 (en) * 2015-08-14 2017-09-19 Toyota Motor Engineering & Manufacturing North America, Inc. Autonomous vehicle operation relative to unexpected dynamic objects
US9864918B2 (en) * 2015-11-04 2018-01-09 Ford Global Technologies, Llc Predicting vehicle movements based on driver body language

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010182236A (ja) * 2009-02-09 2010-08-19 Toyota Motor Corp 移動領域予測装置
JP2012164158A (ja) * 2011-02-07 2012-08-30 Toyota Motor Corp 可動物予測装置、可動物予測プログラム及び可動物予測方法
US20170166123A1 (en) * 2015-12-10 2017-06-15 International Business Machines Corporation Vehicle accident avoidance system

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021205276A1 (ja) * 2020-04-10 2021-10-14 株式会社半導体エネルギー研究所 位置推定システム、位置推定装置、及び移動体
US11814036B2 (en) 2020-10-29 2023-11-14 Toyota Jidosha Kabushiki Kaisha Control method of vehicle and control apparatus thereof
WO2022113772A1 (ja) * 2020-11-27 2022-06-02 ソニーグループ株式会社 情報処理装置、情報処理方法、及び、情報処理システム
JP2022086680A (ja) * 2020-11-30 2022-06-09 トヨタ自動車株式会社 挙動予測装置
JP7294304B2 (ja) 2020-11-30 2023-06-20 トヨタ自動車株式会社 挙動予測装置
WO2024038501A1 (ja) * 2022-08-16 2024-02-22 日本電気株式会社 移動体追跡装置、方法、及びコンピュータ可読媒体

Also Published As

Publication number Publication date
JP6985203B2 (ja) 2021-12-22
US20190311272A1 (en) 2019-10-10
US11498577B2 (en) 2022-11-15

Similar Documents

Publication Publication Date Title
JP6985203B2 (ja) 挙動予測装置
CN108263382B (zh) 基于目标车辆的驾驶样式的协同自适应巡航控制系统
CN108263383B (zh) 在协同自适应巡航控制系统中控制速度的装置和方法
US9141109B1 (en) Automated driving safety system
US11092442B2 (en) Host vehicle position estimation device
US20190346847A1 (en) Autonomous driving system
US11042160B2 (en) Autonomous driving trajectory determination device
CN112208533B (zh) 车辆控制系统、车辆控制方法及存储介质
US11631257B2 (en) Surroundings recognition device, and surroundings recognition method
US11217045B2 (en) Information processing system and server
US11780448B2 (en) Vehicle behavior estimation method, vehicle control method, and vehicle behavior estimation device
JP2021033614A (ja) 自動運転システム
CN110001648B (zh) 车辆控制装置
JP2023085371A (ja) 走行記憶システム、および走行記憶方法
WO2022065021A1 (ja) 自動運転装置
CN114194186B (zh) 车辆行驶控制装置
US10845814B2 (en) Host vehicle position confidence degree calculation device
US20180286222A1 (en) Vehicle identifying device
JP2016113092A (ja) 車両制御装置
JP2020060674A (ja) 地図情報システム
JP7334107B2 (ja) 車両制御方法及び車両制御装置
JP7363062B2 (ja) 走行環境異常判定システム
US20220342417A1 (en) Remote function selection device
WO2022025086A1 (ja) 経路確認装置、経路確認方法および車両制御方法
JP2023013458A (ja) 情報処理サーバ、情報処理サーバの処理方法、プログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200923

TRDD Decision of grant or rejection written
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20211028

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20211102

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20211125

R151 Written notification of patent or utility model registration

Ref document number: 6985203

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151