JP6651486B2 - 車両制御装置、車両制御方法、およびプログラム - Google Patents

車両制御装置、車両制御方法、およびプログラム Download PDF

Info

Publication number
JP6651486B2
JP6651486B2 JP2017168710A JP2017168710A JP6651486B2 JP 6651486 B2 JP6651486 B2 JP 6651486B2 JP 2017168710 A JP2017168710 A JP 2017168710A JP 2017168710 A JP2017168710 A JP 2017168710A JP 6651486 B2 JP6651486 B2 JP 6651486B2
Authority
JP
Japan
Prior art keywords
vehicle
potential
road
target
traveling
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
JP2017168710A
Other languages
English (en)
Other versions
JP2019046161A (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 JP2017168710A priority Critical patent/JP6651486B2/ja
Priority to CN201810978033.1A priority patent/CN109426263B/zh
Priority to US16/112,897 priority patent/US10795371B2/en
Publication of JP2019046161A publication Critical patent/JP2019046161A/ja
Application granted granted Critical
Publication of JP6651486B2 publication Critical patent/JP6651486B2/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/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • 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/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • 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
    • G05D1/0251Control 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 extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
    • 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/14Adaptive cruise control
    • B60W30/16Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18145Cornering
    • 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/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/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
    • 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
    • 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/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • 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/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • 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
    • 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
    • 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/588Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/53Road markings, e.g. lane marker or crosswalk
    • 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
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes

Landscapes

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

Description

本発明は、車両制御装置、車両制御方法、およびプログラムに関する。
従来、自車両の進行方向の画像から死角の有無を判定し、死角があると判定された場合に、死角地点に基づく自車両の将来の目標位置および目標姿勢を設定する技術が知られている(例えば、特許文献1参照)。
特開2013−186722号公報
しかしながら、上記特許文献1に記載の技術では、自車両の走行環境に応じた周辺車両の自車両に対する影響度の変動について考慮されておらず、適切な走行軌道が生成できない場合があった。
本発明は、このような事情を考慮してなされたものであり、走行環境に応じて、より適切な走行軌道を生成することができる車両制御装置、車両制御方法、およびプログラムを提供することを目的の一つとする。
(1):自車両(M)の周辺車両を認識する認識部(121)と、道路領域を分割した複数の分割領域に対して、前記認識部により認識された周辺車両に基づく物標ポテンシャルを設定するポテンシャル設定部(134)であって、前記自車両または前記周辺車両が所定の走行環境を走行しているか否かに応じて前記物標ポテンシャルを異ならせるポテンシャル設定部と、を備える車両制御装置(100)である。
(2):(1)において、前記所定の走行環境とは、カーブ路であり、前記ポテンシャル設定部は、前記自車両または前記周辺車両がカーブ路を走行している場合に、前記自車両または前記周辺車両が前記カーブ路を走行していない場合とは前記物標ポテンシャルを異ならせるものである。
(3):(2)において、前記ポテンシャル設定部は、前記カーブ路の曲率に基づいて前記物標ポテンシャルを異ならせる程度を変更するものである。
(4):(3)において、前記所定の走行環境とは、所定曲率以上のカーブ路であり、前記ポテンシャル設定部は、前記自車両または前記周辺車両が所定曲率以上のカーブ路を走行している場合と、前記自車両または前記周辺車両が所定曲率以上のカーブ路を走行していない場合とで、前記物標ポテンシャルを異ならせるものである。
(5):(1)〜(4)のうち何れか一つにおいて、前記ポテンシャル設定部は、前記周辺車両の位置および挙動に基づいて、前記物標ポテンシャルの変化度合を異ならせるものである。
(6):(1)〜(5)のうち何れか一つにおいて、前記認識部は、前記自車両の位置と前記周辺車両の位置との間の道路区画線を認識し、前記ポテンシャル設定部は、前記認識部により前記道路区画線が認識された場合と、前記道路区画線が認識されなかった場合とで、前記物標ポテンシャルを異ならせるものである。
(7):(1)〜(6)のうち何れか一つにおいて、前記ポテンシャル設定部は、前記周辺車両の走行環境に基づいて、前記周辺車両の挙動が変化する可能性が高いと予測される場合と、予測されなかった場合とで、前記物標ポテンシャルを異ならせるものである。
(8):(1)〜(7)のうち何れか一つにおいて、前記道路領域を分割した複数の分割領域に対して、前記道路領域に基づく誘導ポテンシャルを設定する誘導ポテンシャル設定部(132)と、前記複数の分割領域のうち着目する着目分割領域に設定された前記物標ポテンシャルおよび前記誘導ポテンシャルと、前記着目分割領域の周辺から選択される周辺分割領域に対して生成された予見情報とに基づいて、前記着目分割領域のポテンシャルを評価した指標値を導出する評価部(136)と、前記評価部により導出された指標値に基づいて、前記複数の分割領域から前記自車両の進行方向に沿った一以上の分割領域を選択する選択部(137)と、前記選択部により選択された前記自車両の進行方向に沿った一以上の分割領域に基づいて、前記自車両の将来の走行軌道を生成する軌道生成部(138)と、を更に備えるものである。
(9):コンピュータが、自車両の周辺車両を認識し、道路領域を分割した複数の分割領域に対して、認識された前記周辺車両に基づく物標ポテンシャルを設定し、前記自車両または前記周辺車両が所定の走行環境を走行しているか否かに応じて前記物標ポテンシャルを異ならせる、車両制御方法である。
(10):コンピュータに、自車両の周辺車両を認識させ、道路領域を分割した複数の分割領域に対して、認識された前記周辺車両に基づく物標ポテンシャルを設定させ、前記自車両または前記周辺車両が所定の走行環境を走行しているか否かに応じて前記物標ポテンシャルを異ならせる、プログラムである。
(1)〜(10)によれば、走行環境に応じて、より適切な走行軌道を生成することができる。
自動運転制御ユニット100を含む車両システム1の構成図である。 自車位置認識部122により走行車線L1に対する自車両Mの相対位置および姿勢が認識される様子を示す図である。 推奨車線に基づいて目標軌道が生成される様子を示す図である。 行動計画生成部123の機能構成図である。 路面領域に設定されたグリッドGの一例を示す図である。 誘導ポテンシャルPiの一例を示す図である。 物標ポテンシャルPoの設定手法について説明するための図である。 他車両m1に設定された物標ポテンシャル領域PoAを他車両m1の後ろから見た様子を示す図である。 他車両m2に設定された物標ポテンシャル領域PoAを横から見た様子を示す図である。 図7の場面において、設定される物標ポテンシャル領域PoAを三次元で模式的に示した図である。 カーブ路を走行する自車両Mと他車両m3との関係について説明するための図である。 他車両m3に設定されたカーブ路における物標ポテンシャル領域PoAcを他車両m3の正面から見た様子を示す図である。 他車両m3が車線L3を道路区画線CLに走行している場合の物標ポテンシャル領域PoAdの設定について説明するための図である。 他車両m3の進行方向に障害物Obが検出された場合の物標ポテンシャル領域PoAeの設定について説明するための図である。 走行車線と対向車線との間の道路区画線が認識できない場合の物標ポテンシャル領域PoAfの設定について説明するための図である。 指標値の導出について説明するための図である。 周辺グリッドの他の一例を示す図である。 選択部137により選択された選択グリッドSGと、選択グリッドSGに基づいて生成される目標軌道TLについて説明するための図である。 実施形態の行動計画生成部123により実行される処理の一例を示すフローチャートである。 実施形態の自動運転制御ユニット100のハードウェア構成の一例を示す図である。
以下、図面を参照し、本発明の車両制御装置、車両制御方法、およびプログラムの実施形態について説明する。以下の実施形態では、車両制御装置が自動運転車両に適用されたものとする。自動運転とは、例えば、自車両Mの速度または操舵の少なくとも一方を自動的に制御して自車両を走行させることをいう。
[全体構成]
図1は、自動運転制御ユニット100を含む車両システム1の構成図である。車両システム1が搭載される車両は、例えば、二輪や三輪、四輪等の車両であり、その駆動源は、ディーゼルエンジンやガソリンエンジン等の内燃機関、電動機、或いはこれらの組み合わせである。電動機は、内燃機関に連結された発電機による発電電力、或いは二次電池や燃料電池の放電電力を使用して動作する。
車両システム1は、例えば、カメラ10と、レーダ装置12と、ファインダ14と、物体認識装置16と、通信装置20と、HMI(Human Machine Interface)30と、ETC(Electronic Toll Collection system)車載器40と、ナビゲーション装置50と、MPU(Micro-Processing Unit)60と、車両センサ70と、運転操作子80と、自動運転制御ユニット100と、走行駆動力出力装置200と、ブレーキ装置210と、ステアリング装置220とを備える。これらの装置や機器は、CAN(Controller Area Network)通信線等の多重通信線やシリアル通信線、無線通信網等によって互いに接続される。なお、図1に示す構成はあくまで一例であり、構成の一部が省略されてもよいし、更に別の構成が追加されてもよい。また、自動運転制御ユニット100は、「車両制御装置」の一例である。
カメラ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)方式によって物体の位置および速度を検出してもよい。
ファインダ14は、照射光に対する散乱光を測定し、対象までの距離を検出するLIDAR(Light Detection and Ranging、或いはLaser Imaging Detection and Ranging)である。ファインダ14は、自車両Mの任意の箇所に一つまたは複数が取り付けられる。
物体認識装置16は、カメラ10、レーダ装置12、およびファインダ14のうち一部または全部による検出結果に対してセンサフュージョン処理を行って、物体の位置、種類、速度等を認識する。物体認識装置16は、認識結果を自動運転制御ユニット100に出力する。
通信装置20は、例えば、セルラー網やWi−Fi網、Bluetooth(登録商標)、DSRC(Dedicated Short Range Communication)等を利用して、自車両Mの周辺に存在する他車両(周辺車両)と通信し、或いは無線基地局を介して各種サーバ装置と通信する。
HMI30は、自車両Mの乗員に対して各種情報を提示すると共に、乗員による入力操作を受け付ける。HMI30は、例えば、不図示のタッチパネルやスイッチ等を備える。タッチパネルは、例えば、LCD(Liquid Crystal Display)や有機EL(Electro Luminescence)ディスプレイ等の表示装置とタッチパッドとを組み合わせた構成であってよい。
ナビゲーション装置50は、例えば、GNSS(Global Navigation Satellite System)受信機51と、ナビHMI52と、経路決定部53とを備え、HDD(Hard Disk Drive)やフラッシュメモリ等の記憶装置に第1地図情報54を保持している。GNSS受信機は、GNSS衛星から受信した信号に基づいて、自車両Mの位置を特定する。自車両Mの位置は、車両センサ70の出力を利用したINS(Inertial Navigation System)によって特定または補完されてもよい。ナビHMI52は、表示装置、スピーカ、タッチパネル、キー等を含む。ナビHMI52は、前述したHMI30と一部または全部が共通化されてもよい。経路決定部53は、例えば、GNSS受信機51により特定された自車両Mの位置(或いは入力された任意の位置)から、ナビHMI52を用いて乗員により入力された目的地までの経路を、第1地図情報54を参照して決定する。第1地図情報54は、例えば、道路を示すリンクと、リンクによって接続されたノードとによって道路形状が表現された情報である。第1地図情報54は、道路の曲率やPOI(Point Of Interest)情報等を含んでもよい。経路決定部53により決定された経路は、MPU60に出力される。また、ナビゲーション装置50は、経路決定部53により決定された経路に基づいて、ナビ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には、道路情報、交通規制情報、住所情報(住所・郵便番号)、施設情報、電話番号情報等が含まれてよい。道路情報には、高速道路、有料道路、国道、都道府県道といった道路の種別を表す情報や、道路の車線数、各車線の幅員、道路の勾配、道路の位置(経度、緯度、高さを含む3次元座標)、車線のカーブの曲率、車線の合流および分岐ポイントの位置、道路に設けられた標識等の情報が含まれる。第2地図情報62は、通信装置20を用いて他装置にアクセスすることにより、随時、アップデートされてよい。
車両センサ70は、自車両Mの速度を検出する車速センサ、加速度を検出する加速度センサ、鉛直軸回りの角速度を検出するヨーレートセンサ、自車両Mの向きを検出する方位センサ等を含む。また、車両センサ70は、外気温度を検知する外気温センサが含まれてもよい。
運転操作子80は、例えば、アクセルペダル、ブレーキペダル、シフトレバー、ステアリングホイールその他の操作子を含む。運転操作子80には、操作量あるいは操作の有無を検出するセンサが取り付けられており、その検出結果は、自動運転制御ユニット100、もしくは、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220のうち一方または双方に出力される。
自動運転制御ユニット100は、例えば、第1制御部120と、第2制御部140と、記憶部160とを備える。第1制御部120、および第2制御部140は、それぞれ、CPU(Central Processing Unit)等のプロセッサがプログラム(ソフトウェア)を実行することで実現される。また、各機能部のうち一部または全部は、LSI(Large Scale Integration)やASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)、GPU(Graphics Processing Unit)等のハードウェア(回路部;circuitryを含む)によって実現されてもよいし、ソフトウェアとハードウェアの協働によって実現されてもよい。また、外界認識部121および自車位置認識部122を組み合わせたものが、「認識部」の一例である。
第1制御部120は、例えば、外界認識部121と、自車位置認識部122と、行動計画生成部123とを備える。
外界認識部121は、カメラ10、レーダ装置12、およびファインダ14から物体認識装置16を介して入力される情報に基づいて、周辺車両の位置、および速度、加速度等の状態を認識する。周辺車両の位置は、その周辺車両の重心やコーナー等の代表点で表されてもよいし、周辺車両の輪郭で表現された領域で表されてもよい。周辺車両の「状態」とは、周辺車両の加速度やジャーク、あるいは「行動状態」(例えば車線変更をしている、またはしようとしているか否か)を含んでもよい。また、外界認識部121は、周辺車両に加えて、ガードレールや電柱、駐車車両、歩行者その他の物体の位置を認識してもよい。
自車位置認識部122は、例えば、自車両Mが走行している車線(走行車線)、並びに走行車線に対する自車両Mの相対位置および姿勢を認識する。自車位置認識部122は、例えば、第2地図情報62から得られる道路区画線のパターン(例えば実線と破線の配列)と、カメラ10によって撮像された画像から認識される自車両Mの周辺の道路区画線のパターンとを比較することで、走行車線を認識する。この認識において、ナビゲーション装置50から取得される自車両Mの位置やINSによる処理結果が加味されてもよい。
そして、自車位置認識部122は、例えば、走行車線に対する自車両Mの位置や姿勢を認識する。図2は、自車位置認識部122により走行車線L1に対する自車両Mの相対位置および姿勢が認識される様子を示す図である。自車位置認識部122は、例えば、自車両Mの基準点(例えば重心)の走行車線中央CPからの乖離OS、および自車両Mの進行方向の走行車線中央CPを連ねた線に対してなす角度θを、走行車線L1に対する自車両Mの相対位置および姿勢として認識する。なお、これに代えて、自車位置認識部122は、自車線L1のいずれかの側端部に対する自車両Mの基準点の位置等を、走行車線に対する自車両Mの相対位置として認識してもよい。自車位置認識部122により認識される自車両Mの相対位置は、推奨車線決定部61および行動計画生成部123に提供される。
行動計画生成部123は、推奨車線決定部61により決定された推奨車線を走行するように、且つ、自車両Mの周辺状況に対応できるように、自動運転において順次実行されるイベントを決定する。イベントには、例えば、一定速度で同じ走行車線を走行する定速走行イベント、前走車両に追従する追従走行イベント、車線変更イベント、合流イベント、分岐イベント、緊急停止イベント、自動運転を終了して手動運転に切り替えるためのハンドオーバイベント等がある。また、これらのイベントの実行中に、自車両Mの周辺状況(周辺車両や歩行者の存在、道路工事による車線狭窄等)に基づいて、回避のための行動が計画される場合もある。
行動計画生成部123は、自車両Mが将来走行する目標軌道を生成する。目標軌道は、例えば、速度要素を含んでいる。例えば、目標軌道は、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとに将来の基準時刻を複数設定し、それらの基準時刻に到達すべき目標地点(軌道点)の集合として生成される。このため、軌道点同士の間隔が広い場合、その軌道点の間の区間を高速に走行することを示している。
図3は、推奨車線に基づいて目標軌道が生成される様子を示す図である。図示するように、推奨車線は、目的地までの経路に沿って走行するのに都合が良いように設定される。行動計画生成部123は、推奨車線の切り替わり地点の所定距離手前(イベントの種類に応じて決定されてよい)に差し掛かると、車線変更イベント、分岐イベント、合流イベント等を起動する。各イベントの実行中に、障害物を回避する必要が生じた場合には、図示するように回避軌道が生成される。
行動計画生成部123は、例えば、目標軌道の候補を複数生成し、効率性の観点に基づいて、その時点での最適な目標軌道を選択する。
イベントは、例えば、自車両Mの車外の状況に基づいて、発生するイベントである。自車両Mの車外の状況に基づいて発生するイベントとは、例えば、外界認識部121の認識結果に基づいて行動計画生成部123により決定されるイベントや、後述するリクエスト信号を受信するイベントである。アクションとは、例えば、自車両Mの操舵を制御すること、または加減速を制御することによって、予め期待される所定の挙動を自車両Mに発生させることである。より具体的には、リクエスト信号を受信した際のアクションとは、例えば自車両Mの前方に他車両を割り込ませることである。
また、行動計画生成部123は、外界認識部121により認識された他車両の位置と、自車位置認識部122により認識された自車両Mの位置と、自車両Mまたは他車両の走行環境等に基づいて、自車両Mの将来の走行軌道を生成する。行動計画生成部123の機能の詳細については後述する。
第2制御部140は、走行制御部141を備える。走行制御部141は、行動計画生成部123によって生成された目標軌道を、予定の時刻通りに自車両Mが通過するように、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220を制御する。
記憶部160は、例えば、ROM(Read Only Memory)、EEPROM(Electrically Erasable and Programmable Read Only Memory)、HDD(Hard Disk Drive)等の不揮発性の記憶装置と、RAM(Random Access Memory)、レジスタ等の揮発性の記憶装置によって実現される。記憶部160には、実施形態における車両制御を実行するための各種情報および実行結果等が記憶される。
走行駆動力出力装置200は、車両が走行するための走行駆動力(トルク)を駆動輪に出力する。走行駆動力出力装置200は、例えば、内燃機関、電動機、および変速機等の組み合わせと、これらを制御するECUとを備える。ECUは、走行制御部141から入力される情報、或いは運転操作子80から入力される情報に従って、上記の構成を制御する。
ブレーキ装置210は、例えば、ブレーキキャリパーと、ブレーキキャリパーに油圧を伝達するシリンダと、シリンダに油圧を発生させる電動モータと、ブレーキECUとを備える。ブレーキECUは、走行制御部141から入力される情報、或いは運転操作子80から入力される情報に従って電動モータを制御し、制動操作に応じたブレーキトルクが各車輪に出力されるようにする。ブレーキ装置210は、運転操作子80に含まれるブレーキペダルの操作によって発生させた油圧を、マスターシリンダを介してシリンダに伝達する機構をバックアップとして備えてよい。なお、ブレーキ装置210は、上記説明した構成に限らず、走行制御部141から入力される情報に従ってアクチュエータを制御して、マスターシリンダの油圧をシリンダに伝達する電子制御式油圧ブレーキ装置であってもよい。
ステアリング装置220は、例えば、ステアリングECUと、電動モータとを備える。電動モータは、例えば、ラックアンドピニオン機構に力を作用させて転舵輪の向きを変更する。ステアリングECUは、走行制御部141から入力される情報、或いは運転操作子80から入力される情報に従って、電動モータを駆動し、転舵輪の向きを変更させる。
[行動計画生成部の詳細]
次に、行動計画生成部123の機能の詳細について説明する。図4は、行動計画生成部123の機能構成図である。行動計画生成部123は、例えば、速度生成部130と、グリッド処理部131と、誘導ポテンシャル設定部132と、物標ポテンシャル設定部134と、評価部136と、選択部137と、軌道生成部138とを備える。物標ポテンシャル設定部134は、「ポテンシャル設定部」の一例である。
速度生成部130は、例えば、外界認識部121の認識結果に基づいて、自車両Mの現在または将来の速度(目標速度)を生成する。速度は、法定速度を超えないように、任意に設定される。
グリッド処理部131は、自車両Mの前方の路面領域に対し、道路の長手方向に沿った方向(進行方向)、道路の幅方向に沿った方向(横方向)を軸とした座標系(i,j)を想定し、路面領域を二方向に一定幅で区切って得られるグリッドGを仮想的に設定する。
図5は、路面領域に設定されたグリッドGの一例を示す図である。図5の例では、片側二車線の道路を示している。また、図5の例では、説明を簡易化するために直線路で表している。グリッドGの区切り幅は、進行方向と横方向とで等しくなるように設定してもよいし、異なるように設定してもよい。また、グリッドGは、格子状に設定される必要はなく、ハニカム状等、他の態様で設定されてもよい。また、グリッドGは、四角に限らず、丸や他の多角形であってもよい。また、図5では説明を簡易化するために直線路で表しているが、カーブ路に関しても、何らかの変換処理を介することで同様の処理を行うことができる。
また、グリッド処理部131は、評価部136の評価対象である有効領域を設定する。ここでは、有効領域を一つの車線内に限定して設定するものとする。有効領域は、例えば、図示のように走行車線L1において、道路区画線CL付近の領域AR1、および左側の道路区画線LL付近の領域AR2を除いた有効領域EF内に設定される。有効領域EFは、例えば、自車両Mの代表点(例えば重心)が有効領域EF内に収まっていれば、道路区画線CLまたはLLに対して自車両Mの一部でも重なることが無いように設定される領域である。
誘導ポテンシャル設定部132は、道路領域に基づいて、誘導ポテンシャルPiを設定する。誘導ポテンシャルPiとは、例えば、道路を区画する存在(道路区画線、ガードレール、中央分離帯、路肩線等)に基づいて、道路の領域に対して設定された指標値である。
図6は、誘導ポテンシャルPiの一例を示す図である。縦軸は、誘導ポテンシャルPiを示し、横位置は車線における位置を示している。誘導ポテンシャルPiは、値の低い方に自車両Mが誘導される性質をもった指標値である。誘導ポテンシャルPiの値は、例えば、図6の実線で示すように走行車線中央CPから遠くなるほど高くなるように設定される。
また、誘導ポテンシャル設定部132は、走行する道路がカーブ路である場合に、誘導ポテンシャルPiを、対向車線から離れる方向(道路区画線LL側)に所定距離だけオフセットさせてもよい。この場合、誘導ポテンシャルPiの値は、例えば、図6の点線で示すように走行車線中央CPから所定距離だけオフセットさせた位置CP’で最も低く、そこから遠くなるほど高くなるように設定される。特に、対向車線を走行する対向車両は、相対速度が速いため、走行する道路がカーブ路である場合に、物体認識装置16により対向車両が認識されるよりも前に、対向車線よりも離れた方向に誘導ポテンシャルPiをオフセットする。これにより、カーブ路を走行する場合に、自車両Mの走行位置を対向車線から離れる方向にずらすことができ、対向車線を走行する対向車両との接触を回避しやすくすることができる。
物標ポテンシャル設定部134は、将来の自車両Mの周辺状況に基づいて、物標ポテンシャルPoを設定する。物標ポテンシャルPoは、例えば、外界認識部121により認識された周辺物体のそれぞれに対して設定される指標値である。物標ポテンシャルは、値の低い方に自車両Mが誘導される性質をもった指標値である。物標ポテンシャルは、例えば、物体(例えば、他車両)から遠くなるほど低くなるように設定される。
図7は、物標ポテンシャルPoの設定手法について説明するための図である。図示する例は、時刻t0において、物標ポテンシャル設定部134が物標ポテンシャルPoを設定する場面を示している。例えば、時刻t0において、自車両Mの走行車線L1には、自車両Mの前方において他車両m1が走行し、隣接車線L2には、自車両Mと進行方向に関して重なる位置に他車両m2が走行している。
物標ポテンシャル設定部134は、速度生成部130により生成された速度に基づいて、時刻t0〜t4の自車両Mの位置を予測する。図7の例では、自車両Mは、時刻t0において位置0(ゼロ)に位置し、時刻t1において位置x1に進行すると予想され、時刻t2において位置x2に進行すると予想され、時刻t3において位置x3に進行すると予想され、時刻t4において位置x4に進行すると予測される。また、物標ポテンシャル設定部134は、時刻t0および、それ以前の他車両m1、m2の挙動に基づいて、時刻t1〜t4の他車両m1、m2の位置を予測する。図7の時刻t1〜t4における各車両の位置が、自車両M、他車両m1、および他車両m2の位置の予測結果である。
他車両m1に関する物標ポテンシャルPoについて説明する。例えば、自車両Mは、時刻t4において、他車両m1に追いつくと予測される。したがって、物標ポテンシャル設定部134は、自車両Mが他車両m1に追いつく時刻(或いはそれよりも若干前の時刻)における他車両m1の占める領域PoAを中心とし、周辺領域PoA2を含めた領域を物標ポテンシャル領域PoAとして設定する。物標ポテンシャル領域PoAとは、物標ポテンシャルPoの分布を表す領域である。
図8は、他車両m1に設定された物標ポテンシャル領域PoAを他車両m1の後ろから見た様子を示す図である。図8の物標ポテンシャル領域PoAの各座標における高さは、物標ポテンシャルPоの大きさを示している。例えば、物標ポテンシャルPoは、他車両m1の位置に対応する領域PоA1が最も大きく、この領域PоA1から離れるほど徐々に低くなるように設定される。この場合、物標ポテンシャル設定部134は、所定の関数等を用いて領域PоA1からの距離に基づく物標ポテンシャルPoの大きさを設定する。また、物標ポテンシャル設定部134は、領域PоA1からの距離に応じて段階的に物標ポテンシャルPoの大きさを設定してもよい。
他車両m2に対する物標ポテンシャルPoについて説明する。自車両Mが、時刻t0〜時刻t2の各時点において、他車両m2と進行方向に関して少なくとも一部が重なると予測される。物標ポテンシャル設定部134は、自車両Mと他車両m2の横位置が重なっている時間帯(或いはそれよりも若干長目に設定した時間帯)における他車両m2の位置履歴の占める領域を中心として物標ポテンシャルPoを設定する。
図9は、他車両m2に設定された物標ポテンシャル領域PoAを横から見た様子を示す図である。図9の物標ポテンシャル領域PoAの各座標における高さは、物標ポテンシャルPoの大きさを示している。例えば、物標ポテンシャルPoは、他車両m2の時刻t0〜時刻t2の各位置に対応する領域PoA1が最も大きく、この領域PоA1から離れるほど徐々に低くなるように設定される。図10は、図7の場面において、設定される物標ポテンシャル領域PoAを三次元で模式的に示した図である。図中の高さ方向は、物標ポテンシャルPoの大きさを示している。
また、物標ポテンシャル設定部134は、自車両Mが所定の走行環境を走行しているか否かに基づいて、上述した直線路において設定された物標ポテンシャル領域PoAを異ならせてもよい。所定の走行環境とは、例えば、自車両Mまたは他車両が走行する車線の形状、他車両の走行状態、車線上の障害物の有無、道路区画線の認識の有無等である。車線の形状とは、例えば、カーブ路、S字路、進行方向または進行方向に対する横方向の傾斜、または道幅の変化である。他車両の走行状態とは、例えば、他車両が道路区画線側に寄って走行している状態である。
図11は、カーブ路を走行する自車両Mと他車両m3との関係について説明するための図である。なお、図11〜図14の例では、走行車線L1は一車線であるものとし、車線L3は、対向車線であるものとする。物標ポテンシャル設定部134は、自車両Mまたは他車両m3の走行路がカーブ路である場合に、上述した直線路で設定した物標ポテンシャル領域PoAを、カーブ路の曲率半径Rに基づいて異ならせた物標ポテンシャル領域PoAcを設定する。なお、図11の例において、物標ポテンシャル領域PoAcが他車両m3の前方付近に延在しているのは、上述したように、自車両Mの進行方向と他車両m3の進行方向との関係において、他車両m3の前方で接触する可能性が高いからである。曲率半径Rは、例えば、車線間の道路区画線を基準に設定されていてもよく、車線の中央を基準に設定されていてもよい。
図12は、他車両m3に設定されたカーブ路における物標ポテンシャル領域PoAcを他車両m3の正面から見た様子を示す図である。図12の物標ポテンシャル領域PoAcの各座標における高さは、物標ポテンシャルPоの大きさを示している。物標ポテンシャル設定部134は、他車両m1の位置に対応する領域PоA1が最も大きく、この領域PоA1から離れるほど徐々に低くなるように物標ポテンシャルPоを設定する。ここで、他車両m3のステアリングホイールの操舵角θは、車線L3の曲率半径Rに応じて自車両M側に変化することが予測される。したがって、物標ポテンシャル設定部134は、領域PоA1を基準として車線L1側に近づく方向に対する物標ポテンシャルPoの大きさを、自車両Mから離れる方向の物標ポテンシャルPоに比べて大きくなるように調整する。つまり、図12に示す他車両m3を基準とした車線L1側の物標ポテンシャル領域PoA2bは、直線路を走行しているときに設定された車線L1と反対側の物標ポテンシャル領域PoA2aよりも大きくなる。
物標ポテンシャル設定部134は、所定の関数等を用いて曲率半径Rに対する物標ポテンシャル領域PoAcを調整してもよく、領域PоA1からの距離に基づいて段階的に大きくなるように調整してもよい。また、物標ポテンシャル設定部134は、曲率半径Rが小さくなるほど(曲率が大きくなるほど、急カーブになるほど)、物標ポテンシャル領域PoAcの変化度合を大きくしてもよい。
また、物標ポテンシャル設定部134は、カーブ路の曲率に基づいて物標ポテンシャルPoを異ならせる程度を変更してもよい。この場合、物標ポテンシャル設定部134は、自車両Mまたは他車両m3が所定曲率以上(言い換えると、曲率半径Rが所定値以下)のカーブ路を走行している場合の物標ポテンシャル領域PoAcを、自車両または他車両m3が所定曲率以上のカーブ路を走行していない場合の物標ポテンシャル領域PoAよりも大きくなるように設定する。
このように、他車両m3の走行車線L3の曲率半径Rに基づいて、物標ポテンシャル領域を調整することで、他車両が道路区画線CLをはみ出す可能性が高いと予測される場合に、物標ポテンシャル領域PoAが調整されるため、より適切な走行軌道を生成し、生成した走行軌道を走行することができる。
図13は、他車両m3が車線L3を道路区画線CLに走行している場合の物標ポテンシャル領域PoAdの設定について説明するための図である。例えば、物標ポテンシャル設定部134は、自車両Mの走行車線L1と、他車両m3の走行車線L3とを区画する道路区画線CLに寄って走行している場合に、物標ポテンシャル領域PoAcの全体を更に大きくした物標ポテンシャル領域PoAdを設定する。この場合、物標ポテンシャル設定部134は、自車両Mの車線L3の中心CPからの乖離OSの大きさに応じて、物標ポテンシャル領域PoAcに対する物標ポテンシャル領域PoAdの変化度合が大きくなるように調整してもよい。
図14は、他車両m3の進行方向に障害物Obが検出された場合の物標ポテンシャル領域PoAeの設定について説明するための図である。障害物Obとは、例えば、カラーコーン(登録商標)や電柱、ガードレール、路上駐車車両、歩行者、その他の物体等である。
例えば、他車両m3の進行方向に障害物Obが存在する場合、他車両m3は、障害物Obを避けるために、車線L1側に進入してくる可能性が高い。そのため、物標ポテンシャル設定部134は、外界認識部121により他車両m3の進行方向に障害物Obが認識された場合に、他車両m3の挙動が変化する可能性が高いと予測し、挙動が変化する可能性が高いと予測されなった場合の物標ポテンシャル領域PoAcと異なる物標ポテンシャル領域PoAeを設定する。この場合、物標ポテンシャル設定部134は、自車両Mまたは他車両m3の速度や位置、或いは障害物Obの位置、大きさに基づいて物標ポテンシャル領域PoAeの形状を変形させてよい。これにより、他車両m3の位置および挙動に応じて物標ポテンシャル領域PoAeを設定することができる。
図15は、走行車線と対向車線との間の道路区画線が認識できない場合の物標ポテンシャル領域PoAfの設定について説明するための図である。走行車線と対向車線との間の道路区画線が認識できない場合とは、例えば、カメラ10により撮像された画像から道路区画線が認識できない場合である。また、画像から道路区画線が認識できない例としては、通常あるはずの道路区画線が消えていたり、かすれている場合、または、路地等の狭い道路であるため、そもそも道路区画線がない場合である。図15の例では、そもそも道路区画線がない車線L4を示している。
例えば、車線L4に対して自車両Mと他車両m3とが対向して走行する場合、他車両m3が自車両M側に走行していることが予測される。したがって、物標ポテンシャル設定部134は、走行車線と対向車線との間の道路区画線が認識できない場合に、物標ポテンシャル領域PoAcと比べて広めの物標ポテンシャル領域PoAfを設定する。広めの物標ポテンシャル領域とは、例えば、物標ポテンシャル領域PoAcを基準として、所定比率だけ大きくした領域でもよく、他車両m3の進行方向または進行方向に対して横方向に延在させた領域でもよい。これにより、走行車線の状態に応じて適切な物標ポテンシャル領域PoAを設定することができる。
また、物標ポテンシャル設定部134は、走行車線の路面状態が悪路である場合やスリップ路である場合等に物標ポテンシャル領域PoAを変更してもよい。路面状態については、例えば、通信装置20を介して外部装置から取得した天候情報や車両センサ70に含まれる外気温度等から取得してもよい。例えば、物標ポテンシャル設定部134は、天候が雨または雪であり、外気温度が所定温度以下である場合に、路面が凍結してスリップしやすいことが予測されるため、物標ポテンシャル領域PoAを広くする。
評価部136は、複数のグリッド(分割領域)のうち、着目する着目グリッド(着目分割領域)に設定された誘導ポテンシャルPiおよび物標ポテンシャルPoと、着目グリッドの周辺から選択される周辺グリッド(周辺分割領域)に対して生成された予見情報とに基づいて、着目グリッドのポテンシャルを評価した指標値を導出する。予見情報は、例えば、自車両Mの現在の状況から予測される将来の自車両Mおよび自車両Mの周辺の状況に基づいて生成される情報であり、周辺グリッドに対して設定された誘導ポテンシャルPiおよび物標ポテンシャルPoに基づいて設定される。周辺グリッド(予見情報の対象となるグリッド)とは、例えば着目グリッドの進行方向、または自車両Mの幅方向のうち、一方または双方に沿って延在する所定数のグリッドである。例えば、周辺グリッドは、自車両Mの進行方向に沿って着目グリッドよりも自車両Mの進行方向の先側に延在するグリッドを含む。また、周辺グリッドは、例えば自車両Mの走行状態に基づいて決定されてもよい。例えば、周辺グリッドは、自車両Mの走行速度に所定時間(例えば数秒)を乗算した距離に相当するグリッドである。
次に、評価部136は、有効領域EFの各グリッドGに対して指標値を導出する。図16は、指標値の導出について説明するための図である。例えば、グリッドG1について着目する。評価部136は、例えば、グリッドG1に対して設定された誘導ポテンシャルPiと物標ポテンシャルPoとに基づいて、統合ポテンシャルを導出する。統合ポテンシャルは、誘導ポテンシャルPiと物標ポテンシャルPoとを加算、加重和、乗算等した指標であってもよいし、所定の関数等に誘導ポテンシャルPiおよび物標ポテンシャルPoを入力して導出された指標値であってもよい。
次に、評価部136は、グリッドG1の統合ポテンシャルと、予見情報とに基づいて、グリッドG1の統合指標値を導出する。図16の例において、予見情報は、例えば、グリッドG2〜Gnのそれぞれに対して設定された誘導ポテンシャルPiと物標ポテンシャルPoとを統合した情報である。統合した情報とは、例えば、グリッドG2〜Gnのそれぞれに対してグリッドG1と同様に導出される統合ポテンシャルである。以下、これを予見指標値と称する。
また、評価部136は、予見指標値を導出する際に、着目グリッドG1から遠くなるほど小さくなる重みを乗算してもよい。例えば、統合指標値は、下記の式(1)に基づいて導出される。
Figure 0006651486
ここで、「Q」は着目グリッドGの統合指標値、「i」は着目グリッドの進行方向の座標、「j」は着目グリッドの幅方向の座標、「α」は予見情報の対象となる進行方向の範囲、「β」は予見情報の対象となる幅方向の範囲をそれぞれ示している。式(1)では、予見情報の対象となる幅方向の範囲が任意に設定可能であることを示しているが、図16の例では、βは1グリッド分の値を持つように設定されている。
また、この場合、周辺グリッドに関して、自車両Mの進行方向(i方向)に沿って選択されるグリッドが自車両Mの幅方向(j方向)に沿って選択されるグリッドよりも多くてもよい。
なお、誘導ポテンシャルPiや、物標ポテンシャルPo、統合ポテンシャル等は、有効領域EF外のグリッドGに対しても求められてもよい。これにより、有効領域EFの進行方向側の端部のグリッドGに対しても指標値を精度よく導出することができる。また、有効領域EFの進行方向側の端部のグリッドGに対して指標値を導出する際、予め設定した値を用いて、端部のグリッドGの指標値を導出してもよい。
また、周辺グリッドは、下記に示すように、矩形や円、楕円でない形状の範囲を対象としてもよいし、正方形や、長方形に限らず、多角形の範囲を対象としてもよい。図17は、周辺グリッドの他の一例を示す図である。周辺グリッドは、例えば、着目するグリッドGに対して進行方向から「n(任意の自然数)」個、および幅方向に「k(任意の自然数)」個のグリッドGを含む範囲PR1であってもよい。例えば、グリッドG1に着目した場合、周辺グリッドは、着目グリッドG1に対して進行方向から「n(任意の自然数)」個のグリッドG2〜Gn、およびグリッドG1の幅方向に隣接するグリッドGを含み、更に隣接するグリッドGに対して進行方向に延在する2個のグリッドGを含む範囲PR1であってもよい。
図4に戻り、選択部137は、有効領域EF内において、評価部136により導出された統合指標値に基づいて、複数のグリッドから自車両Mの進行方向に沿った一以上のグリッドを選択する。
軌道生成部138は、選択部137により選択された自車両Mの進行方向に沿った一以上のグリッドに基づいて自車両Mの将来の目標軌道を生成する。
図18は、選択部137により選択された選択グリッドSGと、選択グリッドSGに基づいて生成される目標軌道TLについて説明するための図である。選択部137は、自車両Mの進行方向に対して横方向に延在する複数のグリッドGにおいて、例えば、それぞれのグリッドGに対して導出された統合指標値のうち、最も統合指標値が低いグリッドGを選択グリッドSGとして選択する。
軌道生成部138は、選択部137により選択された選択グリッドSGになるべく接近すると共に、スプライン関数(またはエルミート関数)等で表される滑らかな曲線を生成し、その曲線上に目標軌道TLを生成する。
[フローチャート]
図19は、実施形態の行動計画生成部123により実行される処理の一例を示すフローチャートである。本フローチャートの処理は、例えば、所定の周期或いは所定のタイミングで繰り返し実行されてよい。まず、速度生成部130は、外界認識部121の認識結果に基づいて、自車両Mの現在または将来の速度(目標速度)を生成する(ステップS100)。次に、グリッド処理部131は、自車両Mの走行車線の縦方向および横方向の走査対象のグリッドGを設定する(ステップS102)。
次に、誘導ポテンシャル設定部132は、誘導ポテンシャルPiを設定する(ステップS104)。次に、物標ポテンシャル設定部134は、外界認識部121により認識された物体(例えば、他車両や障害物)に基づいて物標ポテンシャルPoを設定する(ステップS106)。次に、物標ポテンシャル設定部134は、他車両または自車両Mが所定の走行環境(例えば、カーブ路)を走行しているか否かを判定する(ステップS108)。他車両または自車両Mが所定の走行環境を走行している場合、物標ポテンシャル設定部134は、走行環境に基づいて物標ポテンシャルPoを調整する(ステップS110)。つまり、物標ポテンシャル設定部134は、所定の走行環境を走行している場合と、走行していない場合とで、物標ポテンシャルPoを異ならせる。
次に、評価部136は、誘導ポテンシャルPiと、物標ポテンシャルPoと、予見情報とに基づいて、着目したグリッドの統合指標値を導出する(ステップS112)。次に、選択部137は、縦方向のグリッドごとに、横方向の複数のグリッドのうち、統合指標値が最も小さい統合指標値を選択する(ステップS114)。次に、軌道生成部138は、選択された統合指標値に基づいて、自車両Mの将来の走行軌道を生成する(ステップS116)。これにより、本フローチャートの1ルーチンの処理は終了する。
上述した実施形態によれば、走行環境に応じて、より適切な走行軌道を生成することができる。例えば、実施形態によれば、直線路を走行する場合に比べて、カーブ路等を走行する他車両の自車両に対する影響度を高く設定することができるため、他車両との接触可能性の低い走行軌道を生成することができる。
なお、上述した実施形態では、車両制御装置が自動運転車両に適用された例を説明したが、例えば統合ポテンシャルや統合指標値の大きさに基づいて、乗員に他車両との接触可能性を通知したり、接触回避を行う運転支援装置が搭載された車両に適用してもよい。
[ハードウェア構成]
上述した実施形態の自動運転制御ユニット100は、例えば、図20に示すようなハードウェアの構成により実現される。図20は、実施形態の自動運転制御ユニット100のハードウェア構成の一例を示す図である。
自動運転制御ユニット100は、通信コントローラ100−1、CPU100−2、RAM100−3、ROM100−4、フラッシュメモリやHDD等の二次記憶装置100−5、およびドライブ装置100−6が、内部バスあるいは専用通信線によって相互に接続された構成となっている。ドライブ装置100−6には、光ディスク等の可搬型記憶媒体が装着される。二次記憶装置100−5に格納されたプログラム100−5aがDMAコントローラ(不図示)等によってRAM100−3に展開され、CPU100−2によって実行されることで、第1制御部120、および第2制御部140が実現される。また、CPU100−2が参照するプログラムは、ドライブ装置100−6に装着された可搬型記憶媒体に格納されていてもよいし、ネットワークNWを介して他の装置からダウンロードされてもよい。
上記実施形態は、以下のように表現することができる。
情報を記憶する記憶装置と、
プログラムを実行するハードウェアプロセッサと、を備え、
前記記憶装置には、前記ハードウェアプロセッサに、
自車両の周辺車両を認識する認識処理と、
道路領域を分割した複数の分割領域に対して、前記認識処理により認識された周辺車両に基づく物標ポテンシャルを設定するポテンシャル設定処理であって、前記自車両または前記周辺車両が所定の走行環境を走行しているか否かに応じて前記物標ポテンシャルを異ならせるポテンシャル設定処理と、
を実行させるための前記プログラムが格納される、
車両制御装置。
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
1‥車両システム、10‥カメラ、12‥レーダ装置、14‥ファインダ、16‥物体認識装置、20…通信装置、30…HMI、50…ナビゲーション装置、60…MPU、70…車両センサ、80…運転操作子、100‥自動運転制御ユニット、120‥第1制御部、121‥外界認識部、122‥自車位置認識部、123‥行動計画生成部、130‥速度生成部、131‥グリッド処理部、132‥誘導ポテンシャル設定部、134‥物標ポテンシャル設定部、136‥評価部、137‥選択部、138‥軌道生成部、140…第2制御部、141…走行制御部、160…記憶部、200…走行駆動力出力装置、210…ブレーキ装置、220…ステアリング装置、M…自車両

Claims (10)

  1. 自車両の周辺車両を認識する認識部と、
    道路領域を分割した複数の分割領域に対して、前記道路領域に基づく誘導ポテンシャルと、前記認識部により認識された周辺車両に基づく物標ポテンシャル領域とを設定するポテンシャル設定部であって、前記自車両または前記周辺車両が所定の走行環境を走行しているか否かに応じて前記誘導ポテンシャルおよび前記物標ポテンシャル領域を異ならせるポテンシャル設定部と、を備え
    前記ポテンシャル設定部は、
    前記所定の走行環境がカーブ路である場合に、前記認識部により対向車両が認識されるよりも前に、前記誘導ポテンシャルの位置を、前記カーブ路でない場合に比して対向車線よりも離れた方向にオフセットし、
    前記カーブ路の曲率に基づいて前記対向車両の前記自車両側の前記物標ポテンシャル領域を、前記カーブ路でない場合に比して大きくする、
    車両制御装置。
  2. 記ポテンシャル設定部は、前記自車両または前記周辺車両が前記カーブ路を走行している場合に、前記自車両または前記周辺車両が前記カーブ路を走行していない場合とは前記物標ポテンシャル領域を異ならせる、
    請求項1に記載の車両制御装置。
  3. 前記ポテンシャル設定部は、前記カーブ路の曲率に基づいて前記物標ポテンシャル領域を異ならせる程度を変更する、
    請求項2に記載の車両制御装置。
  4. 前記所定の走行環境とは、所定曲率以上のカーブ路であり、
    前記ポテンシャル設定部は、前記自車両または前記周辺車両が所定曲率以上のカーブ路を走行している場合と、前記自車両または前記周辺車両が所定曲率以上のカーブ路を走行していない場合とで、前記物標ポテンシャル領域を異ならせる、
    請求項3に記載の車両制御装置。
  5. 前記ポテンシャル設定部は、前記周辺車両の位置および挙動に基づいて、前記物標ポテンシャル領域の変化度合を異ならせる、
    請求項1から4のうち何れか1項に記載の車両制御装置。
  6. 前記認識部は、前記自車両の位置と前記周辺車両の位置との間の道路区画線を認識し、
    前記ポテンシャル設定部は、前記認識部により前記道路区画線が認識された場合と、前記道路区画線が認識されなかった場合とで、前記物標ポテンシャル領域を異ならせる、
    請求項1から5のうち何れか1項に記載の車両制御装置。
  7. 前記ポテンシャル設定部は、前記周辺車両の走行環境に基づいて、前記周辺車両の挙動が変化する可能性が高いと予測される場合と、予測されなかった場合とで、前記物標ポテンシャル領域を異ならせる、
    請求項1から6のうち何れか1項に記載の車両制御装置。
  8. 記複数の分割領域のうち着目する着目分割領域に設定された前記物標ポテンシャル領域および前記誘導ポテンシャルと、前記着目分割領域の周辺から選択される周辺分割領域に対して生成された予見情報とに基づいて、前記着目分割領域のポテンシャルを評価した指標値を導出する評価部と、
    前記評価部により導出された指標値に基づいて、前記複数の分割領域から前記自車両の進行方向に沿った一以上の分割領域を選択する選択部と、
    前記選択部により選択された前記自車両の進行方向に沿った一以上の分割領域に基づいて、前記自車両の将来の走行軌道を生成する軌道生成部と、を更に備える、
    請求項1から7のうち何れか1項に記載の車両制御装置。
  9. コンピュータが、
    自車両の周辺車両を認識し、
    道路領域を分割した複数の分割領域に対して、前記道路領域に基づく誘導ポテンシャルと、認識された前記周辺車両に基づく物標ポテンシャル領域とを設定し、
    前記自車両または前記周辺車両が所定の走行環境を走行しているか否かに応じて前記誘導ポテンシャルおよび前記物標ポテンシャル領域を異ならせ
    前記所定の走行環境がカーブ路である場合に、対向車両が認識されるよりも前に、前記誘導ポテンシャルの位置を、前記カーブ路でない場合に比して対向車線よりも離れた方向にオフセットし、
    前記カーブ路の曲率に基づいて前記対向車両の前記自車両側の前記物標ポテンシャル領域を、前記カーブ路でない場合に比して大きくする、
    車両制御方法。
  10. コンピュータに、
    自車両の周辺車両を認識させ、
    道路領域を分割した複数の分割領域に対して、前記道路領域に基づく誘導ポテンシャルと、認識された前記周辺車両に基づく物標ポテンシャル領域とを設定させ、
    前記自車両または前記周辺車両が所定の走行環境を走行しているか否かに応じて前記誘導ポテンシャルおよび前記物標ポテンシャル領域を異ならせ
    前記所定の走行環境がカーブ路である場合に、対向車両が認識されるよりも前に、前記誘導ポテンシャルの位置を、前記カーブ路でない場合に比して対向車線よりも離れた方向にオフセットさせ、
    前記カーブ路の曲率に基づいて前記対向車両の前記自車両側の前記物標ポテンシャル領域を、前記カーブ路でない場合に比して大きくさせる、
    プログラム。
JP2017168710A 2017-09-01 2017-09-01 車両制御装置、車両制御方法、およびプログラム Active JP6651486B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2017168710A JP6651486B2 (ja) 2017-09-01 2017-09-01 車両制御装置、車両制御方法、およびプログラム
CN201810978033.1A CN109426263B (zh) 2017-09-01 2018-08-24 车辆控制装置、车辆控制方法及存储介质
US16/112,897 US10795371B2 (en) 2017-09-01 2018-08-27 Vehicle control device, vehicle control method, and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017168710A JP6651486B2 (ja) 2017-09-01 2017-09-01 車両制御装置、車両制御方法、およびプログラム

Publications (2)

Publication Number Publication Date
JP2019046161A JP2019046161A (ja) 2019-03-22
JP6651486B2 true JP6651486B2 (ja) 2020-02-19

Family

ID=65514581

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017168710A Active JP6651486B2 (ja) 2017-09-01 2017-09-01 車両制御装置、車両制御方法、およびプログラム

Country Status (3)

Country Link
US (1) US10795371B2 (ja)
JP (1) JP6651486B2 (ja)
CN (1) CN109426263B (ja)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11077756B2 (en) * 2017-11-23 2021-08-03 Intel Corporation Area occupancy determining device
DE102019105547A1 (de) * 2019-03-05 2020-09-10 Bayerische Motoren Werke Aktiengesellschaft Verfahren und Steuereinheit zur Erkennung eines ein- bzw. ausscherenden Fahrzeugs
JP7210336B2 (ja) * 2019-03-12 2023-01-23 本田技研工業株式会社 車両制御システム、車両制御方法、及びプログラム
JP7261635B2 (ja) * 2019-03-28 2023-04-20 本田技研工業株式会社 車両制御装置
US11875678B2 (en) 2019-07-19 2024-01-16 Zoox, Inc. Unstructured vehicle path planner
JP7159137B2 (ja) * 2019-09-25 2022-10-24 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
CN111142539B (zh) * 2020-01-13 2020-10-27 中智行科技有限公司 一种无人驾驶车辆控制方法、装置和无人驾驶车辆
JP7465705B2 (ja) * 2020-03-31 2024-04-11 本田技研工業株式会社 車両制御装置、車両制御方法、及びプログラム
JP7369078B2 (ja) * 2020-03-31 2023-10-25 本田技研工業株式会社 車両制御装置、車両制御方法、及びプログラム
CN111645682B (zh) * 2020-04-20 2021-12-28 长城汽车股份有限公司 一种巡航控制方法、系统及车辆
CN111367299B (zh) * 2020-05-26 2020-09-29 弗徕威智能机器人科技(上海)有限公司 行车避让方法、移动机器人和存储介质
CN113968216B (zh) * 2020-07-25 2023-11-17 华为技术有限公司 一种车辆碰撞检测方法、装置及计算机可读存储介质
CN112464782B (zh) * 2020-11-24 2024-09-13 惠州华阳通用电子有限公司 一种行人识别方法和系统
CN114792416A (zh) * 2021-01-08 2022-07-26 华为技术有限公司 一种目标检测方法及装置
CN114132317B (zh) * 2021-11-30 2023-05-23 重庆长安新能源汽车科技有限公司 智能弯道靠边行驶控制方法、系统、车辆及存储介质
CN114202625B (zh) * 2021-12-10 2023-03-14 北京百度网讯科技有限公司 路肩线的提取方法、装置及电子设备

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4254844B2 (ja) * 2006-11-01 2009-04-15 トヨタ自動車株式会社 走行制御計画評価装置
JP2010018062A (ja) * 2008-07-08 2010-01-28 Fuji Heavy Ind Ltd 車両の運転支援装置
JP5300357B2 (ja) * 2008-07-22 2013-09-25 日立オートモティブシステムズ株式会社 衝突防止支援装置
JP4853525B2 (ja) * 2009-02-09 2012-01-11 トヨタ自動車株式会社 移動領域予測装置
JP4905571B2 (ja) * 2010-03-10 2012-03-28 トヨタ自動車株式会社 車両の駐車支援装置およびそれを備える車両
JP5607409B2 (ja) * 2010-04-06 2014-10-15 トヨタ自動車株式会社 対象物リスク予測装置
CN103109313B (zh) * 2010-09-08 2016-06-01 丰田自动车株式会社 危险度计算装置
JP5673597B2 (ja) * 2011-11-18 2015-02-18 株式会社デンソー 車両用挙動制御装置
US8930128B2 (en) * 2012-02-27 2015-01-06 Lit Motors Corporation Vehicle collision mitigation system
JP2013186722A (ja) 2012-03-08 2013-09-19 Nissan Motor Co Ltd 走行制御装置及び走行制御方法
JP6441610B2 (ja) * 2013-10-30 2018-12-19 株式会社デンソー 走行制御装置及びサーバ
JP6226084B2 (ja) * 2014-11-19 2017-11-08 三菱電機株式会社 レーダ装置
US9965956B2 (en) * 2014-12-09 2018-05-08 Mitsubishi Electric Corporation Collision risk calculation device, collision risk display device, and vehicle body control device
JP6791616B2 (ja) * 2015-04-27 2020-11-25 トヨタ自動車株式会社 自動運転車両システム
JP6532786B2 (ja) * 2015-08-07 2019-06-19 株式会社日立製作所 車両走行制御装置及び速度制御方法
JP6327719B2 (ja) * 2016-02-04 2018-05-23 株式会社Subaru 車両の走行制御装置
US20190016339A1 (en) * 2016-02-16 2019-01-17 Honda Motor Co., Ltd. Vehicle control device, vehicle control method, and vehicle control program

Also Published As

Publication number Publication date
JP2019046161A (ja) 2019-03-22
CN109426263A (zh) 2019-03-05
US10795371B2 (en) 2020-10-06
CN109426263B (zh) 2022-03-18
US20190072971A1 (en) 2019-03-07

Similar Documents

Publication Publication Date Title
JP6651486B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP6823512B2 (ja) 経路決定装置、車両制御装置、経路決定方法、およびプログラム
JP6904849B2 (ja) 車両制御装置、車両制御方法、およびプログラム。
JP6817334B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JP6916953B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP6646168B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JP6649512B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JP6676196B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JP6715959B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JP6601696B2 (ja) 予測装置、予測方法、およびプログラム
US20190359209A1 (en) Vehicle control device, vehicle control method, and vehicle control program
JP6676697B2 (ja) 車両制御装置、車両制御方法、及びプログラム
WO2018131290A1 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JPWO2018216194A1 (ja) 車両制御システムおよび車両制御方法
JP6692930B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JP6663038B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JPWO2018158873A1 (ja) 車両制御装置、車両制御方法、およびプログラム
JP6638172B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP6669640B2 (ja) 軌道評価装置、軌道評価方法、および軌道評価プログラム
JP6827026B2 (ja) 車両制御装置、車両制御方法、及びプログラム
JP6763033B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JP6696006B2 (ja) 車両制御システム、車両制御方法、および車両制御プログラム
JPWO2019064490A1 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7080091B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP6781335B2 (ja) 車両制御システム、サーバ装置、車両制御方法、および車両制御プログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180529

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190613

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190625

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190823

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200122

R150 Certificate of patent or registration of utility model

Ref document number: 6651486

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150