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

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

Info

Publication number
JP7141421B2
JP7141421B2 JP2020045677A JP2020045677A JP7141421B2 JP 7141421 B2 JP7141421 B2 JP 7141421B2 JP 2020045677 A JP2020045677 A JP 2020045677A JP 2020045677 A JP2020045677 A JP 2020045677A JP 7141421 B2 JP7141421 B2 JP 7141421B2
Authority
JP
Japan
Prior art keywords
vehicle
self
lane
control mode
road
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
JP2020045677A
Other languages
English (en)
Other versions
JP2021149201A (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 JP2020045677A priority Critical patent/JP7141421B2/ja
Priority to US17/197,096 priority patent/US11702078B2/en
Priority to CN202110262630.6A priority patent/CN113479204A/zh
Publication of JP2021149201A publication Critical patent/JP2021149201A/ja
Application granted granted Critical
Publication of JP7141421B2 publication Critical patent/JP7141421B2/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
    • 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • 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
    • 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • 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
    • 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/06Road 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • 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/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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/06Direction of travel
    • 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

Description

本発明は、車両制御装置、車両制御方法、およびプログラムに関する。
従来、ズーム機能により撮影範囲を変化させて車両周辺を撮影する車載カメラを制御する車載カメラ制御装置が開示されている(例えば特許文献1参照)。この車載カメラ制御装置は、車両位置情報および地図情報に基づいて、決定された撮影範囲を撮影するよう撮影画角を制御したり、走行状態に関する情報に基づいて撮影画角を制御したりする。
特開2007-288444号公報
しかしながら、上記の装置のように、撮像範囲または撮像画角を変化させる機能を有する撮像部を設けると、コストが高くなったり、構造が複雑になったりする場合がある。
本発明は、このような事情を考慮してなされたものであり、簡便な構成で車両の周辺をより精度よく認識することができる車両制御装置、車両制御方法、およびプログラムを提供することを目的の一つとする。
この発明に係る車両制御装置、車両制御方法、およびプログラムは、以下の構成を採用した。
(1):車両制御装置は、車両が存在する第1の自己位置を取得する取得部と、前記車両の周辺の状況を検知する検知デバイスにより提供された情報に基づいて前記車両の周辺の状況を認識する第1認識部と、前記第1認識部が認識した周辺の状況、前記取得部が取得した第1の自己位置、および記憶装置に記憶された地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識する第2認識部と、前記第2認識部が認識した前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定する決定部と、前記決定部により決定された制御態様に基づいて、前記車両を制御して自動運転を行う制御部と、を備え、前記車両が走行する第1車線から、前記車両が進行予定の本線である第2車線に、前記車両が進行する予定である場合に、前記第1車線から前記第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、前記第1認識部が認識できない場合、前記決定部は、前記第2の自己位置および前記車両の向きに基づいて、前記目標を探索するための操舵角の制御態様を決定する車両制御装置である。
(2):上記(1)の態様において、前記目標を探索するための操舵角の制御態様は、前記目標が存在すると推定される第1方向に前記車両の基準方向を向ける制御態様であり、前記決定部は、少なくとも前記第2の自己位置、前記車両の向き、および前記地図情報に基づいて、前記目標が存在する方向を推定する。
(3):上記(2)の態様において、前記第1方向は、前記基準方向と前記第2車線の道路区画線が延在する方向との関係が平行に近づく方向である。
(4):上記(2)または(3)の態様において、前記目標を探索するための操舵角の制御態様は、前記目標が存在すると推定される第1方向に前記車両の基準方向を向けた後に、前記基準方向を前記第1方向に向ける前の第2方向に戻す制御態様である。
(5):上記(4)の態様において、前記第2方向は、前記第1方向に前記車両の基準方向を向けた場合における前記基準方向と前記第2車線の道路区画線が延在する方向との関係よりも、前記基準方向と前記第2車線の道路区画線が延在する方向との関係が直交に近い関係である。
(6):上記(1)から(5)のいずれかの態様において、前記検知デバイスは、前記車両の前方の固定的な範囲を撮像する撮像部である。
(7):上記(1)から(6)のいずれかの態様において、前記取得部は、衛星を用いた測位システムの測位結果に基づいて前記車両が存在する第1の自己位置を取得する。
(8):上記(1)から(7)のいずれかの態様において、前記第1認識部が認識した周辺の状況は、前記車両の前方に存在する合流領域の始点である導流帯の端部と、前記車両が合流する本線の道路区画線とを含み、前記第2認識部は、前記合流領域の始点である導流帯の端部、前記車両が合流する本線の道路区画線、前記取得部が取得した自己位置、および前記地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識する。
(9):上記(8)の態様において、前記目標は、前記合流領域の終点である導流帯の端部であり、前記第1認識部は、前記合流領域の始点と終点に基づいて、前記合流領域を認識し、前記決定部は、前記合流領域、前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定し、前記制御部は、前記決定部により決定された制御態様に基づいて自動運転を行って、前記合流領域において本線に前記車両を進入させる制御を行う。
(10):この発明の一態様に係る車両制御方法は、コンピュータが、車両が存在する第1の自己位置を取得し、前記車両の周辺の状況を検知する検知デバイスにより提供された情報に基づいて前記車両の周辺の状況を認識し、前記認識した周辺の状況、前記取得した第1の自己位置、および記憶装置に記憶された地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識し、前記認識した前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定し、前記決定された制御態様に基づいて、前記車両を制御して自動運転を行い、前記車両が走行する第1車線から、前記車両が進行予定の本線である第2車線に、前記車両が進行する予定である場合に、前記第1車線から前記第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、認識できない場合、前記第2の自己位置および前記車両の向きに基づいて、前記目標を探索するための操舵角の制御態様を決定する車両制御方法である。
(11):この発明の一態様に係るプログラムは、コンピュータに、車両が存在する第1の自己位置を取得させ、前記車両の周辺の状況を検知する検知デバイスにより提供された情報に基づいて前記車両の周辺の状況を認識させ、前記認識させた周辺の状況、前記取得させた第1の自己位置、および記憶装置に記憶された地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識させ、前記認識させた前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定させ、前記決定された制御態様に基づいて、前記車両を制御して自動運転を行わせ、前記車両が走行する第1車線から、前記車両が進行予定の本線である第2車線に、前記車両が進行する予定である場合に、前記第1車線から前記第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、認識できない場合、前記第2の自己位置および前記車両の向きに基づいて、前記目標を探索するための操舵角の制御態様を決定させるプログラムである。
(1)~(11)によれば、車両制御装置が、第2の自己位置および車両の向きに基づいて、決定された目標を探索するための操舵角の制御態様に基づいて、車両を制御して自動運転を行うことにより、簡便な構成で車両の周辺をより精度よく認識することができる。
実施形態に係る車両制御装置を利用した車両システム1の構成図である。 第1制御部120および第2制御部160の機能構成図である。 車両Mが本線に合流する際の処理について説明するための図(その1)である。 操舵が制御された後の車両Mの状態の一例を示す図である。 車両Mが本線に合流する際の処理について説明するための図(その2)である。 操舵が制御された後の車両Mの状態の一例を示す図である。 ターゲット領域TAにおいて車両Mが車線L3から車線L4に滑らかに進入する場面の一例を示す図である。 自動運転制御装置100が車両Mの位置を認識し、その後、ゼブラゾーンS2の端部TEを探索する処理について説明するための図である。 修正処理について説明するための図である。 制御態様を決定する処理について説明するための図である。 本実施形態の処理の内容について説明するための図である。 自動運転制御装置100により実行される処理の流れの一例を示すフローチャートである。 実施形態の自動運転制御装置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が他装置と通信することにより、随時、アップデートされてよい。第2地図情報62には、ゼブラゾーン(導流帯)の位置や範囲を示す情報が記憶されている。ゼブラゾーンは、車両の走行を誘導するための道路標示である。ゼブラゾーンは、例えば縞模様で表される標示である。
運転操作子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は、例えば、情報取得部110と、認識部130と、行動計画生成部140とを備える。第1制御部120は、例えば、AI(Artificial Intelligence;人工知能)による機能と、予め与えられたモデルによる機能とを並行して実現する。例えば、「交差点を認識する」機能は、ディープラーニング等による交差点の認識と、予め与えられた条件(パターンマッチング可能な信号、道路標示などがある)に基づく認識とが並行して実行され、双方に対してスコア付けして総合的に評価することで実現されてよい。これによって、自動運転の信頼性が担保される。
情報取得部110は、車両Mが走行する領域付近の地図情報を取得する。情報取得部110は、例えば、第1地図情報54の情報または第2地図情報62の情報を取得する。
認識部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の相対位置として認識してもよい。
認識部130は、例えば、位置取得部132と、第1認識部134と、第2認識部136とを備える。位置取得部132は、車両Mが存在する第1の自己位置を取得する。第1の自己位置は、例えば、衛星を用いた測位システムの測位結果に基づく位置である。第1の自己位置は、例えば、GNSS受信機51により特定、またはナビゲーション装置50により提供された車両Mの位置である。
第1認識部134は、物体認識装置16により提供された情報(車両Mの周辺の状況を検知する検知デバイスにより提供された情報)に基づいて、車両Mの周辺の状況を認識する。カメラ10、レーダ装置12、またはLIDAR14は、「検知デバイス」の一例である。検知デバイスは、例えば、検知範囲を拡大したり、縮小したりせずに、車両Mの前方の固定的な範囲を検知(または撮像)する。
第2認識部136は、第1認識部134が認識した周辺の状況、位置取得部132が取得した第1の自己位置、および情報取得部110が取得した地図情報(記憶装置に記憶された地図情報)に基づいて、第1の自己位置を修正した第2の自己位置および車両Mが走行する道路における車両Mの向きを認識する。この処理の詳細については後述する(後述する図8-図11参照)。
行動計画生成部140は、原則的には推奨車線決定部61により決定された推奨車線を走行し、更に、車両Mの周辺状況に対応できるように、車両Mが自動的に(運転者の操作に依らずに)将来走行する目標軌道を生成する。目標軌道は、例えば、速度要素を含んでいる。例えば、目標軌道は、車両Mの到達すべき地点(軌道点)を順に並べたものとして表現される。軌道点は、道なり距離で所定の走行距離(例えば数[m]程度)ごとの車両Mの到達すべき地点であり、それとは別に、所定のサンプリング時間(例えば0コンマ数[sec]程度)ごとの目標速度および目標加速度が、目標軌道の一部として生成される。また、軌道点は、所定のサンプリング時間ごとの、そのサンプリング時刻における車両Mの到達すべき位置であってもよい。この場合、目標速度や目標加速度の情報は軌道点の間隔で表現される。
行動計画生成部140は、目標軌道を生成するにあたり、自動運転のイベントを設定してよい。自動運転のイベントには、定速走行イベント、低速追従走行イベント、車線変更イベント、分岐イベント、合流イベント、テイクオーバーイベントなどがある。行動計画生成部140は、起動させたイベントに応じた目標軌道を生成する。
行動計画生成部140は、例えば、決定部142を有する。決定部142は、第2認識部136が認識した第2の自己位置および車両Mの向きに基づいて、車両Mの操舵の制御態様および速度(または加速度)の制御態様を決定する。制御態様とは、制御の方針や計画であって、単位時間あたり制御量など制御の度合を含む。操舵の制御態様は、例えば、操舵の方向や操舵の制御量であり、速度の制御態様は、例えば、速度の変化度合である。決定部142の処理の詳細については後述する。
第2制御部160は、決定部142により決定された操舵の制御態様および速度の制御態様で車両Mを制御する。第2制御部160は、行動計画生成部140によって生成された目標軌道を、予定の時刻通りに車両Mが通過するように、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220を制御する。行動計画生成部140、第2制御部160、または行動計画生成部140と第2制御部160とを合わせたものは、「制御部」の一例である。
図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から入力される情報に従って、電動モータを駆動し、転舵輪の向きを変更させる。
[合流に関する処理(その1)]
自動運転制御装置100(決定部142)は、車両Mが走行する第1車線から、車両Mが進行予定の本線である第2車線に、車両Mが進行する予定である場合に、第1車線から第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、第1認識部134が認識できない場合、第2の自己位置および車両Mの向きに基づいて、目標を探索するための操舵角の制御態様を決定する。そして、自動運転制御装置100は、決定した制御態様に基づいて車両Mを制御する。以下、この処理について説明する。
本実施形態では、車両Mが車両Mの進行方向に対して右方向の車線に車線変更して合流する例について説明するが、左方向の車線に車線変更して合流する場合も、同様の考え方に基づいて処理が行われる。この場合、適宜、右方向または左方向が他の方向に読み替えてられ、プラス方向またはマイナス方向が他の方向に読み替えられる。
以下の例では、車両Mや道路を俯瞰した図を用いて説明するが、自動運転制御装置100は、実際は車両Mの正面方向の周辺状況等を認識し、認識結果に基づいて制御を行う。
図3は、車両Mが本線に合流する際の処理について説明するための図(その1)である。以下の説明では、車両の進行方向(道路の延在方向)をX方向と称し、車両の幅方向(道路の幅方向)をY方向と称する場合がある。図3では、車線L1-L6を含む道路を示している。車線L1-L3を合流車線(第1車線)、車線L4-L6を本線(第2車線)と称する場合がある。
車線L3(第1車線)と車線L4(第2車線)とが接続される領域は、車両Mが本線に合流可能なターゲット領域TAである。車両Mは、ターゲット領域TAにおいて、車線L3から車線L4に車線変更が可能である。ターゲット領域TAのマイナスX方向側(車両Mの進行方向とは反対側)には、ゼブラゾーンS1、分岐帯OB1、分岐帯OB2が設けられている。ターゲット領域TAのプラスX方向側には、ゼブラゾーンS2、分岐帯OB3、分岐帯OB4が設けられている。ターゲット領域TAは、ゼブラゾーンS1のプラスX方向側の端部TSと、ゼブラゾーンS2のマイナスX方向側の端部TEとの間の区間である。ゼブラゾーンは、「導流帯」の一例である。
図3の領域Zは、車両M(例えば第1認識部134)が道路の標示(例えばゼブラゾーン)を認識可能な領域である。換言すると、第1認識部134が、物体認識装置16により提供された情報、カメラ10により撮像された画像、レーダ装置12の検知結果、またはLIDAR14の検知結果に基づいて、道路の標示を認識可能な領域である。領域Zは、例えば、車両Mの前方数百メートル程度(例えば150m-250m程度)の範囲の領域である。また、領域Zは、車両Mを起点にした扇状の領域である。
自動運転制御装置100が、図3に示すように、車線L3を走行し、車線L4に車線変更する計画を立てた場合、自動運転制御装置100は、ゼブラゾーンの端部TSと、ゼブラゾーンの端部TEとを認識し、認識結果に基づいて、ターゲット領域TAを認識する。そして、自動運転制御装置100は、ターゲット領域TAにおいて車線L3から車線L4に進入する計画を生成して、生成した計画に基づいて車両Mを車線L3から車線L4に進入させる。
ここで、図3に示すように、車線L3の道路が湾曲した形状を有している場合、車両MがゼブラゾーンS2の端部TEよりもプラスY方向側を向くことがある。この場合、車両Mは、ゼブラゾーンS2の端部TEを認識できない場合がある。湾曲している形状は、図3の例では、車線L3の道路がターゲット領域TAにおいて窪むように形成されている形状である。車線L3の道路は、ターゲット領域TAのマイナスX方向の所定の区間で、端部TSに向かってマイナスY方向側からプラスY方向に傾斜し、ターゲット領域TAのプラスX方向の所定の区間で、端部TEに向かってマイナスY方向側からプラスY方向に傾斜している。
本実施形態では、車両Mは、上記のようにゼブラゾーンS2の端部TEを認識できない場合、決定部142は、第2認識部136の認識結果(第2の自己位置および車両Mの向き)に基づいて、ゼブラゾーンS2の端部TE(目標)を探索するための操舵角の制御態様を決定する。そして、自動運転制御装置100は、決定された操舵角の制御態様に基づいて操舵を制御する。ゼブラゾーンS2の端部TEを探索する処理については、後述する(図8-図11参照)。
図4は、操舵が制御された後の車両Mの状態の一例を示す図である。例えば、車両Mの向きを第1方向に変える。第1方向は、車両Mの基準方向(例えば車両Mの中心軸方向)が、ターゲット領域TAの道路区画線(または本線の道路区画線)が延在する方向と平行になるような方向である。この結果、ゼブラゾーンS2の端部TEが、領域Zに含まれるようになり、第1認識部134は、ゼブラゾーンS2の端部TEを認識することができる。
例えば、自動運転制御装置100は、第1方向に車線Mの基準方向を向けた後、基準方向を第1方向に向ける前の第2方向(例えば図3に示したような向き)に戻し、ターゲット領域TAにおいて車線L3から車線L4に進入する。第2方向は、第1方向に車両Mの基準方向を向けた場合における基準方向と本線の道路区画線が延在する方向との関係よりも、基準方向と本線の道路区画線が延在する方向との関係が直交に近い関係である。
上記のように、自動運転制御装置100は、ゼブラゾーンS2の端部TEを認識した後、ターゲット領域TAを認識し、認識したターゲット領域TAにおいて車線L3から車線L4に滑らかに進入することができる。
[合流に関する処理(その2)]
上述した例では、車両Mが車線L3を走行しているものとして説明したが、車両Mが車線L2を走行している場合も、上記と同様の処理が行われてもよい。
図5は、車両Mが本線に合流する際の処理について説明するための図(その2)である。図5に示すように、車線L2の道路も車線L3と同様に道路が湾曲した形状を有している。このため、車両Mは、ゼブラゾーンS2の端部TEを認識できないため、決定部142は、第2認識部136の認識結果(第2の自己位置および車両Mの向き)に基づいて、ゼブラゾーンS2の端部TEを探索するための操舵角の制御態様を決定する。そして、自動運転制御装置100は、決定された操舵角の制御態様に基づいて操舵を制御する。
図6は、操舵が制御された後の車両Mの状態の一例を示す図である。例えば、車両Mは、前述したように車両の向きを第1方向に変える。この結果、ゼブラゾーンS2の端部TEは、領域Z内に含まれるようになり、第1認識部134は、ゼブラゾーンS2の端部TEを認識することができる。
上記のように、自動運転制御装置100は、ゼブラゾーンS2の端部TEを認識した後、図7に示すようにターゲット領域TAを認識し、認識したターゲット領域TAにおいて車線L3から車線L4に滑らかに進入することができる。
[処理の詳細]
図8は、自動運転制御装置100が車両Mの位置を認識し、その後、ゼブラゾーンS2の端部TEを探索する処理について説明するための図である。図8のAに示すように、位置取得部132は、ナビゲーション装置50により提供された情報(測位結果)に基づいて車両Mの位置P1を取得する。
例えば、自動運転制御装置100が、上記の位置P1と、地図情報のゼブラゾーンS2の端部TEの位置情報とに基づいて、端部TEの位置P2を推定すると、図8のBに示すように、位置P2は、実際の端部TEの位置とずれてしまう場合がある。なぜなら、測位結果の誤差等により位置P1が実際の車両Mの位置とずれている場合があるからである。
そこで、本実施形態では、第2認識部136が、第1認識部134が認識した周辺の状況、位置取得部132が取得した自己位置、および情報取得部110が取得した地図情報に基づいて、位置P1(第1の自己位置)を修正した第2の自己位置および車両Mが走行する道路における車両Mの向きを認識する。以下、この処理を修正処理と称する場合がある。
(車両の位置を認識する処理)
図9は、修正処理について説明するための図である。第1認識部134は、ゼブラゾーンS1の端部TS(図9では省略)や、車線L4-L6を区画する区画線D1-D4を認識する。第2認識部136は、車両Mの基準方向に延在する仮想線ILを想定する。第2認識部136は、想定した仮想線IL1と交わる道路区画線D1-D4を認識する。第2認識部136は、認識した道路区画線の本数に基づいて、車線数を認識する。例えば、道路区画線の数から1を減算した数が車線数である。
第2認識部136は、地図情報を参照して、車線数を認識してもよい。例えば、第2認識部136は、車両Mの位置(例えば測位結果である位置P1)を基準として、地図情報を参照して、推定される車線数と、認識した車線数との相違が所定数以上である場合、道路区画線を再度取得して、処理を実行してもよい。
更に、第2認識部136は、車両Mの基準位置から道路区画線D1までの距離dを認識する。道路区画線D1は、車両Mから最も近い道路区画線である。第2認識部136は、距離dが閾値以上である場合、道路区画線を正確に認識できていない場合があるため、道路区画線を再度取得して、処理を実行してもよい。距離dは、検知デバイスの検知結果に基づいて直接導出されてもよいし、車両Mの基準位置から道路区画線D1までの仮想線ILの距離と、後述する角度θとを用いた計算が行われて距離dが導出されてもよい。
上記の処理により、第2認識部136は、車両MのプラスY方向には車線L4-L6が存在し、車両Mは車線L4のマイナスY方向側に隣接する車線L3を走行していることを認識する。また、第2認識部136は、ゼブラゾーンS1の位置や、その端部TSが認識することができれば、道路のY方向に関する車両Mの位置に加え、道路のX方向に関する車両Mの位置を認識することができる。
(車両の向きを認識する処理)
第2認識部136は、想定した仮想線IL1と、道路区画線D1-D4のそれぞれとが交わる箇所を認識し、交わる箇所における仮想線ILと道路区画線D1-D4のそれぞれとが形成するなす角(仮想線ILと道路区画線D1-D3のうち所定の道路区画線とが形成するなす角)を導出する。第2認識部136は、上記の処理によりなす角θ1を認識する。そして、第2認識部136は、車両Mの基準方向が道路区画線に対してθ2回転していることを認識する。
上記の処理により、第2認識部136は、道路区画線に対する車両Mの向きを認識することができる。
なお、第2認識部136は、道路区画線に代えて(加えて)、道路標示と地図情報とに基づいて、道路標示に対する車両Mの向きを認識してもよい。地図情報において、例えばゼブラゾーンが表示された領域を示す位置座標や、車線の位置座標等が記憶されている。第2認識部136は、実際に認識されたゼブラゾーンに対する車両Mの向きを、地図情報のゼブラゾーンに対する向きに当てはめることで、道路の車線に対する車両Mの向きを認識することができる。
(操舵の操舵態様を決定する処理)
上記のように、認識された車両Mの位置と向きを参照して、決定部142は、操作の制御態様を決定する。決定部142は、少なくとも第2の自己位置、車両Mの向き、および地図情報に基づいて、端部TEが存在する方向を推定し、推定結果に基づいて、端部TE存在すると推定される第1方向に車両Mの基準方向を向ける制御態様を決定する。
図10は、制御態様を決定する処理について説明するための図である。前述したように、車両Mが車線L3を走行して、本線側の方向を向いている場合、ゼブラゾーンS2の端部TEは道路区画線D1が延在する方向に存在すると、決定部142は推定する。地図情報において(或いは一般的に)ゼブラゾーンS2は、車線L3と車線L4との間に存在するためである。そして、決定部142は、仮想線ILが道路区画線D1と平行な関係になるように(仮想線ILが仮想線IL#になるように)車両Mの向き変えるための操舵の制御態様を決定する。例えば、決定部142は、車両Mのヨー角を角度θ2だけ回転させる。角度θ2は、180度から角度θ1を減算した角度である。
このとき、決定部142は、車両Mの現在の速度と、操舵の制御態様とに基づいて、速度の制御態様を決定してもよい。例えば、決定部142は、予め自動運転制御装置100の記憶装置に記憶された制御マップに基づいて、速度の制御態様を決定する。制御マップは、操舵の方向や単位時間の制御量に対して、少なくとも許容上限速度が関連付けられたマップである。制御マップにおいては、許容上限速度は、操舵の単位時間の制御量が大きくなるほど小さくなる傾向を示している。決定部142は、例えば、制御マップを参照して、決定された操舵の制御態様に応じた許容上限速度以下の速度に、車両Mの速度を決定する。これにより、車両Mは、適切な速度において操舵の制御態様に基づいて操舵を変更することができる。
上記のように、自動運転制御装置100は、決定部142が決定した操舵の制御態様および速度の制御態様で車両Mを制御することで、ゼブラゾーンS2の端部TEを認識することができる。
(比較例との対比)
例えば、車両に搭載されたカメラが稼働して撮像範囲を変化させたり、広い視野を撮像可能なカメラを用いて撮像範囲を拡大させたりすれば、車両の周辺を認識することができる。しなしながら、上記のようにカメラの構造やカメラの機能等を向上させる場合、コストが上昇する。このため、なるべくコストを抑制しつつ、車両の周辺をより精度よく認識することが望まれている。
本実施形態では、上記および図11に示すように、自動運転制御装置100が、車両Mの周辺の状況、第1の自己位置、および地図情報に基づいて、車両Mの位置P1を修正した位置P1#および車両Mが走行する道路における車両Mの向きを認識する。更に、自動運転制御装置100は、決定部142により決定された車両Mの操舵の制御態様に基づいて車両Mの向きを変更することで、ゼブラゾーンS2の端部TEを探索する。これにより、位置P1に基づいて得られた端部TEの位置は、精度の高い端部TEに修正される。そして、自動運転制御装置100は、修正された端部TEに基づいて、ターゲット領域TAを認識し、認識したターゲット領域TAにおいて車線変更を滑らかに行うことができる。
このように、自動運転制御装置100は、簡便な構成で車両の周辺をより精度よく認識し、認識結果に基づいて、滑らかに本線に進入することができる。
[フローチャート]
図12は、自動運転制御装置100により実行される処理の流れの一例を示すフローチャートである。本処理は、車両Mがターゲット領域TAから所定距離に近づいた場合に実行される処理である。
まず、位置取得部132が、第1の自己位置を取得する(ステップS100)。次に、位置取得部132が、情報取得部110により取得された地図情報を参照して、地図情報における第1の自己位置を取得する(ステップS102)。次に、第1認識部134は、車両Mの周辺状況(例えば車線、ゼブラゾーン等)を認識する(ステップS104)。
次に、第1認識部134は、ターゲット領域TAの終点であるゼブラゾーンS2の端部TEを認識できたか否かを判定する(ステップS106)。ターゲット領域TAの終点であるゼブラゾーンS2の端部TEを認識できた場合、第2認識部136は、第1の自己位置、ターゲット領域TA、車線、および地図情報等に基づいて第2の自己位置および道路に対する車両Mの向きを認識し(ステップS108)、認識結果に基づいて車両Mを制御する。
ターゲット領域TAの終点であるゼブラゾーンS2の端部TEを認識できない場合、決定部142は、操舵の制御態様および速度の制御態様を決定する(ステップS110)。ステップS110の制御態様に基づいて車両Mが制御されることで、第1認識部134は、ターゲット領域TAの終点を認識し(ステップS112)、ステップS108の処理に進む。これにより、本フローチャートの処理が終了する。
なお、ステップS110およびS112の処理で、ターゲット領域TAの終点が認識されなかった場合、例えば、車両Mがターゲット領域TAの終点から十分に遠いと判定されてもよい。この場合、所定距離走行した後に、本フローチャートの処理が実行される。例えば、第1の自己位置がターゲット領域TAから十分に遠い場合、車両Mがターゲット領域TAの終点から十分に遠いと判定されてもよい。
また、例えば、第1の自己位置がターゲット領域TAから十分に遠くない場合、決定部142は、操舵の制御態様を、前回の処理の操舵の制御態様よりも大きく変化させるように決定し、決定した操舵の制御態様と、その操舵の制御態様に応じた速度の制御態様に基づいて車両Mを制御する。これにより、車両Mはより広い範囲を認識するように向きを変えるため、この処理で第1認識部134はターゲット領域TAの終点を認識することができる。
以上説明した実施形態によれば、自動運転制御装置100は、車両Mが走行する第1車線から、車両Mが進行予定の本線である第2車線に、車両Mが進行する場合に、第1車線から第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、第1認識部が認識できない場合、決定部142が、前記第2の自己位置および向きに基づいて、前記目標を探索するための操舵角の制御態様を決定する。そして、自動運転制御装置100は、決定部142により決定された制御態様に基づいて、車両Mを制御することにより、簡便な構成で車両の周辺をより精度よく認識することができる。
[ハードウェア構成]
図13は、実施形態の自動運転制御装置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によって実行される。これによって、第1制御部120、第2制御部160、およびこれらに含まれる機能部のうち一部または全部が実現される。
上記説明した実施形態は、以下のように表現することができる。
プログラムを記憶した記憶装置と、
ハードウェアプロセッサと、を備え、
前記ハードウェアプロセッサが前記記憶装置に記憶されたプログラムを実行することにより、
車両が存在する第1の自己位置を取得し、
前記車両の周辺の状況を検知する検知デバイスにより提供された情報に基づいて前記車両の周辺の状況を認識し、
前記認識した周辺の状況、前記取得した第1の自己位置、および記憶装置に記憶された地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識し、
前記認識した前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定し、
前記決定された制御態様に基づいて、前記車両を制御して自動運転を行い、
前記車両が走行する第1車線から、前記車両が進行予定の本線である第2車線に、前記車両が進行する予定である場合に、前記第1車線から前記第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、認識できない場合、
前記第2の自己位置および前記車両の向きに基づいて、前記目標を探索するための操舵角の制御態様を決定する、ように構成されている、車両制御装置。
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
1‥車両システム、100‥自動運転制御装置、110‥情報取得部、120‥第1制御部、130‥認識部、132‥位置取得部、134‥第1認識部、136‥第2認識部、140‥行動計画生成部、142‥決定部、160‥第2制御部

Claims (10)

  1. 車両が存在する第1の自己位置を取得する取得部と、
    前記車両の周辺の状況を検知する検知デバイスにより提供された情報に基づいて前記車両の周辺の状況を認識する第1認識部と、
    前記第1認識部が認識した周辺の状況、前記取得部が取得した第1の自己位置、および記憶装置に記憶された地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識する第2認識部と、
    前記第2認識部が認識した前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定する決定部と、
    前記決定部により決定された制御態様に基づいて、前記車両を制御して自動運転を行う制御部と、を備え、
    前記車両が走行する第1車線から、前記車両が進行予定の本線である第2車線に、前記車両が進行する予定である場合に、前記第1車線から前記第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、前記第1認識部が認識できない場合、
    前記決定部は、少なくとも前記第2の自己位置、前記車両の向き、および地図情報に基づいて、前記目標を探索するための操舵角の制御態様であって前記目標が存在すると推定される第1方向に前記車両の基準方向を向ける制御態様を決定する、
    車両制御装置。
  2. 前記第1方向は、前記基準方向と前記第2車線の道路区画線が延在する方向との関係が平行に近づく方向である、
    請求項に記載の車両制御装置。
  3. 前記目標を探索するための操舵角の制御態様は、前記目標が存在すると推定される第1方向に前記車両の基準方向を向けた後に、前記基準方向を前記第1方向に向ける前の第2方向に戻す制御態様である、
    請求項1または2に記載の車両制御装置。
  4. 前記第2方向は、前記第1方向に前記車両の基準方向を向けた場合における前記基準方向と前記第2車線の道路区画線が延在する方向との関係よりも、前記基準方向と前記第2車線の道路区画線が延在する方向との関係が直交に近い関係である、
    請求項に記載の車両制御装置。
  5. 前記検知デバイスは、前記車両の前方の固定的な範囲を撮像する撮像部である、
    請求項1からのうちいずれか1項に記載の車両制御装置。
  6. 前記取得部は、衛星を用いた測位システムの測位結果に基づいて前記車両が存在する第1の自己位置を取得する、
    請求項1からのうちいずれか1項に記載の車両制御装置。
  7. 前記第1認識部が認識した周辺の状況は、前記車両の前方に存在する合流領域の始点である導流帯の端部と、前記車両が合流する本線の道路区画線とを含み、
    前記第2認識部は、前記合流領域の始点である導流帯の端部、前記車両が合流する本線の道路区画線、前記取得部が取得した自己位置、および前記地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識する、
    請求項1からのうちいずれか1項に記載の車両制御装置。
  8. 車両が存在する第1の自己位置を取得する取得部と、
    前記車両の周辺の状況を検知する検知デバイスにより提供された情報に基づいて、前記車両の前方に存在する合流領域の始点である第1導流帯の端部と、前記車両が合流する本線の道路区画線とを含む前記車両の周辺の状況を認識する第1認識部と、
    前記第1認識部が認識した前記合流領域の始点である第1導流帯の端部および前記車両が合流する本線の道路区画線を含む周辺の状況、前記取得部が取得した第1の自己位置、および記憶装置に記憶された地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識する第2認識部と、
    前記第2認識部が認識した前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定する決定部と、
    前記決定部により決定された制御態様に基づいて、前記車両を制御して自動運転を行う制御部と、を備え、
    前記車両が走行する第1車線から、前記車両が進行予定の本線である第2車線に、前記車両が進行する予定である場合に、前記第1車線から前記第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標である第2導流帯の端部を、前記第1認識部が認識できない場合、
    前記決定部は、前記第2の自己位置および前記車両の向きに基づいて、前記目標を探索するための操舵角の制御態様を決定し、その後、
    前記第1認識部が、前記合流領域の終点を認識できた場合、前記合流領域の始点と終点に基づいて、前記合流領域を認識し、
    前記決定部は、前記合流領域、前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵角の制御態様および速度の制御態様を決定し、
    前記制御部は、前記決定部により決定された制御態様に基づいて自動運転を行って、前記合流領域において本線に前記車両を進入させる制御を行う、
    車両制御装置。
  9. コンピュータが、
    車両が存在する第1の自己位置を取得し、
    前記車両の周辺の状況を検知する検知デバイスにより提供された情報に基づいて前記車両の周辺の状況を認識し、
    前記認識した周辺の状況、前記取得した第1の自己位置、および記憶装置に記憶された地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識し、
    前記認識した前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定し、
    前記決定された制御態様に基づいて、前記車両を制御して自動運転を行い、
    前記車両が走行する第1車線から、前記車両が進行予定の本線である第2車線に、前記車両が進行する予定である場合に、前記第1車線から前記第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、前記認識できない場合、
    少なくとも前記第2の自己位置、前記車両の向き、および地図情報に基づいて、前記目標を探索するための操舵角の制御態様であって前記目標が存在すると推定される第1方向に前記車両の基準方向を向ける制御態様を決定する、
    車両制御方法。
  10. コンピュータに、
    車両が存在する第1の自己位置を取得させ、
    前記車両の周辺の状況を検知する検知デバイスにより提供された情報に基づいて前記車両の周辺の状況を認識させ、
    前記認識した周辺の状況、前記取得した第1の自己位置、および記憶装置に記憶された地図情報に基づいて、前記第1の自己位置を修正した第2の自己位置および前記車両が走行する道路における前記車両の向きを認識させ、
    前記認識した前記第2の自己位置および前記車両の向きに基づいて、前記車両の操舵の制御態様および速度の制御態様を決定させ、
    前記決定された制御態様に基づいて、前記車両を制御して自動運転を行わせ、
    前記車両が走行する第1車線から、前記車両が進行予定の本線である第2車線に、前記車両が進行する予定である場合に、前記第1車線から前記第2車線への合流が許容される合流区間の終点を示す道路に関連付けられた目標を、前記認識できない場合、
    少なくとも前記第2の自己位置、前記車両の向き、および地図情報に基づいて、前記目標を探索するための操舵角の制御態様であって前記目標が存在すると推定される第1方向に前記車両の基準方向を向ける制御態様を決定させる、
    プログラム。
JP2020045677A 2020-03-16 2020-03-16 車両制御装置、車両制御方法、およびプログラム Active JP7141421B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2020045677A JP7141421B2 (ja) 2020-03-16 2020-03-16 車両制御装置、車両制御方法、およびプログラム
US17/197,096 US11702078B2 (en) 2020-03-16 2021-03-10 Vehicle control device, vehicle control method, and storage medium
CN202110262630.6A CN113479204A (zh) 2020-03-16 2021-03-10 车辆控制装置、车辆控制方法及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020045677A JP7141421B2 (ja) 2020-03-16 2020-03-16 車両制御装置、車両制御方法、およびプログラム

Publications (2)

Publication Number Publication Date
JP2021149201A JP2021149201A (ja) 2021-09-27
JP7141421B2 true JP7141421B2 (ja) 2022-09-22

Family

ID=77664262

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020045677A Active JP7141421B2 (ja) 2020-03-16 2020-03-16 車両制御装置、車両制御方法、およびプログラム

Country Status (3)

Country Link
US (1) US11702078B2 (ja)
JP (1) JP7141421B2 (ja)
CN (1) CN113479204A (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20230021457A (ko) * 2021-08-05 2023-02-14 현대모비스 주식회사 차량의 장애물 감지 시스템 및 방법

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007323178A (ja) 2006-05-30 2007-12-13 Nissan Motor Co Ltd 合流支援装置及び合流支援方法
JP2012133446A (ja) 2010-12-20 2012-07-12 Nissan Motor Co Ltd 車両運転支援装置
JP2018189463A (ja) 2017-05-01 2018-11-29 株式会社Soken 車両位置推定装置及びプログラム
JP2019036050A (ja) 2017-08-10 2019-03-07 本田技研工業株式会社 走行制御装置、走行制御方法、および車両

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4622928B2 (ja) 2006-04-14 2011-02-02 トヨタ自動車株式会社 車載カメラ制御装置および車載カメラ制御方法。
JP6197691B2 (ja) * 2014-02-26 2017-09-20 アイシン・エィ・ダブリュ株式会社 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
DE112018001586T5 (de) * 2017-04-27 2020-01-02 Hitachi Automotive Systems, Ltd. Fahrzeugsteuervorrichtung
KR102138094B1 (ko) * 2017-07-27 2020-07-27 닛산 지도우샤 가부시키가이샤 운전 지원 차량의 자기 위치 보정 방법 및 자기 위치 보정 장치
WO2020008227A1 (ja) * 2018-07-04 2020-01-09 日産自動車株式会社 運転支援方法及び運転支援装置
CN110361015B (zh) * 2018-09-30 2021-04-02 长城汽车股份有限公司 道路特征点提取方法及系统
JP7304535B2 (ja) * 2019-02-14 2023-07-07 パナソニックIpマネジメント株式会社 車両制御装置、車両制御方法及びプログラム
JP7047824B2 (ja) * 2019-09-12 2022-04-05 トヨタ自動車株式会社 車両制御装置
CN110570049B (zh) * 2019-09-19 2022-04-29 西南交通大学 一种高速公路混合交通流汇流协同优化底层控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007323178A (ja) 2006-05-30 2007-12-13 Nissan Motor Co Ltd 合流支援装置及び合流支援方法
JP2012133446A (ja) 2010-12-20 2012-07-12 Nissan Motor Co Ltd 車両運転支援装置
JP2018189463A (ja) 2017-05-01 2018-11-29 株式会社Soken 車両位置推定装置及びプログラム
JP2019036050A (ja) 2017-08-10 2019-03-07 本田技研工業株式会社 走行制御装置、走行制御方法、および車両

Also Published As

Publication number Publication date
US11702078B2 (en) 2023-07-18
JP2021149201A (ja) 2021-09-27
US20210284165A1 (en) 2021-09-16
CN113479204A (zh) 2021-10-08

Similar Documents

Publication Publication Date Title
JP6782370B2 (ja) 車両制御装置、車両制御方法、及びプログラム
JP6641583B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP2019048570A (ja) 車両制御装置、車両制御方法、およびプログラム
JP7043295B2 (ja) 車両制御装置、車両制御方法、およびプログラム
US20190278285A1 (en) Vehicle control device, vehicle control method, and storage medium
US10854083B2 (en) Vehicle control device, vehicle control method, and storage medium
JP7406432B2 (ja) 移動体制御装置、移動体制御方法、およびプログラム
JP7141421B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7376634B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP6583697B2 (ja) 周辺監視装置、制御装置、周辺監視方法、およびプログラム
US20220297696A1 (en) Moving object control device, moving object control method, and storage medium
JP2023030147A (ja) 車両制御装置、車両制御方法、およびプログラム
JP7308880B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7191065B2 (ja) 処理装置、処理方法、およびプログラム
CN114954511A (zh) 车辆控制装置、车辆控制方法以及存储介质
JP2022142863A (ja) 移動体制御装置、移動体制御方法、およびプログラム
US11495029B2 (en) Estimation device, estimation method, and storage medium
JP7429556B2 (ja) 車両制御装置、車両制御方法、およびプログラム
US11801838B2 (en) Vehicle control device, vehicle control method, and storage medium
JP7225185B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7250833B2 (ja) 物体認識装置、物体認識方法、およびプログラム
JP7431081B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7345515B2 (ja) 車両制御装置、車両制御方法、およびプログラム
US20230294702A1 (en) Control device, control method, and storage medium
JP2023112396A (ja) 移動体制御装置、移動体制御方法、およびプログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201127

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220201

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220401

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220909

R150 Certificate of patent or registration of utility model

Ref document number: 7141421

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150