JP7232166B2 - 予測装置、車両システム、予測方法、およびプログラム - Google Patents

予測装置、車両システム、予測方法、およびプログラム Download PDF

Info

Publication number
JP7232166B2
JP7232166B2 JP2019191022A JP2019191022A JP7232166B2 JP 7232166 B2 JP7232166 B2 JP 7232166B2 JP 2019191022 A JP2019191022 A JP 2019191022A JP 2019191022 A JP2019191022 A JP 2019191022A JP 7232166 B2 JP7232166 B2 JP 7232166B2
Authority
JP
Japan
Prior art keywords
unit
risk area
time
prediction
processing
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
JP2019191022A
Other languages
English (en)
Other versions
JP2021068013A (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.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
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 Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP2019191022A priority Critical patent/JP7232166B2/ja
Priority to US17/068,847 priority patent/US11866071B2/en
Priority to CN202011096175.9A priority patent/CN112677978B/zh
Publication of JP2021068013A publication Critical patent/JP2021068013A/ja
Application granted granted Critical
Publication of JP7232166B2 publication Critical patent/JP7232166B2/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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • B60W60/00274Planning or execution of driving tasks using trajectory prediction for other traffic participants considering possible movement changes
    • 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
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • 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
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • 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
    • B60W40/00Estimation 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/02Estimation 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/04Traffic conditions
    • 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
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • 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
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4041Position
    • 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
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4045Intention, e.g. lane change or imminent movement
    • 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/10Historical data
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V10/00Arrangements for image or video recognition or understanding
    • G06V10/40Extraction of image or video features
    • G06V10/62Extraction of image or video features relating to a temporal dimension, e.g. time-based feature extraction; Pattern tracking

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Mathematical Physics (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、予測装置、車両システム、予測方法、およびプログラムに関する。
近年、車両を自動的に制御することについて研究が進められている。従来、自車両の周囲の移動物体の将来位置を予測する予測装置が開示されている(例えば、特許文献1参照)。この予測装置は、前記移動物体の将来位置を簡易予測する第一の予測部と、前記第一の予測部よりも高精度に前記移動物体の将来位置を本予測する第二の予測部と、前記簡易予測の結果に応じて前記第二の予測部によって前記将来位置を本予測する移動物体を割振る割振り部とを備える。
特開2018-124663号公報 特開2002-74594号公報 特許第4349452号公報
しかしながら、上記の予測装置は、移動体の将来のリスクを精度よく導出できない場合があった。
本発明は、このような事情を考慮してなされたものであり、移動体の将来のリスクをより精度よく導出することができる予測装置、車両システム、予測方法、およびプログラムを提供することを目的の一つとする。
この発明に係る予測装置、車両システム、予測方法、およびプログラムは、以下の構成を採用した。
(1):この発明の一態様に係る予測装置は、移動体の状態を認識する認識部と、前記認識部の認識結果に基づいて、前記移動体の将来の位置を予測する予測部と、前記認識部により認識された移動体の位置と、前記予測部により過去に予測された将来の位置との乖離に基づいて、前記移動体に対して第1リスク領域を設定するか、前記第1リスク領域よりも大きい第2リスク領域を設定するかを決定する処理部とを備える。
(2):上記(1)の態様において、前記処理部は、前記移動体の現在の位置と前記移動体の将来の位置とのうち一方または双方に対して、前記第1リスク領域または前記第2リスク領域を設定する。
(3):上記(1)または(2)の態様において、前記処理部は、前記認識部が認識した第2時刻における前記移動体の第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の第2位置との乖離が、第1所定度合未満である場合、前記移動体に対して前記第1リスク領域を設定し、前記認識部が認識した前記第2時刻における前記移動体の前記第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の前記第2位置との乖離が、第1所定度合以上である場合、前記移動体に対して前記第2リスク領域を設定する。
(4):上記(3)の態様において、前記処理部は、前記第2リスク領域を設定した後、前記第1位置と前記第2位置との乖離が、第2所定度合未満である場合、前記移動体に対して前記第1リスク領域を設定する。
(5):上記(4)の態様において、前記第2所定度合は、前記第1所定度合よりも小さい度合である。
(6):上記(2)から(5)のいずれかの態様において、前記処理部は、前記認識部が認識した第2時刻における前記移動体の第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の第2位置との乖離が、第1所定度合以上であり、且つ基準位置から所定の範囲に存在する移動体に対して前記第2リスク領域を設定する。
(7):上記(1)から(6)のいずれかの態様において、前記認識部と前記予測部とのうち少なくとも一方は、前記認識部により認識された移動体の位置と、前記予測部により過去に予測された将来の位置との乖離に基づいて、処理の周期を変更する。
(8):上記(7)の態様において、前記認識部と前記予測部とのうち少なくとも一方は、前記認識部が認識した第2時刻における前記移動体の第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の第2位置との乖離が、第1所定度合未満である場合、前記処理の周期を変更せず、前記認識部が認識した前記第2時刻における前記移動体の前記第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の前記第2位置との乖離が、第1所定度合以上である場合、前記処理の周期を変更する。
(9):上記(8)の態様において、前記認識部と前記予測部とのうち少なくとも一方は、前記処理の周期を変更した後、前記第1位置と前記第2位置との乖離が、第3所定度合未満である場合、前記処理の周期を変更前の周期に変更する。
(10):上記(9)の態様において、前記第3所定度合は、前記第1所定度合よりも小さい度合である。
(11):上記(8)から(10)のいずれかの態様において、前記認識部と前記予測部とのうち少なくとも一方は、前記認識部が認識した第2時刻における前記移動体の第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の第2位置との乖離が、第1所定度合以上であり、且つ前記移動体が基準位置から所定の範囲に存在する場合、前記移動体を対象とした処理の周期を変更する。
(12):この発明の一態様に係る予測装置は、移動体の状態を認識する認識部と、前記認識部の認識結果に基づいて、前記移動体の将来の位置を予測する予測部と、前記移動体に対してリスク領域を設定する処理部と、を備え、前記認識部と前記予測部とのうち少なくとも一方は、前記認識部により認識された移動体の位置と、前記予測部により過去に予測された将来の位置との乖離に基づいて、処理の周期を変更する。
(13):この発明の一態様に係る車両システムは、上記(1)から(12)のいずれかの態様の予測装置と、前記処理部により設定された第1リスク領域または第2リスク領域に基づいて、車両の速度および操舵のうち少なくとも一方を制御する制御装置とを含む。
(14):この発明の一態様に係る予測方法は、移動体の状態を認識し、前記認識結果に基づいて、前記移動体の将来の位置を予測し、前記認識された移動体の位置と、過去に予測された将来の位置との乖離に基づいて、前記移動体に対して第1リスク領域を設定するか、前記第1リスク領域よりも大きい第2リスク領域を設定するかを決定する。
(15):この発明の一態様に係るプログラムは、移動体の状態を認識させ、前記認識結果に基づいて、前記移動体の将来の位置を予測させ、前記認識された移動体の位置と、過去に予測された将来の位置との乖離に基づいて、前記移動体に対して第1リスク領域を設定するか、前記第1リスク領域よりも大きい第2リスク領域を設定するかを決定させる。
(1)~(15)によれば、予測装置が、認識部により認識された移動体の位置と、予測部により過去に予測された将来の位置との乖離に基づいて、第1リスク領域または第2リスク領域を設定することにより、移動体の将来のリスクをより精度よく導出することができる。特に、予測装置は、予想外の動きを行う移動体の将来のリスクをより精度よく導出することができる。
(4)によれば、予測装置は、第2リスク領域を設定した後、第1位置と第2位置との乖離が第2所定度合未満である場合、第1リスク領域を設定することにより、より適切なリスクを移動体に対して設定することができる。
(5)によれば、第2所定度合は、第1所定度合よりも小さい度合であるため、ハンチングが抑制される。
(6)によれば、処理部は、基準位置から所定の範囲に存在する移動体に対して第2リスク領域を設定することにより、処理負荷を軽減しつつ、移動体の将来のリスクをより精度よく導出することができる。
(7)によれば、予測装置は、認識部と予測部とのうち少なくとも一方は、認識部により認識された移動体の位置と、予測部により過去に予測された将来の位置との乖離に基づいて、処理の周期を変更することにより、より迅速に予測結果に基づく移動体の位置と、認識部の認識結果に基づく移動体の位置とを近づけることができる。
(9)によれば、予測装置は、処理の周期を変更した後、第1位置と第2位置との乖離が、第3所定度合未満である場合、処理の周期を変更前の周期に変更することにより、装置の処理負荷を軽減することができる。
(10)によれば、第3所定度合は、第1所定度合よりも小さい度合であるため、ハンチングが抑制される。
(11)によれば、処理部は、移動体が基準位置から所定の範囲に存在する場合、移動体を対象とした処理の周期を変更することにより、処理負荷を軽減しつつ、より迅速に予測結果に基づく移動体の位置と、認識部の認識結果に基づく移動体の位置とを近づけることができる。
(12)によれば、認識部と予測部とのうち少なくとも一方は、認識部により認識された移動体の位置と、予測部により過去に予測された将来の位置との乖離に基づいて、処理の周期を変更することにより、処理負荷を軽減しつつ、より迅速に予測結果に基づく移動体の位置と、認識部の認識結果に基づく移動体の位置とを近づけることができる。
(13)によれば、車両は、より移動体の特性に応じた走行を行うことができる。
実施形態に係る車両制御装置を利用した車両システム1の構成図である。 第1制御部120および第2制御部160の機能構成図である。 リスク領域が設定された場面の一例を示す図である。 予測された歩行者PDの位置について説明するための図である。 認識された歩行者PDの位置について説明するための図である。 第1リスク領域と第2リスク領域について説明するための図である。 自車両Mの挙動の一例を示す図である。 サンプルレートの変更について説明するための図である。 処理部144がサンプルレートを上昇させた場合とサンプルレートを上昇させない場合との処理について説明するための図である。 サンプルレートの上昇について説明するための図である。 サンプルレートが変更される場合とサンプルレートが変更されない場合との処理の概念図である。 所定の移動体について説明するための図である。 サンプルレートの変更について説明するための図である。 処理部144により実行される処理の流れの一例を示すフローチャートである。 処理部144により実行される処理の流れの一例を示すフローチャートである。 車両システム1の機能構成の一例を示す図である。 実施形態の自動運転制御装置100のハードウェア構成の一例を示す図である。
以下、図面を参照し、本発明の車両制御装置、車両制御方法、およびプログラムの実施形態について説明する。なお、以下では、左側通行の法規が適用される場合について説明するが、右側通行の法規が適用される場合、左右を逆に読み替えればよい。
[全体構成]
図1は、実施形態に係る車両制御装置を利用した車両システム1の構成図である。車両システム1が搭載される車両は、例えば、二輪や三輪、四輪等の車両であり、その駆動源は、ディーゼルエンジンやガソリンエンジンなどの内燃機関、電動機、或いはこれらの組み合わせである。電動機は、内燃機関に連結された発電機による発電電力、或いは二次電池や燃料電池の放電電力を使用して動作する。
車両システム1は、例えば、カメラ10と、レーダ装置12と、LIDAR(Light Detection and Ranging)14と、物体認識装置16と、通信装置20と、HMI(Human Machine Interface)30と、車両センサ40と、ナビゲーション装置50と、MPU(Map Positioning Unit)60と、運転操作子80と、自動運転制御装置100と、走行駆動力出力装置200と、ブレーキ装置210と、ステアリング装置220とを備える。これらの装置や機器は、CAN(Controller Area Network)通信線等の多重通信線やシリアル通信線、無線通信網等によって互いに接続される。なお、図1に示す構成はあくまで一例であり、構成の一部が省略されてもよいし、更に別の構成が追加されてもよい。
カメラ10は、例えば、CCD(Charge Coupled Device)やCMOS(Complementary Metal Oxide Semiconductor)等の固体撮像素子を利用したデジタルカメラである。カメラ10は、車両システム1が搭載される車両(以下、自車両M)の任意の箇所に取り付けられる。前方を撮像する場合、カメラ10は、フロントウインドシールド上部やルームミラー裏面等に取り付けられる。カメラ10は、例えば、周期的に繰り返し自車両Mの周辺を撮像する。カメラ10は、ステレオカメラであってもよい。
レーダ装置12は、自車両Mの周辺にミリ波などの電波を放射すると共に、物体によって反射された電波(反射波)を検出して少なくとも物体の位置(距離および方位)を検出する。レーダ装置12は、自車両Mの任意の箇所に取り付けられる。レーダ装置12は、FM-CW(Frequency Modulated Continuous Wave)方式によって物体の位置および速度を検出してもよい。
LIDAR14は、自車両Mの周辺に光(或いは光に近い波長の電磁波)を照射し、散乱光を測定する。LIDAR14は、発光から受光までの時間に基づいて、対象までの距離を検出する。照射される光は、例えば、パルス状のレーザー光である。LIDAR14は、自車両Mの任意の箇所に取り付けられる。
物体認識装置16は、カメラ10、レーダ装置12、およびLIDAR14のうち一部または全部による検出結果に対してセンサフュージョン処理を行って、物体の位置、種類、速度などを認識する。物体認識装置16は、認識結果を自動運転制御装置100に出力する。物体認識装置16は、カメラ10、レーダ装置12、およびLIDAR14の検出結果をそのまま自動運転制御装置100に出力してよい。車両システム1から物体認識装置16が省略されてもよい。
通信装置20は、例えば、セルラー網やWi-Fi網、Bluetooth(登録商標)、DSRC(Dedicated Short Range Communication)などを利用して、自車両Mの周辺に存在する他車両と通信し、或いは無線基地局を介して各種サーバ装置と通信する。
HMI30は、自車両Mの乗員に対して各種情報を提示すると共に、乗員による入力操作を受け付ける。HMI30は、各種表示装置、スピーカ、ブザー、タッチパネル、スイッチ、キーなどを含む。
車両センサ40は、自車両Mの速度を検出する車速センサ、加速度を検出する加速度センサ、鉛直軸回りの角速度を検出するヨーレートセンサ、自車両Mの向きを検出する方位センサ等を含む。
ナビゲーション装置50は、例えば、GNSS(Global Navigation Satellite System)受信機51と、ナビHMI52と、経路決定部53とを備える。ナビゲーション装置50は、HDD(Hard Disk Drive)やフラッシュメモリなどの記憶装置に第1地図情報54を保持している。GNSS受信機51は、GNSS衛星から受信した信号に基づいて、自車両Mの位置を特定する。自車両Mの位置は、車両センサ40の出力を利用したINS(Inertial Navigation System)によって特定または補完されてもよい。ナビHMI52は、表示装置、スピーカ、タッチパネル、キーなどを含む。ナビHMI52は、前述したHMI30と一部または全部が共通化されてもよい。経路決定部53は、例えば、GNSS受信機51により特定された自車両Mの位置(或いは入力された任意の位置)から、ナビHMI52を用いて乗員により入力された目的地までの経路(以下、地図上経路)を、第1地図情報54を参照して決定する。第1地図情報54は、例えば、道路を示すリンクと、リンクによって接続されたノードとによって道路形状が表現された情報である。第1地図情報54は、道路の曲率やPOI(Point Of Interest)情報などを含んでもよい。地図上経路は、MPU60に出力される。ナビゲーション装置50は、地図上経路に基づいて、ナビHMI52を用いた経路案内を行ってもよい。ナビゲーション装置50は、例えば、乗員の保有するスマートフォンやタブレット端末等の端末装置の機能によって実現されてもよい。ナビゲーション装置50は、通信装置20を介してナビゲーションサーバに現在位置と目的地を送信し、ナビゲーションサーバから地図上経路と同等の経路を取得してもよい。
MPU60は、例えば、推奨車線決定部61を含み、HDDやフラッシュメモリなどの記憶装置に第2地図情報62を保持している。推奨車線決定部61は、ナビゲーション装置50から提供された地図上経路を複数のブロックに分割し(例えば、車両進行方向に関して100[m]毎に分割し)、第2地図情報62を参照してブロックごとに推奨車線を決定する。推奨車線決定部61は、左から何番目の車線を走行するといった決定を行う。推奨車線決定部61は、地図上経路に分岐箇所が存在する場合、自車両Mが、分岐先に進行するための合理的な経路を走行できるように、推奨車線を決定する。
第2地図情報62は、第1地図情報54よりも高精度な地図情報である。第2地図情報62は、例えば、車線の中央の情報あるいは車線の境界の情報等を含んでいる。また、第2地図情報62には、道路情報、交通規制情報、住所情報(住所・郵便番号)、施設情報、電話番号情報などが含まれてよい。第2地図情報62は、通信装置20が他装置と通信することにより、随時、アップデートされてよい。
運転操作子80は、例えば、アクセルペダル、ブレーキペダル、シフトレバー、ステアリングホイール、異形ステア、ジョイスティックその他の操作子を含む。運転操作子80には、操作量あるいは操作の有無を検出するセンサが取り付けられており、その検出結果は、自動運転制御装置100、もしくは、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220のうち一部または全部に出力される。
自動運転制御装置100は、例えば、第1制御部120と、第2制御部160とを備える。第1制御部120と第2制御部160は、それぞれ、例えば、CPU(Central Processing Unit)などのハードウェアプロセッサがプログラム(ソフトウェア)を実行することにより実現される。また、これらの構成要素のうち一部または全部は、LSI(Large Scale Integration)やASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)、GPU(Graphics Processing Unit)などのハードウェア(回路部;circuitryを含む)によって実現されてもよいし、ソフトウェアとハードウェアの協働によって実現されてもよい。プログラムは、予め自動運転制御装置100のHDDやフラッシュメモリなどの記憶装置(非一過性の記憶媒体を備える記憶装置)に格納されていてもよいし、DVDやCD-ROMなどの着脱可能な記憶媒体に格納されており、記憶媒体(非一過性の記憶媒体)がドライブ装置に装着されることで自動運転制御装置100のHDDやフラッシュメモリにインストールされてもよい。自動運転制御装置100は「制御装置」の一例である。
図2は、第1制御部120および第2制御部160の機能構成図である。第1制御部120は、例えば、認識部130と、行動計画生成部140とを備える。第1制御部120は、例えば、AI(Artificial Intelligence;人工知能)による機能と、予め与えられたモデルによる機能とを並行して実現する。例えば、「交差点を認識する」機能は、ディープラーニング等による交差点の認識と、予め与えられた条件(パターンマッチング可能な信号、道路標示などがある)に基づく認識とが並行して実行され、双方に対してスコア付けして総合的に評価することで実現されてよい。これによって、自動運転の信頼性が担保される。
認識部130は、カメラ10、レーダ装置12、およびLIDAR14から物体認識装置16を介して入力された情報に基づいて、自車両Mの周辺にある物体の位置、および速度、加速度等の状態を認識する。物体の位置は、例えば、自車両Mの代表点(重心や駆動軸中心など)を原点とした絶対座標上の位置として認識され、制御に使用される。物体の位置は、その物体の重心やコーナー等の代表点で表されてもよいし、表現された領域で表されてもよい。物体の「状態」とは、物体の加速度やジャーク、あるいは「行動状態」(例えば車線変更をしている、またはしようとしているか否か)を含んでもよい。
また、認識部130は、例えば、自車両Mが走行している車線(走行車線)を認識する。例えば、認識部130は、第2地図情報62から得られる道路区画線のパターン(例えば実線と破線の配列)と、カメラ10によって撮像された画像から認識される自車両Mの周辺の道路区画線のパターンとを比較することで、走行車線を認識する。なお、認識部130は、道路区画線に限らず、道路区画線や路肩、縁石、中央分離帯、ガードレールなどを含む走路境界(道路境界)を認識することで、走行車線を認識してもよい。この認識において、ナビゲーション装置50から取得される自車両Mの位置やINSによる処理結果が加味されてもよい。また、認識部130は、一時停止線、障害物、赤信号、料金所、その他の道路事象を認識する。
認識部130は、走行車線を認識する際に、走行車線に対する自車両Mの位置や姿勢を認識する。認識部130は、例えば、自車両Mの基準点の車線中央からの乖離、および自車両Mの進行方向の車線中央を連ねた線に対してなす角度を、走行車線に対する自車両Mの相対位置および姿勢として認識してもよい。これに代えて、認識部130は、走行車線のいずれかの側端部(道路区画線または道路境界)に対する自車両Mの基準点の位置などを、走行車線に対する自車両Mの相対位置として認識してもよい。
行動計画生成部140は、原則的には推奨車線決定部61により決定された推奨車線を走行し、更に、自車両Mの周辺状況に対応できるように、自車両Mが自動的に(運転者の操作に依らずに)将来走行する目標軌道を生成する。目標軌道は、例えば、速度要素を含んでいる。例えば、目標軌道は、自車両Mの到達すべき地点(軌道点)を順に並べたものとして表現される。軌道点は、道なり距離で所定の走行距離(例えば数[m]程度)ごとの自車両Mの到達すべき地点であり、それとは別に、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとの目標速度および目標加速度が、目標軌道の一部として生成される。また、軌道点は、所定のサンプリング時間ごとの、そのサンプリング時刻における自車両Mの到達すべき位置であってもよい。この場合、目標速度や目標加速度の情報は軌道点の間隔で表現される。
行動計画生成部140は、目標軌道を生成するにあたり、自動運転のイベントを設定してよい。自動運転のイベントには、定速走行イベント、低速追従走行イベント、車線変更イベント、分岐イベント、合流イベント、テイクオーバーイベントなどがある。行動計画生成部140は、起動させたイベントに応じた目標軌道を生成する。
行動計画生成部140は、例えば、予測部142と、処理部144とを備える。予測部142と、処理部144との処理の詳細については後述する。上述した認識部130と、予測部142と、処理部144とを合わせたものは、「予測装置」の一例である。
第2制御部160は、行動計画生成部140によって生成された目標軌道を、予定の時刻通りに自車両Mが通過するように、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220を制御する。
図2に戻り、第2制御部160は、例えば、取得部162と、速度制御部164と、操舵制御部166とを備える。取得部162は、行動計画生成部140により生成された目標軌道(軌道点)の情報を取得し、メモリ(不図示)に記憶させる。速度制御部164は、メモリに記憶された目標軌道に付随する速度要素に基づいて、走行駆動力出力装置200またはブレーキ装置210を制御する。操舵制御部166は、メモリに記憶された目標軌道の曲がり具合に応じて、ステアリング装置220を制御する。速度制御部164および操舵制御部166の処理は、例えば、フィードフォワード制御とフィードバック制御との組み合わせにより実現される。一例として、操舵制御部166は、自車両Mの前方の道路の曲率に応じたフィードフォワード制御と、目標軌道からの乖離に基づくフィードバック制御とを組み合わせて実行する。
走行駆動力出力装置200は、車両が走行するための走行駆動力(トルク)を駆動輪に出力する。走行駆動力出力装置200は、例えば、内燃機関、電動機、および変速機などの組み合わせと、これらを制御するECU(Electronic Control Unit)とを備える。ECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って、上記の構成を制御する。
ブレーキ装置210は、例えば、ブレーキキャリパーと、ブレーキキャリパーに油圧を伝達するシリンダと、シリンダに油圧を発生させる電動モータと、ブレーキECUとを備える。ブレーキECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って電動モータを制御し、制動操作に応じたブレーキトルクが各車輪に出力されるようにする。ブレーキ装置210は、運転操作子80に含まれるブレーキペダルの操作によって発生させた油圧を、マスターシリンダを介してシリンダに伝達する機構をバックアップとして備えてよい。なお、ブレーキ装置210は、上記説明した構成に限らず、第2制御部160から入力される情報に従ってアクチュエータを制御して、マスターシリンダの油圧をシリンダに伝達する電子制御式油圧ブレーキ装置であってもよい。
ステアリング装置220は、例えば、ステアリングECUと、電動モータとを備える。電動モータは、例えば、ラックアンドピニオン機構に力を作用させて転舵輪の向きを変更する。ステアリングECUは、第2制御部160から入力される情報、或いは運転操作子80から入力される情報に従って、電動モータを駆動し、転舵輪の向きを変更させる。
[予測部の詳細]
予測部142は、認識部130の認識結果に基づいて、移動体の将来の位置を予測する。予測部142は、所定のアルゴリズムに基づいて、将来の歩行者PDの位置を予測する。所定のアルゴリズムとは、予め定められた仮定の下で将来のステップ(時刻)ごとの歩行者PDの移動をシミュレートするものである。その場合、将来のステップごとの歩行者PDの移動は、他の交通参加者から受ける影響を考慮したものであってもよい。これに代えて、所定のアルゴズムは、加速度や速度を一定と仮定し、多次方程式で軌跡をフィッティングするものであってもよい。
[処理部の詳細]
(リスク領域の設定)
処理部144は、認識部130により認識された移動体の第1位置と、予測部142により過去に予測された将来の第2位置との乖離に基づいて、移動体に対して第1リスク領域を設定するか、移動体に対して第1リスク領域よりも大きい第2リスク領域を設定するかを決定する。以下、第1リスク領域と第2リスク領域とを区別しない場合は、「リスク領域」と称する場合がある。リスク領域の詳細については後述する。「第1位置」は認識部130により認識された移動体の位置であり、「第2位置」は予測部142が予測した移動体の位置である。
「移動体」とは、人や、動物などを含む。移動体とは、歩行者や、自転車、車いすなどを含む。以下の説明では、移動体は歩行者であるものとして説明する。
図3は、リスク領域が設定された場面の一例を示す図である。例えば、自車両Mが道路を走行中に、自車両Mの進行方向に存在する歩行者PDが存在する場合、処理部144は、歩行者PDを含む領域および歩行者PDの将来の位置に対してリスク領域ARを設定する。例えば、以下の手順でリスク領域ARが設定される。
まず、処理部144は、予測部142により予測された歩行者PDの位置を取得する。図4は、予測された歩行者PDの位置について説明するための図である。例えば、図示するように、処理部144は、時刻tにおいて予測された、位置Pa1(t+1)、位置Pa2(t+2)、および位置Pa3(t+3)を取得する。位置Pa1(t+1)、位置Pa2(t+2)、および位置Pa3(t+3)は、時刻t+1で存在すると予測された歩行者PDの位置、時刻t+2で存在すると予測された歩行者PDの位置、時刻t+3で存在すると予測された歩行者PDの位置である。なお、位置P(t)は、時刻tにおける歩行者PDの位置である。
次に、処理部144は、時刻tから所定時刻(例えば時刻+2)までの間に認識部130により認識された歩行者PDの位置を取得する。図5は、認識された歩行者PDの位置について説明するための図である。例えば、図示するように、処理部144は、位置Pb1(t+1)、および位置Pb2(t+2)を取得する。位置Pb1(t+1)、および位置Pb2(t+2)は、時刻t+1で認識された歩行者PDの位置、および時刻t+2で認識された歩行者PDの位置である。
次に、処理部144は、認識部130により認識された移動体の位置(第1位置)が、予測部142により過去に予測された将来の位置(第2位置)に対して第1所定度合以上乖離(例えば距離L以上乖離)しているか否かを判定する。例えば、処理部144は、位置Pa2(t+2)と、位置Pb2(t+2)とが第1所定度合以上乖離していない場合、移動体の現在の位置または移動体の将来の位置に対して第1リスク領域を設定する。処理部144は、位置Pa2(t+2)と、位置Pb2(t+2)とが第1所定度合以上乖離している場合、移動体の現在の位置または移動体の将来の位置に対して第2リスク領域を設定する。第2リスク領域は、第1リスク領域よりも大きい領域である。
例えば、以下の条件を満たす場合に、処理部144は、認識部130により認識された移動体の位置が、予測部142により過去に予測された将来の位置に対して第1所定度合以上乖離していると判定する。
(1)時刻t+nにおける第1位置が、時刻t+nにおける第2位置に対して第1所定度合以上乖離していること。「n」は任意の自然数である。この場合、時刻「n」に応じて第1所定度合の値は変更されてもよい。
例えば、位置Pa2(t+2)と、位置Pb2(t+2)とが第1所定度合以上乖離していることである。
時刻tは「第1時刻」の一例であり、時刻t+2は「第2時刻」の一例である。
(2)時刻ごとに求めた第1位置と第2位置との乖離を合計した値や平均した値が閾値以上であること。例えば、位置Pa1(t+1)と位置Pb1(t+1)との距離と、位置Pa2(t+2)と位置Pb2(t+2)との距離との合計が第1所定度合以上であること。
(3)上記の(1)または(2)の条件が、連続して複数回の処理周期で成立したことである。例えば、時刻t+nにおける第1位置が、時刻t+nにおける第2位置に対して第1所定度合以上乖離していることが、連続して複数回(例えば3回)の処理周期で成立した場合、第1位置と第2位置とは第1所定度合以上乖離していると判定される。
「リスク領域」とは、リスクポテンシャルが設定される領域である。「リスクポテンシャル」とは、リスクポテンシャルが設定された領域に自車両Mが進入した場合のリスクの高さを示す指標値である。第1リスク領域および第2リスク領域は、所定の大きさの指標値(ゼロを超える指標値)であるリスクポテンシャルが設定された領域である。
図6は、第1リスク領域と第2リスク領域について説明するための図である。図中、位置Pb3(t+3)、位置Pb4(t+4)、位置Pb5(t+5)は、現在(時刻t+2)の歩行者PDの状態(位置や移動方向、速度)や、過去の歩行者PDの状態に基づいて、予測部142が予測した将来の歩行者PDの位置である。例えば、距離Lが閾値Th未満(第1所定度合未満)である場合、処理部144はPb2(t+2)-Pb5(t+5)に対して第1リスク領域AR1を設定する。例えば、距離Lが閾値Th以上である場合、処理部144はPb2(t+2)-Pb5(t+5)に対して第2リスク領域AR2を設定する。
リスク領域は、例えば、移動体の位置または移動体の将来の位置を中心に設定される。例えば、リスク領域は、移動体の中心点をリスクポテンシャルの値の最高値として周辺に広がるに連れて値が低下するように設定される。例えば、リスク領域におけるリスクポテンシャルはガウス分布などのリスクを示す分布で表現されてもよい。リスク領域は、例えば、移動体を中心として移動体が移動している方向の領域が他の方向の領域よりも大きく(または移動体が移動している方向のリスクポテンシャルの値が他の方向のリスクポテンシャルの値よりも大きく)設定される。また、現在から近い将来の移動体の位置よりも、より未来の将来の移動体の位置の方がリスク領域は大きく(またはリスクポテンシャルの値が小さく)設定される。
なお、第2リスク領域AR2が設定された後、第1位置と第2位置との乖離が、所定度合(第2所定度合)未満である場合、処理部144は、移動体に対して第2リスク領域AR2よりも小さいリスク領域(第1リスク領域AR1)を設定してもよい。この時の所定度合(第2所定度合)は、第2リスク領域ARを設定するための基準である所定度合(第1所定度合)とは異なる度合であってもよい。例えば、第2所定度合は、第1所定度合よりも小さい度合であってもよい。
図7は、自車両Mの挙動の一例を示す図である。例えば、上述したように第2リスク領域AR2が設定された場合、自動運転制御装置100は、第2リスク領域を回避するように自車両Mを制御する。例えば、時刻t+5において、位置Pb5(時刻+5)に対応する第2リスク領域AR2に接近しないように、自動運転制御装置100は、自車両Mを制御する。
このように、処理部144は、動きが不安定な移動体または予測外の動きをする移動体に対してより大きいリスク領域を設定することで、移動体の将来のリスクをより精度よく導出することができる。そして、自動運転制御装置100は、動きが不安定な移動体または予測外の動きをする移動体に接近するリスクを抑制した走行を行うことができる。
(サンプルレートの変更)
認識部130と予測部142とのうち少なくとも一方は、認識部130により認識された移動体の位置と、予測部142により過去に予測された将来の位置との乖離に基づいて、処理の周期を変更する。認識部130と予測部142とのうち少なくとも一方は、認識部130が認識した第2時刻における移動体の第1位置と、予測部142が第2時刻よりも前の第1時刻で予測した第2時刻における移動体の第2位置との乖離が、第1所定度合未満である場合、処理の周期を変更せず、認識部130が認識した第2時刻における移動体の第1位置と、予測部142が第2時刻よりも前の第1時刻で予測した第2時刻における移動体の第2位置との乖離が、第1所定度合以上である場合、処理の周期を変更する。
図8は、サンプルレートの変更について説明するための図である。図5との相違点を中心に説明する。例えば、処理部144は、前述した図5で示したように位置Pa2(t+2)と、位置Pb2(t+2)とが第1所定度合以上乖離している場合、認識部130に認識処理のサンプルレートを上昇させる。例えば、図8に示すように、サンプルレートを2倍にする。以下、上昇したサンプルレートを「第2サンプルレート」と称し、上昇前のサンプルレートを「第1サンプルレート」と称する。
そして、処理部144は、認識処理の結果ごとに、予測部142に移動体の将来の位置を予測させる。すなわち、予測部142が予測処理のサンプルレートを上昇させる。
図9は、処理部144がサンプルレートを上昇させた場合とサンプルレートを上昇させない場合との処理について説明するための図である。例えば、処理部144がサンプルレートを変更しない場合(上昇させない場合)、第1位置と第2位置との乖離は迅速に縮まらない場合がある。これに対して、処理部144がサンプルレートを変更する場合(上昇させる場合)、予測部142の予測結果が実際の移動体の位置に近づく傾向となるため、第1位置と第2位置との乖離が縮まる。
このように、処理部144は、サンプルレートを上昇させることにより、迅速に第1位置と第2位置との乖離を縮めることができ、より精度よくリスク領域を設定することができる。
なお、上述した例では、処理部144は、第1位置と第2位置との乖離が第1所定度合以上である場合、サンプルレートを上昇させるものとして説明したが、これに代えて、第1位置と第2位置との乖離が第1所定度合未満である場合、サンプルレートを低下させてもよい。
また、処理部144は、認識処理により認識された移動体の位置に基づいて、認識されていない移動体の位置を補間してもよい。例えば、処理部144は、位置Pa2(t+2)と位置Pa3(t+3)とに基づいて、位置Pa2.5(t+2.5)を補間してもよい。また、サンプルレートを上昇させる処理に加えて(または代えて)、処理部144は、は、予測処理により予測された移動体の位置に基づいて、予測されていない移動体の将来の位置を補間してもよい。例えば、処理部144は、予測部142により予測された位置Pb2(t+2)と位置Pb3(t+3)とに基づいて、位置Pb3.5(t+3.5)における将来の移動体の位置を補間してもよい。また、予測部142は、過去の予測結果に基づいて、所定の処理周期の予測処理を実行してもよい。
また、予測部142は、サンプルレートを上昇させる際に、予測処理のサンプルレートを上昇させてもよい。図10は、サンプルレートの上昇について説明するための図である。例えば、認識部130は、時刻T-時刻T+4のそれぞれにおいて移動体の位置を認識するものとする。サンプルレートが変更されていない場合、予測部142は、時刻T、時刻T+2、時刻T+4のそれぞれにおいて予測処理を行い、将来の移動体の位置を予測する。そして、処理部144は、時刻T、時刻T+2、時刻T+4において、その時刻の移動体の位置と、過去の予測処理により得られた将来の移動体の位置と基づいて、設定するリスク領域を決定したり、サンプルレートを変更したりする。
これに対して、サンプルレートが変更された場合、予測部142は、時刻T-時刻T+4のそれぞれにおいて予測処理を行い、将来の移動体の位置を予測する。そして、処理部144は、時刻T-時刻T+4のそれぞれの時刻において、その時刻の移動体の位置と、過去の予測処理により得られた将来の移動体の位置と基づいて、設定するリスク領域を決定したり、サンプルレートを変更したりする。このように、処理部144は、サンプルレートを上昇させることにより、迅速に第1位置と第2位置との乖離を縮めることができ、より精度よくリスク領域を設定することができる。
認識部130と予測部142とのうち少なくとも一方は、処理の周期を変更した後、第1位置と第2位置との乖離が、所定度合(第3所定度合)未満である場合、処理の周期を変更前の周期に変更してもよい。変更後の処理周期は、例えば第2サンプルレートであり、変更前の処理の周期は、例えば第1サンプルレートである。第3所定度合は、第1所定度合と同じ値であってもよいし、異なる値であってもよい。第3所定度合は、例えば第1所定度合よりも小さい度合である。
図11は、サンプルレートが変更される場合とサンプルレートが変更されない場合との処理の概念図である。第1位置と第2位置との乖離が閾値Th1未満である場合(1)、処理部144は、第1サンプルレートで処理を行う(2)。以降の処理においても、第1サンプルレートで処理が行われる(3)。
第1位置と第2位置との乖離が閾値Th1以上である場合(10)、処理部144は、第2サンプルレートで処理を行う(11)。第2サンプルレートは、第1サンプルレートよりもサンプルレートが高いサンプルレートである。以降の処理においても、第2サンプルレートで処理が行われる(12)。第2サンプルレートで処理が行われて、第1位置と第2位置との乖離が閾値Th2未満となると、処理部144は、第1サンプルレートで処理を実行する(13)。例えば、閾値Th1と閾値Th2とは同様の値であってもよいし、異なる値であってもよい。閾値Th1は閾値Th2より大きい値であってもよいし、小さい値であってもよい。
このように、処理部144は、第1位置と第2位置との乖離に応じて、サンプルレートを変更することにより、処理負荷を軽減しつつ、より精度よく移動体に対してリスク領域を設定することができる。
(特定条件の成立の有無による処理)
処理部144は、特定条件が成立した場合に、特定条件が成立する前よりも短い周期(サンプルレート)で予測部142が移動体の将来の位置を予測する予測処理を予測部142に実行、または認識部130が移動体の状態を認識する認識処理を認識部130に実行させてもよい。特定条件は、認識部130により認識された移動体の第1位置が、予測部142により過去に予測された移動体の将来の第2位置に対して所定度合(第1所定度合)以上乖離し、且つ移動体が基準位置から所定の範囲に存在することである。基準位置(例えば自車両Mの位置)から所定の範囲に存在する移動体を、以下、「所定の移動体」と称する場合がある。
処理部144は、複数の移動体のうち、所定の移動体に対する処理に対して第2サンプルレートを適用してもよい。所定の移動体とは、自車両Mの走行に関する影響度が所定度合以上の移動体である。所定の移動体は、例えば、自車両Mから所定距離以内に存在する歩行者PDである。
図12は、所定の移動体について説明するための図である。例えば、処理部144は、所定の移動体である歩行者PD1および歩行者PD2の処理において第2サンプルレートを適用し、所定の移動体である歩行者PD3の処理において第1サンプルレートを適用する。
このように、処理部144が、所定の移動体の処理において第2サンプルレートを適用することにより、処理負荷を軽減しつつ、より精度よく移動体に対してリスク領域を設定することができる。
また、処理部144は、特定条件が成立する場合において、特定条件が成立する移動体に対して、第1位置と第2位置とが第1所定度合以上乖離している場合、その移動体に対して第2リスク領域を設定してもよい。この場合、処理部144は、第1位置と第2位置とが第1所定度合以上乖離している場合であっても、特定条件が成立していない場合は、その移動体に対して第2リスク領域を設定せず、第1リスク領域を設定してもよい。
(その他)
また、予測処理において、下記のようにサンプルレートが変更されてもよい。図13は、サンプルレートの変更について説明するための図である。図6との相違点を中心に説明する。例えば、処理部144は、位置Pa2(t+2)と、位置Pb2(t+2)とが第1所定度合以上乖離している場合、予測処理のサンプルレートを上昇させる。例えば、サンプルレートを2倍にして、位置Pb2(t+2)、位置Pb2.5(t+2.5)、位置Pb3(t+3)、位置Pb3.5(t+3.5)・・・のように位置を予測する。
このように、処理部144は、サンプルレートを上昇させることにより、より精度よく移動体の将来の位置を予測し、移動体の将来のリスクをより精度よく導出することができる。
なお、処理部144は、第1リスク領域と第2リスク領域とを切り替えて設定する処理を省略して、第1位置と第2位置とが第1所定度合以上乖離しているか否かに基づいて、このサンプルレートを変更する処理で行ってもよい。すなわち、自動運転制御装置100において、第2リスク領域を設定する処理を行う機能は省略され、認識部130と予測部142とのうち少なくとも一方は、認識部130により認識された移動体の位置と、予測部142により過去に予測された将来の位置との乖離に基づいて、処理の周期を変更する機能を有してもよい。
上記のように、処理部144は、サンプルレートを上昇させることにより、第1位置と第2位置との乖離を迅速に縮小させることができる。
[フローチャート(その1)]
図14は、処理部144により実行される処理の流れの一例を示すフローチャートである。まず、処理部144は、予測部142により予測された移動体の第1位置と、認識部130により認識された移動体の第2位置とが、第1所定度合以上乖離している否かを判定する(ステップS100)。
第1位置と第2位置とが、第1所定度合以上乖離している場合、処理部144は、第2サンプルレートで認識部130に認識処理を実行させ、第2サンプルレートで予測部142に予測処理を実行させる(ステップS102)。第1位置と第2位置とが、第1所定度合以上乖離していない場合、処理部144は、第1サンプルレートで認識部130に認識処理を実行させ、第1サンプルレートで予測部142に予測処理を実行させる(ステップS104)。これにより本フローチャートの1ルーチンの処理が終了する。
上述したように、処理部144が、第1位置と、第2位置との乖離度合に基づいて、サンプルレートを変更することにより、処理負荷を軽減しつつ、より精度よく移動体に対してリスク領域を設定することができる。
[フローチャート(その2)]
図15は、処理部144により実行される処理の流れの一例を示すフローチャートである。まず、処理部144は、予測部142により予測された移動体の第1位置と、認識部130により認識された移動体の第2位置とが、第1所定度合以上乖離している否かを判定する(ステップS200)。
第1位置と第2位置とが、第1所定度合以上乖離している場合、処理部144は、移動体の位置および移動体の将来の位置に対して第2リスク領域を設定する(ステップS202)。第1位置と第2位置とが、第1所定度合以上乖離していない場合、処理部144は、移動体の位置および移動体の将来の位置に対して第1リスク領域を設定する(ステップS204)。処理部144は、リスク領域を設定した後、リスク領域に基づいて将来の軌道を生成し、生成した軌道に基づく制御を実行する(ステップS206)。これにより本フローチャートの1ルーチンの処理が終了する。
上述したように、処理部144が、リスク領域に基づく制御を実行することにより、移動体から十分距離をとった位置を自車両Mに走行させることができる。例えば、処理部144は、挙動が不安定であったり、予想外の挙動を行ったりする移動体に対して第2リスク領域を設定することで、その移動体に対して十分距離をとった位置を自車両Mに走行させることができる。
以上説明した第1実施形態によれば、処理部144が、第1位置と第2位置との乖離度合に基づいて、リスク領域を変更することにより、より精度よく移動体に対してリスク領域を設定することができる。また、処理部144は、第1位置と第2位置との乖離度合に基づいて、サンプルレートを変更することにより、処理負荷を軽減しつつ、迅速に乖離度合を低減させることができる。
<変形例>
図16は、車両システム1の機能構成の一例を示す図である。車両システム1Aは、自動運転制御装置100に代えて、自動運転制御装置100Aを備える。また、車両システム1Aは、予測装置300を備える。第1実施形態で説明した自動運転制御装置100以外の構成について図示および説明を省略する。
自動運転制御装置100Aは、例えば、第1制御部120Aと、第2制御部160とを備える。第1制御部120Aは、行動計画生成部140を備える。
予測装置300は、例えば、認識部130と、予測部320と、処理部330とを備える。認識部130は、例えば、物体認識装置16の処理結果を取得し、第1実施形態の認識部130と同様に認識処理を行う。予測部320は、予測部142と同等の機能を有し、処理部330は、処理部144と同等の機能を有する。処理部330は、処理結果を自動運転制御装置100に提供する。自動運転制御装置100は、処理部330の処理結果(例えばリスク領域)に基づいて自車両Mを制御する。
以上説明した変形例によりは、第1実施形態の効果と同様の効果を奏する。
[ハードウェア構成]
図17は、実施形態の自動運転制御装置100のハードウェア構成の一例を示す図である。図示するように、自動運転制御装置100は、通信コントローラ100-1、CPU100-2、ワーキングメモリとして使用されるRAM(Random Access Memory)100-3、ブートプログラムなどを格納するROM(Read Only Memory)100-4、フラッシュメモリやHDD(Hard Disk Drive)などの記憶装置100-5、ドライブ装置100-6などが、内部バスあるいは専用通信線によって相互に接続された構成となっている。通信コントローラ100-1は、自動運転制御装置100以外の構成要素との通信を行う。記憶装置100-5には、CPU100-2が実行するプログラム100-5aが格納されている。このプログラムは、DMA(Direct Memory Access)コントローラ(不図示)などによってRAM100-3に展開されて、CPU100-2によって実行される。これによって、認識部130、予測部142、および処理部144のうち一部または全部が実現される。
上記説明した実施形態は、以下のように表現することができる。
プログラムを記憶した記憶装置と、
ハードウェアプロセッサと、を備え、
前記ハードウェアプロセッサが前記記憶装置に記憶されたプログラムを実行することにより、
移動体の状態を認識させ、
前記認識結果に基づいて、前記移動体の将来の位置を予測させ、
前記認識された移動体の位置と、過去に予測された将来の位置との乖離に基づいて、前記移動体に対して第1リスク領域を設定するか、前記第1リスク領域よりも大きい第2リスク領域を設定するかを決定させる、
ように構成されている、車両制御装置。
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
1‥車両システム、16‥物体認識装置、100‥自動運転制御装置、120‥第1制御部、130‥認識部、140‥行動計画生成部、142‥予測部、144‥処理部、160‥第2制御部

Claims (15)

  1. 移動体の状態を認識する認識部と、
    前記認識部の認識結果に基づいて、前記移動体の将来の位置を予測する予測部と、
    前記認識部により認識された移動体の位置と、前記予測部により過去に予測された将来の位置との乖離に基づいて、前記移動体に対して第1リスク領域を設定するか、前記第1リスク領域よりも大きい第2リスク領域を設定するかを決定する処理部と、
    を備える予測装置。
  2. 前記処理部は、
    前記移動体の現在の位置と前記移動体の将来の位置とのうち一方または双方に対して、前記第1リスク領域または前記第2リスク領域を設定する、
    請求項1に記載の予測装置。
  3. 前記処理部は、
    前記認識部が認識した第2時刻における前記移動体の第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の第2位置との乖離が、第1所定度合未満である場合、前記移動体に対して前記第1リスク領域を設定し、
    前記認識部が認識した前記第2時刻における前記移動体の前記第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の前記第2位置との乖離が、第1所定度合以上である場合、前記移動体に対して前記第2リスク領域を設定する、
    請求項1または2に記載の予測装置。
  4. 前記処理部は、
    前記第2リスク領域を設定した後、前記第1位置と前記第2位置との乖離が、第2所定度合未満である場合、前記移動体に対して前記第1リスク領域を設定する、
    請求項3に記載の予測装置。
  5. 前記第2所定度合は、前記第1所定度合よりも小さい度合である、
    請求項4に記載の予測装置。
  6. 前記処理部は、前記認識部が認識した第2時刻における前記移動体の第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の第2位置との乖離が、第1所定度合以上であり、且つ基準位置から所定の範囲に存在する移動体に対して前記第2リスク領域を設定する、
    請求項2から5のうちいずれか1項に記載の予測装置。
  7. 前記認識部と前記予測部とのうち少なくとも一方は、前記認識部により認識された移動体の位置と、前記予測部により過去に予測された将来の位置との乖離に基づいて、処理の周期を変更する、
    請求項1から6のうちいずれか1項に記載の予測装置。
  8. 前記認識部と前記予測部とのうち少なくとも一方は、
    前記認識部が認識した第2時刻における前記移動体の第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の第2位置との乖離が、第1所定度合未満である場合、前記処理の周期を変更せず、
    前記認識部が認識した前記第2時刻における前記移動体の前記第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の前記
    第2位置との乖離が、第1所定度合以上である場合、前記処理の周期を変更する、
    請求項7に記載の予測装置。
  9. 前記認識部と前記予測部とのうち少なくとも一方は、
    前記処理の周期を変更した後、前記第1位置と前記第2位置との乖離が、第3所定度合未満である場合、前記処理の周期を変更前の周期に変更する、
    請求項8に記載の予測装置。
  10. 前記第3所定度合は、前記第1所定度合よりも小さい度合である、
    請求項9に記載の予測装置。
  11. 前記認識部と前記予測部とのうち少なくとも一方は、
    前記認識部が認識した第2時刻における前記移動体の第1位置と、前記予測部が前記第2時刻よりも前の第1時刻で予測した前記第2時刻における前記移動体の第2位置との乖離が、第1所定度合以上であり、且つ前記移動体が基準位置から所定の範囲に存在する場合、前記移動体を対象とした処理の周期を変更する、
    請求項8から10のうちいずれか1項に記載の予測装置。
  12. 移動体の状態を認識する認識部と、
    前記認識部の認識結果に基づいて、前記移動体の将来の位置を予測する予測部と、
    前記移動体に対してリスク領域を設定する処理部と、
    を備え、
    前記認識部と前記予測部とのうち少なくとも一方は、前記認識部により認識された移動体の位置と、前記予測部により過去に予測された将来の位置との乖離に基づいて、処理の周期を変更する、
    予測装置。
  13. 請求項1から11のうちいずれか1項に記載の予測装置と、
    前記処理部により設定された第1リスク領域または第2リスク領域に基づいて、車両の速度および操舵のうち少なくとも一方を制御する制御装置と、
    を含む車両システム。
  14. コンピュータが、
    移動体の状態を認識し、
    前記認識結果に基づいて、前記移動体の将来の位置を予測し、
    前記認識された移動体の位置と、過去に予測された将来の位置との乖離に基づいて、前記移動体に対して第1リスク領域を設定するか、前記第1リスク領域よりも大きい第2リスク領域を設定するかを決定する、
    予測方法。
  15. コンピュータに、
    移動体の状態を認識させ、
    前記認識結果に基づいて、前記移動体の将来の位置を予測させ、
    前記認識された移動体の位置と、過去に予測された将来の位置との乖離に基づいて、前記移動体に対して第1リスク領域を設定するか、前記第1リスク領域よりも大きい第2リスク領域を設定するかを決定させる、
    プログラム。
JP2019191022A 2019-10-18 2019-10-18 予測装置、車両システム、予測方法、およびプログラム Active JP7232166B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2019191022A JP7232166B2 (ja) 2019-10-18 2019-10-18 予測装置、車両システム、予測方法、およびプログラム
US17/068,847 US11866071B2 (en) 2019-10-18 2020-10-13 Predicting device, vehicle system, and storage medium
CN202011096175.9A CN112677978B (zh) 2019-10-18 2020-10-14 预测装置、车辆系统、预测方法及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019191022A JP7232166B2 (ja) 2019-10-18 2019-10-18 予測装置、車両システム、予測方法、およびプログラム

Publications (2)

Publication Number Publication Date
JP2021068013A JP2021068013A (ja) 2021-04-30
JP7232166B2 true JP7232166B2 (ja) 2023-03-02

Family

ID=75445754

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019191022A Active JP7232166B2 (ja) 2019-10-18 2019-10-18 予測装置、車両システム、予測方法、およびプログラム

Country Status (2)

Country Link
US (1) US11866071B2 (ja)
JP (1) JP7232166B2 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20210074937A (ko) * 2019-12-12 2021-06-22 현대자동차주식회사 차량 및 그 제어방법

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010038851A1 (ja) 2008-10-02 2010-04-08 日立オートモティブシステムズ株式会社 車両走行に関する情報処理装置
JP2017142760A (ja) 2016-02-12 2017-08-17 日立オートモティブシステムズ株式会社 移動体の周囲環境認識装置
JP2019078554A (ja) 2017-10-20 2019-05-23 株式会社Soken 物体検知装置

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002074594A (ja) 2000-08-25 2002-03-15 Alpine Electronics Inc 障害物検知システム
JP4349452B2 (ja) * 2007-08-27 2009-10-21 トヨタ自動車株式会社 行動予測装置
JP4917626B2 (ja) * 2009-03-31 2012-04-18 本田技研工業株式会社 内燃機関の吸気装置
CN106164998B (zh) * 2014-04-10 2019-03-15 三菱电机株式会社 路径预测装置
JP6442904B2 (ja) * 2014-08-01 2018-12-26 株式会社デンソー 運転支援装置
US9604639B2 (en) * 2015-08-28 2017-03-28 Delphi Technologies, Inc. Pedestrian-intent-detection for automated vehicles
US10126722B2 (en) * 2016-08-01 2018-11-13 Qualcomm Incorporated System and method of dynamically controlling parameters for processing sensor output data for collision avoidance and path planning
JP2018124663A (ja) 2017-01-30 2018-08-09 日立オートモティブシステムズ株式会社 移動物体予測装置
JP7100998B2 (ja) * 2018-03-08 2022-07-14 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
US11345342B2 (en) * 2019-09-27 2022-05-31 Intel Corporation Potential collision warning system based on road user intent prediction
US20220315047A1 (en) * 2021-03-30 2022-10-06 Honda Research Institute Europe Gmbh Method, system and vehicle with an uncertainty-based lane positioning control

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2010038851A1 (ja) 2008-10-02 2010-04-08 日立オートモティブシステムズ株式会社 車両走行に関する情報処理装置
JP2017142760A (ja) 2016-02-12 2017-08-17 日立オートモティブシステムズ株式会社 移動体の周囲環境認識装置
JP2019078554A (ja) 2017-10-20 2019-05-23 株式会社Soken 物体検知装置

Also Published As

Publication number Publication date
US20210114629A1 (en) 2021-04-22
JP2021068013A (ja) 2021-04-30
CN112677978A (zh) 2021-04-20
US11866071B2 (en) 2024-01-09

Similar Documents

Publication Publication Date Title
JP7429143B2 (ja) 移動体制御装置、移動体制御方法、およびプログラム
JP7043279B2 (ja) 車両制御システム、車両制御方法、およびプログラム
JP7085371B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7000202B2 (ja) 車両制御システム、車両制御方法、およびプログラム
JP7112374B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7345349B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7313298B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7429172B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7406432B2 (ja) 移動体制御装置、移動体制御方法、およびプログラム
JP7444680B2 (ja) 移動体制御装置、移動体制御方法、およびプログラム
JP7236979B2 (ja) 車両制御装置、および車両制御方法
JP7165109B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7232166B2 (ja) 予測装置、車両システム、予測方法、およびプログラム
JP6964062B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7080091B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7125969B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7166988B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP2022142863A (ja) 移動体制御装置、移動体制御方法、およびプログラム
CN112677978B (zh) 预测装置、车辆系统、预测方法及存储介质
JP7448400B2 (ja) 移動体制御装置、移動体制御方法、およびプログラム
JP7123867B2 (ja) 車両制御装置、車両制御装方法、およびプログラム
JP7345515B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7121715B2 (ja) 推定装置、推定方法、及びプログラム
JP7429555B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP2024039776A (ja) 移動体制御装置、移動体制御方法、およびプログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20211126

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20221110

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20221115

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230110

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230217

R150 Certificate of patent or registration of utility model

Ref document number: 7232166

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150