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

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

Info

Publication number
JP7225185B2
JP7225185B2 JP2020196085A JP2020196085A JP7225185B2 JP 7225185 B2 JP7225185 B2 JP 7225185B2 JP 2020196085 A JP2020196085 A JP 2020196085A JP 2020196085 A JP2020196085 A JP 2020196085A JP 7225185 B2 JP7225185 B2 JP 7225185B2
Authority
JP
Japan
Prior art keywords
road
vehicle
road marking
line
division line
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
JP2020196085A
Other languages
English (en)
Other versions
JP2022084303A (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 JP2020196085A priority Critical patent/JP7225185B2/ja
Priority to CN202111194516.0A priority patent/CN114537386A/zh
Priority to US17/503,352 priority patent/US20220161794A1/en
Publication of JP2022084303A publication Critical patent/JP2022084303A/ja
Application granted granted Critical
Publication of JP7225185B2 publication Critical patent/JP7225185B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • 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/10Path keeping
    • B60W30/12Lane keeping
    • 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
    • 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/005Handover processes
    • B60W60/0059Estimation of the risk associated with autonomous or manual driving, e.g. situation too complex, sensor failure or driver incapacity
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching
    • 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo or light sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • B60W2420/408
    • 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
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/801Lateral distance
    • 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/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle for navigation systems

Description

本発明は、車両制御装置、車両制御方法、およびプログラムに関する。
従来、車両の周辺の外部環境を認識し、認識した結果に基づいて車線逸脱警報を行う車載用走行環境認識装置が開示されている(例えば、特許文献1参照)。この車載用走行環境認識装置は、撮像画像から片側のレーンマーカしか検出できない場合、片側のレーンマーカと地図データベースに保存されたレーン幅とから車線逸脱警報を行う。
特開2008-197863号公報
しかしながら、上記の技術では、種々の環境や周辺の認識結果に応じて適切に車両を制御することができない場合があった。
本発明は、このような事情を考慮してなされたものであり、より適切に車両を制御することができる車両制御装置、車両制御方法、およびプログラムを提供することを目的の一つとする。
この発明に係る車両制御装置、車両制御方法、およびプログラムは、以下の構成を採用した。
(1):車両制御装置は、車両の周辺を撮像する撮像部により撮像された画像から前記車両が走行する車線の第1側の第1道路区画線を認識する認識部と、地図情報から前記車両が走行する車線の前記第1側の第2道路区画線の情報を取得する取得部と、前記車両が道路区画線から逸脱する可能性が所定度合以上である場合に、前記車両が道路区画線から逸脱しないように支援する支援処理を実行する支援部であって、前記認識部が認識した前記第1側の前記第1道路区画線の第1位置と、前記取得部が取得した前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下である場合、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制する、支援部とを備える。
(2): 車両制御装置は、上記(1)の態様において、前記認識部は、更に、前記車線の前記第1側とは反対の第2側の第3道路区画線を認識し、前記取得部は、更に、地図情報から前記第2側の第4道路区画線の情報を取得し、前記支援部は、前記第1側の前記第1道路区画線の第1位置と、前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下であり、且つ前記第2側の前記第3道路区画線の第3位置と、前記第2側の前記第4道路区画線の第4位置との合致度合が第2閾値以上である場合において、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理を実行せず、且つ、前記第2側の前記第3道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第3道路区画線に基づいて前記車両が前記第3道路区画線から逸脱しないように支援する支援処理を実行する。
(3):上記(1)または(2)の態様において、前記支援部は、前記取得部が前記車線の道路区画線の情報を取得することができない場合、前記認識部が認識した前記道路区画線に基づいて、前記車両が前記道路区画線から逸脱しないように支援する。
(4):上記(1)から(3)のいずれかの態様において、前記認識部は、更に、前記車線の前記第1側とは反対の第2側の第3道路区画線を認識し、前記取得部は、更に、地図情報から前記第2側の第4道路区画線の情報を取得し、前記支援部は、前記第1側の前記第1道路区画線の第1位置と、前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下であり、且つ前記第2側の前記第3道路区画線の第3位置と、前記第2側の前記第4道路区画線の第4位置との合致度合が第2閾値以下である場合において、前記第1側の前記第1道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第1道路区画線に基づいて前記車両が前記第1道路区画線から逸脱しないように支援する支援処理を実行し、前記第2側の前記第3道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第3道路区画線に基づいて前記車両が前記第3道路区画線から逸脱しないように支援する支援処理を実行する。
(5):上記(1)から(5)のいずれかの態様において、前記認識部は、前記第1側の第1道路区画線または前記車線の前記第1側とは反対の第2側の第3道路区画線の一方または双方を認識し、前記取得部は、地図情報から前記第1側の第2道路区画線の情報または前記第2側の第4道路区画線の情報の一方または双方を取得し、前記支援部は、前記認識部が前記第1道路区画線および前記第3道路区画線を認識した場合、前記認識部の認識結果に加え、前記第2道路区画線の第2位置または前記第4道路区画線の第4位置を用いて、前記車両が前記道路区画線から逸脱しないように支援する支援処理を実行し、前記認識部が前記第1道路区画線または前記第3道路区画線を認識していない場合、前記第2道路区画線の第2位置または前記第4道路区画線の第4位置を用いず、前記認識部の認識結果を用いて、前記車両が前記道路区画線から逸脱しないように支援する支援処理を実行する。
(6):上記(1)から(5)のいずれかの態様において、前記支援部は、前記第1位置の方位角と前記第2位置の方位角との差分、前記第1道路区画線と前記第2道路区画線とが形成するなす角、前記第1道路区画線と前記第2道路区画線との横方向の距離に基づいて、前記第1道路区画線の第1位置と、前記第2道路区画線の第2位置との合致度合を判定する。
(7):この発明の一態様に係る車両制御方法は、コンピュータが、車両の周辺を撮像する撮像部により撮像された画像から前記車両が走行する車線の第1側の第1道路区画線を認識し、地図情報から前記車両が走行する車線の前記第1側の第2道路区画線の情報を取得し、前記車両が道路区画線から逸脱する可能性が所定度合以上である場合に、前記車両が道路区画線から逸脱しないように支援する支援処理を実行し、前記認識した前記第1側の前記第1道路区画線の第1位置と、前記取得した前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下である場合、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制するものである。
(8):この発明の一態様に係るプログラムは、コンピュータに、車両の周辺を撮像する撮像部により撮像された画像から前記車両が走行する車線の第1側の第1道路区画線を認識する処理と、地図情報から前記車両が走行する車線の前記第1側の第2道路区画線の情報を取得する処理と、前記車両が道路区画線から逸脱する可能性が所定度合以上である場合に、前記車両が道路区画線から逸脱しないように支援する支援処理を実行する処理と、前記認識した前記第1側の前記第1道路区画線の第1位置と、前記取得した前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下である場合、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制する処理と、を実行させるものである。
(1)、(2)、(5)、(7)、(8)によれば、車両制御装置は、車両が第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制することにより、より適切に車両を制御することができる。
(3)によれば、車両制御装置が、道路区画線の情報を取得することができない場合であっても、支援処理を実行することができるため、乗員にとっての利便性が向上する。
(4)によれば、車両制御装置は、第1側の第1道路区画線の第1位置と、第1側の第2道路区画線の第2位置との合致度合が第1閾値以下であり、且つ第2側の第3道路区画線の第3位置と、第2側の第4道路区画線の第4位置との合致度合が第2閾値以下である場合においても、支援処理を実行することができるため、乗員にとっての利便性が向上する。
(6)によれば、車両制御装置は、第1道路区画線の第1位置と、第2道路区画線の第2位置との合致度合を、より精度よく判定することができる。
実施形態に係る車両制御装置を利用した車両システム1の構成図である。 第1制御部120および第2制御部160の機能構成図である。 逸脱抑制支援部148が車両Mを制御する場面の一例を示す図である。 車線変更抑制支援部150が車両Mを制御する場面の一例を示す図である。 支援の作動可否の条件について説明するための図(その1)である。 支援の作動可否の条件について説明するための図(その2)である。 支援の作動可否の条件について説明するための図(その3)である。 合致度合の判定に用いる(A)に関する処理の内容の一例を示す図である。 合致度合の判定に用いる(B)に関する処理の内容の一例を示す図である。 合致度合の判定に用いる(C)に関する処理の内容の一例を示す図である。 道路区画線(認識)の位置と道路区画線(地図)の位置との合致条件および不合致条件の一例を示す図である。 支援部146が実行する処理の流れの一例を示すフローチャートである。 支援部146が実行する作動判断に関する処理の流れの一例を示すフローチャートである。 支援部146が実行する作動判断に関する処理の流れの一例を示すフローチャートである。 第1実施形態での変形例の処理の流れの一例を示すフローチャートである。 実施形態の自動運転制御装置100(支援装置100A)のハードウェア構成の一例を示す図である。
以下、図面を参照し、本発明の車両制御装置、車両制御方法、およびプログラムの実施形態について説明する。
<第1実施形態>
[全体構成]
図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は、例えば、道路区画線情報63が含まれる。道路区画線情報63は、例えば、車線の中央の情報あるいは車線の境界の情報等を含んでいる。車線の境界の情報は、車線を形成する道路区画線の位置座標や、道路区画線間の幅等である。また、第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は、例えば、認識部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と、支援部146とを備える。
自己位置認識部142は、ナビゲーション装置50により特定される車両Mの位置、カメラ10により撮像された画像、車両センサ40に含まれる方位センサの出力などを第2地図情報62と照合し、車両Mが地図におけるどの道路、どの車線を走行しているかを認識する。更に、自己位置認識部142は、上記した各種情報に基づいて、車線や道路の幅方向に関して、自車両Mの代表点がどの位置にあるのか(以下、横位置)を認識する。横位置は、車線の左右のいずれかの道路区画線からのオフセット量として導出されてもよいし、車線中央からのオフセット量として導出されてもよい。自己位置認識部142は、上記した各種情報に基づいて、車線の延在方向に対して、その時点の自車両Mの進行方向が何度傾いているか(以下、ヨー角)を認識する。
自己位置認識部142は、ナビゲーション装置50により特定される車両Mの位置、カメラ10により撮像された画像、車両センサ40に含まれる方位センサの出力などを第2地図情報62と照合した結果、十分な信頼度で整合しない場合には、マッチング失敗を示す情報を行動計画生成部140に出力する。「マッチング失敗」には、ナビゲーション装置50により特定される車両Mの位置に相当する地図が無い場合や、道路に含まれる全部または所定の道路区画線が検出されなかった場合も含まれてもよい。上記のように、地図において車両Mが存在する位置が認識される。以下、自己位置認識部142が、ナビゲーション装置50により特定される車両Mの位置、カメラ10により撮像された画像、車両センサ40に含まれる方位センサの出力などを第2地図情報62と照合する処理を「マッチング処理」と称する場合がある。
取得部144は、地図情報(例えば道路区画線情報63)から車両Mが走行する車線の道路区画線の情報を取得する。取得部144は、道路区画線情報63から、自己位置認識部142により認識された車両Mの位置および位置周辺の道路区画線の情報を取得する。道路区画線の情報とは、道路区画線の位置や種別(実線、破線)などの情報を含む。
[支援部]
支援部146は、車両が道路区画線から逸脱する可能性が所定度合以上である場合に、車両が道路区画線から逸脱しないように支援する。以下、この処理を「支援処理」と称する場合がある。車両Mが車線から逸脱する可能性が所定度合以上であるとは、車両Mが車線を逸脱する傾向に移動して、且つ車両Mの基準位置(例えばタイヤ)と車線との関係が所定の関係(例えば基準位置と車線とが近接した関係)であることである。支援とは、警報の出力または車両Mの操舵を自動で制御することである。警報とは、運転者に車両Mが車線から逸脱する可能性が高いことを示す音声や画像、振動等、または車線から逸脱しないように車両Mを制御することを促す音声や画像、振動等である。車両Mの操舵を自動で制御するとは、車両Mが車線から逸脱しないように、または車両Mが車線の中央側に近づくように操舵を自動で制御することである。
支援部146は、例えば、逸脱抑制支援部148と、車線変更抑制支援部150とを備える。逸脱抑制支援部148は、車両Mが車線から逸脱する可能性が所定度合以上である場合(以下、第1条件を満たす場合)、車両Mが車線から逸脱するのを抑制する。
図3は、逸脱抑制支援部148が車両Mを制御する場面の一例を示す図である。逸脱抑制支援部148は、第1条件を満たす場合、HMI30に警報を出力させる。また、逸脱抑制支援部148は、第1条件を満たす、車両Mが車線の中央方向に移動するように操舵を制御する。例えば、逸脱抑制支援部148は、警報を出力した後、第1条件が満たされる状態が解消されていない場合、車両Mが車線の中央方向に移動するように操舵を制御する。逸脱抑制支援部148が実行する制御を、「RDM(Road Departure Mitigation)」と称する場合がある。
車線変更抑制支援部150は、車両Mが隣接車線に進入する可能性が所定度合以上であり(例えば、隣接車線に車線変更しようとし)、且つ隣接車線において車両Mの後方および車両Mから所定距離の位置に他車両が存在する場合(以下、第2条件を満たす場合)、車両Mが車線から逸脱するのを抑制する。車両Mが隣接車線に進入する可能性が所定度合以上とは、車両Mが隣接車線に進入する傾向に移動して、且つ車両Mの基準位置(例えばタイヤ)と車線との関係が所定の関係(例えば基準位置と車線とが近接した関係)であることである。
図4は、車線変更抑制支援部150が車両Mを制御する場面の一例を示す図である。車線変更抑制支援部150は、第2条件を満たす場合、HMI30に警報を出力させる。また、逸脱抑制支援部148は、第2条件を満たす場合、車両Mが車線の中央方向に移動するように操舵を制御する。例えば、逸脱抑制支援部148は、警報を出力した後、第2条件が満たされる状態が解消されていない場合、車両Mが車線の中央方向に移動するように操舵を制御する。車線変更抑制支援部150が実行する制御を、「LCCM(Lane Change Collision Mitigation)」と称する場合がある。
第2制御部160は、行動計画生成部140によって生成された目標軌道を、予定の時刻通りに車両Mが通過するように、走行駆動力出力装置200、ブレーキ装置210、およびステアリング装置220を制御する。
第2制御部160は、例えば、取得部162と、速度制御部164と、操舵制御部166とを備える。取得部162は、行動計画生成部140により生成された目標軌道(軌道点)の情報を取得し、メモリ(不図示)に記憶させる。速度制御部164は、メモリに記憶された目標軌道に付随する速度要素に基づいて、走行駆動力出力装置200またはブレーキ装置210を制御する。操舵制御部166は、メモリに記憶された目標軌道の曲がり具合に応じて、ステアリング装置220を制御する。速度制御部164および操舵制御部166の処理は、例えば、フィードフォワード制御とフィードバック制御との組み合わせにより実現される。一例として、操舵制御部166は、車両Mの前方の道路の曲率に応じたフィードフォワード制御と、目標軌道からの乖離に基づくフィードバック制御とを組み合わせて実行する。
図1に戻り、走行駆動力出力装置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から入力される情報に従って、電動モータを駆動し、転舵輪の向きを変更させる。
[支援部が実行する処理の詳細について]
支援部146は、認識部130が認識した道路区画線の第1位置と、取得部144が取得した道路区画線の第2位置との合致度合が第1閾値以下である場合、車両Mが車線から逸脱しないようにする支援を抑制する。「抑制」とは、上記の支援を行わないことや、支援の度合(制御度合)を小さくすること、支援のタイミングを通常よりも遅らせることである。「抑制」とは、警報の出力を行わないことや、警報の出力度合を小さすること、警報の出力のタイミングを通常よりも遅らせることであってもよい。以下の説明では、一例として、抑制は、支援を行わないこととして説明する。
第1実施形態では、自動運転車両において、運転者がステアリングホイールを操作して車両Mが走行している場合、運転者がステアリングホイールを操作していないが把持して車両Mが走行している場合に、後述する処理が実行される。また、運転者がステアリングホイールを把持してなく車両Mが操舵を制御している状態で、運転者が車両Mの周辺を監視し、運転者が迅速に車両Mを運転することが可能な場合に、後述する処理が実行されてもよい。また、以下の説明では、マッチング処理のマッチングは成立しているものとして説明する。
図5-図7を参照して、支援の作動可否について説明する。図5は、支援の作動可否の条件について説明するための図である。図6および図7は、認識された道路区画線の位置と道路区画線情報の道路区画線の位置との合致度合と、情報の利用態様とを示す図である。合致度合については、後述する図8-10を参照して説明する。
(1)-(4)では、左側の道路区画線および右側の道路区画線が認識部130により認識されているものとする。以下、認識部130により認識された道路区画線については、道路区画線の後に「(認識)」を付し、道路区画線情報63から得られた道路区画線については、道路区画線の後に「(地図)」を付す。
(1)左側の道路区画線(認識)の位置と左側の道路区画線(地図)の位置との合致度合が閾値以上であり、右側の道路区画線(認識)の位置と右側の道路区画線(地図)の位置との合致度合が閾値以上である場合、支援部146は、車両Mが左側の道路区画線から逸脱しないように支援(以下、「左側支援」と称し)し、車両Mが右側の道路区画線から逸脱しないように支援(以下、「右側支援」と称する)する。左右の道路区画線(認識)の信頼性が高いと推定されるため、左側支援および右側支援が実行される。
(2)左側の道路区画線(認識)の位置と左側の道路区画線(地図)の位置との合致度合が閾値以上であり、右側の道路区画線(認識)の位置と右側の道路区画線(地図)の位置との合致度合が閾値未満である場合、支援部146は、左側支援を実行し、右側支援を実行しない。左側の道路区画線(認識)の位置と左側の道路区画線(地図)の位置とが合致しているため、左側の道路区画線情報(認識)の信頼性は高く、右側の道路区画線(認識)の信頼性が低いと推定されるため、信頼性が担保された側の左側支援が実行される。
(3)左側の道路区画線(認識)の位置と左側の道路区画線(地図)の位置との合致度合が閾値未満であり、右側の道路区画線(認識)の位置と右側の道路区画線(地図)の位置との合致度合が閾値以上である場合、支援部146は、左側支援を実行せず、右側支援を実行する。右側の道路区画線(認識)の位置と右側の道路区画線(地図)の位置とが合致しているため、右側の道路区画線(認識)の信頼性は高く、左側の道路区画線(認識)の信頼性が低いと推定されるため、信頼性が担保された側の右側支援が実行される。
上記の(2)または(3)の処理は、「第1位置と、第2位置との合致度合が第1閾値以下である場合、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制する」処理の一例である。また、上記の(2)または(3)の処理は、「第1位置と、第2位置との合致度合が第1閾値以下であり、且つ第3位置と、第4位置との合致度合が第2閾値以上である場合において、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理を実行せず、且つ、前記第2側の前記第3道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第3道路区画線に基づいて前記車両が前記第3道路区画線から逸脱しないように支援する支援処理を実行する」処理の一例である。
(4)左側の道路区画線(認識)の位置と左側の道路区画線(地図)の位置との合致度合が閾値未満であり、右側の道路区画線(認識)の位置と右側の道路区画線(地図)の位置との合致度合が閾値未満である場合であっても、支援部146は、左側支援および右側支援を実行する。左右の道路区画線(認識)の位置と左右の道路区画線(地図)の位置とが合致していない場合、道路区画線情報(地図)の信頼性は低いと推定される。例えば、道路区画線が引き直され、引き直された道路区画線の位置等の情報が道路区画線情報63に反映されてないと推定される。この場合、左右の道路区画線(認識)の信頼性は高いと推定されるため、信頼性が担保された道路区画線(認識)が参照されて、左側支援および右側支援が実行される。
上記の(4)の処理は、「第1位置と、第2位置との合致度合が第1閾値以下であり、且つ第3位置と、第4位置との合致度合が第2閾値以下である場合において、前記第1道路区画線に基づいて前記車両が前記第1道路区画線から逸脱しないように支援する支援処理を実行し、前記第3道路区画線に基づいて前記車両が前記第3道路区画線から逸脱しないように支援する支援処理を実行する」処理の一例である。
このように、認識部130が左右の道路区画線を認識した場合、支援部146は、一方の道路区画線の合致度合が閾値未満であると判定した場合は、閾値未満であると判定した側の支援を実行せず、両方の道路区画線の合致度合が閾値未満であると判定した場合、道路区間線(認識)を参照して左側支援および右側支援を実行する。
(5)-(7)では、道路区画線(地図)の有無や合致度合は考慮されない。
(5)右側の道路区画線が認識部130により認識されず、左側の道路区画線は認識部130により認識されている場合、支援部146は、認識部130が認識していない右側の道路区画線に対する右側支援を実行しない。支援部146は、左側の道路区画線(認識)に基づいて左側支援を実行する(図7の(5A)、(5B))。
(6)左側の道路区画線が認識部130により認識されず、右側の道路区画線は認識部130により認識された場合、支援部146は、認識部130が認識していない左側の道路区画線に対する左側支援を実行しない。支援部146は、右側の道路区画線(認識)に基づいて右側支援を実行する(図7の(6A)、(6B))。
(7)左側の道路区画線および右側の道路区画線が認識部130により認識されていない場合、支援部146は、右側支援および左側支援を実行しない。
このように、支援部146は、認識部130が少なくとも一方の道路区画線を認識していない場合、認識していない側に対する支援を実行しない。
支援部146は、上記の(1)-(4)のように両側の道路区画線が認識部130により認識された場合、認識部130の認識結果に加え、地図情報から取得された道路区画線の位置を用いて、車両Mが道路区画線から逸脱しないように支援する支援処理を実行し、上記の(5)-(7)のように両側の道路区画線が認識部130により認識されていない場合、地図情報から取得された道路区画線の情報を用いず、認識部130の認識結果を用いて、車両Mが道路区画線から逸脱しないように支援する支援処理を実行することにより、認識部130の認識結果に応じた適切な制御を実現することができる。
[認識された道路区画線と道路区画線情報の道路区画線の合致度合の判定]
支援部146は、例えば、道路区画線(認識)の位置の方位角と道路区画線(地図)の位置の方位角との差分、道路区画線(認識)と道路区画線(地図)とが形成するなす角、道路区画線(認識)と道路区画線(地図)との横方向の距離に基づいて、道路区画線(認識)の位置と、道路区画線(地図)の位置との合致度合を判定する。支援部146は、図8-11に示す(A)-(C)のうち1以上の処理の結果を用いて合致度を判定する。
(A)について
図8は、(A)に関する処理の内容の一例を示す図である。支援部146は、方位角差分を算出する。支援部146は、車両Mを基準に道路区画線(認識)および道路区画線(地図)において順番にサンプリング点(サンプリング点1、2、3・・・)を設定し、サンプリング点のうち道路区画線(認識)および道路区画線(地図)において対応するサンプリング点を抽出する。対応するサンプリング点とは、順番が同じサンプリング点(例えば(m[i]、θ)、(c[i]、θ))である。
支援部146は、対応するサンプリング点ごとの方位角の差分を算出する。方位角の基準は、例えば、車両Mの進行方向(図中、X方向)である。例えば、支援部146は、車両Mの進行方向と、対象のサンプリング点と対象のサンプリング点の一つ前のサンプリング点とを繋げた線分との差分を方位角の差分とする。差分は、車両Mから所定距離の位置まで算出される。
支援部146は、式(1)に示すように、対応するサンプリング点ごとの方位角の差分の合計(Σw[i]△θ[i])を対応するサンプリング点の数(Σw[i])で除算して平均差分(△θave)を算出する。対応するサンプリング点ごとの方位角の差分には、サンプリング点の位置に基づいて重みが付与されてもよい。例えば、車両Mから近いサンプリング点の方位角の差分に対しては、車両Mから遠いサンプリング点の方位角の差分よりも重い重みが付与されてもよい。
Figure 0007225185000001
(B)について
図9は、(B)に関する処理の内容の一例を示す図である。支援部146は、前方注視角度の差分を算出する。支援部146は、前方注視位置を設定し、第1線分と第2線分とがなす角である前方注視角度の差分を算出する。第1線分は、設定した前方注視位置における道路区画線(認識)の第1所定位置と、車両Mの現在(または前方注視位置より手前側)の第2所定位置の道路区画線(認識)とを繋げた線分である。第2線分は、設定した前方注視位置における道路区画線(地図)の第3所定位置と、車両Mの現在(または前方注視位置より手前側)の第4所定位置の道路区画線(地図)とを繋げた線分である。第2所定位置と第4所定位置とは、例えば、同じ位置である。
(C)について
図10は、(C)に関する処理の内容の一例を示す図である。支援部146は、横位置差分(例えば(m[i]、y)、(c[i]、y))との差分)を算出する。支援部146は、上記の(A)と同様にサンプリング点を設定し対応するサンプリング点を抽出し、対応するサンプリング点ごとの横方向の差分を算出してもよい。差分を求める対象の位置は、上記の(A)と同様の所定距離の位置であってもよいし、異なる位置であってもよい。
支援部146は、式(2)に示すように、横位置の差分の合計(Σw[i]△y[i])を、差分を求めた横位置の数(Σw[i])で除算して平均差分(△yave)を算出する。横位置の差分には、重みが付与されてもよい。例えば、車両Mから近い横位置の差分に対しては、車両Mから遠い横位置の差分よりも重い重みが付与されてもよい。
Figure 0007225185000002
支援部146は、上記の方位角の差分、前方注視角度の差分、または横位置の差分を用いて、道路区画線(認識)と道路区画線(地図)とが合致しているか否かを判定する。例えば、支援部146は、方位角の差分、視野角の差分、または横位置の差分のそれぞれと、それぞれに対応する閾値とを比較し、比較結果に基づいて、道路区画線(認識)と道路区画線(地図)とが合致しているか否かを判定する。
図11は、道路区画線(認識)の位置と道路区画線(地図)の位置との合致条件および不合致条件の一例を示す図である。前回、道路区画線(認識)の位置と道路区画線(地図)の位置とが不合致(閾値未満)であると判定された後に、今回、道路区画線(認識)の位置と道路区画線(地図)の位置とが合致する(閾値以上である)と判定されるための条件は、以下の条件a-条件cの全部または一部を満たすことである。
条件aは、方位角の差分(方位角差分の重み付き平均)が閾値角度θ1以下であることである。条件bは、前方注視角度の差分(前方注視角差分)が閾値角度θ2以下であることである。条件cは、横位置の差分(横位置差分の重み付き平均)が閾値距離d1以下であることである。閾値距離d1は、実験的に求められた道路区画線(認識)と道路区画線(地図)との誤差の分布の2σ(標準偏差)に相当する距離である。
前回、道路区画線(認識)の位置と道路区画線(地図)の位置とが合致すると判定された後に、今回、道路区画線(認識)の位置と道路区画線(地図)の位置とが不合致であると判定されるための条件は、以下の条件d-条件fの全部または一部を満たすことである。
条件dは、方位角の差分(方位角差分の重み付き平均)が閾値角度θ3を超えることである。条件eは、前方注視角度の差分(前方注視角差分)が閾値角度θ4を超えることである。条件fは、横位置の差分(横位置差分の重み付き平均)が閾値距離d2を超えることである。
例えば、閾値角度θ1と閾値角度θ2とは同じ角度であってもよいし、異なる角度であってもよい。例えば、閾値角度θ3と閾値角度θ4とは同じ角度であってもよいし、異なる角度であってもよい。閾値角度θ1と閾値角度θ2は、例えば、閾値角度θ3または閾値角度θ4以下の角度である。閾値距離d1は、例えば、閾値距離d2以下または未満の距離である。
なお、支援部146は、方位角の差分、前方注視角度の差分、または横位置の差分のうち、一または二の差分のそれぞれと、それぞれに対応する閾値とを比較し、比較結果に基づいて、道路区画線(認識)と道路区画線(地図)とが合致しているか否かを判定してもよい。
上記のように、支援部146は、上述した差分を用いることにより、より精度よく道路区画線(認識)と道路区画線(地図)とが合致するか否かを判定するができる。
[フローチャート(その1)]
図12は、支援部146が実行する処理の流れの一例を示すフローチャートである。まず、自動運転制御装置100が、支援モードがオン状態であるか否かを判定する(ステップS100)。支援モードがオン状態とは、支援部146が支援を実行し得る状態であることである。
支援モードがオン状態である場合、支援部146は、認識部130により認識された道路区画線の情報を取得する(ステップS102)。次に、支援部146は、ステップS102で取得した道路区画線の情報に基づいて、認識部130が左右の道路区画線を認識していないか否か判定する(ステップS104)。左右の道路区画線が認識されていない場合、支援部146は、支援を実行しない(ステップS106、図5等の(7)に相当)。左右の道路区画線が認識されている場合、または左右の道路区画線のうち一方の道路区画線が認識されている場合、支援部146は、図13で示す支援の作動判断を行う(ステップS108)。これにより本フローチャートの1ルーチンの処理が終了する。
[フローチャート(その2)]
図13は、支援部146が実行する作動判断に関する処理の流れの一例を示すフローチャートである。まず、支援部146が、作動判断の処理の開始条件を満たすか否を判定する(ステップS200)。作動判断の処理の開始条件を満たす場合(図12のS104で左右の道路区画線のうち少なくとも一つの道路区画線が認識されたと判定された場合)、支援部146は、認識部130により左右の道路区画線が認識されたか否かを判定する(ステップS202)。
左右の道路区画線が認識されていない場合、支援部146は、認識された道路区画線を参照対象とする(ステップS204、図5等の(5)、(6)に相当)。例えば、左側の道路区画線が認識された場合、左側の道路区画線が参照対象とされ、右側の道路区画線が認識された場合、右側の道路区画線が参照対象とされる。参照対象とは、支援処理を行う際に参照対象とされることである。参照対象とされた側の道路区画線から車両Mが逸脱する可能性が高い場合は、支援処理が実行される。参照対象とされた道路区画線から車両Mが逸脱しないように、支援部146は車両Mを制御する。
左右の道路区画線が認識された場合、支援部146は、取得部144が道路区画線情報63から車両Mの位置および周辺の左右の道路区画線の情報を取得したか否かを判定する(ステップS206)。左右の道路区画線の情報が取得されていない場合、支援部146は、認識された道路区画線を参照対象とする(ステップS208)。すなわち、支援部146は、取得部144が車線の道路区画線の情報を取得することができない場合(例えば、地図情報に道路区画線の情報が記憶されていない場合)、認識部130が認識した道路区画線に基づいて、車両Mが道路区画線から逸脱しないように支援する。
左右の道路区画線情報が取得された場合、支援部146は、認識された道路区画線の位置と、道路区画線情報63から得られた道路区画線の位置とのマッチングを行う(ステップS210)。支援部146は、認識された左右の道路区画線の位置と、道路区画線情報63から得られた左右の道路区画線の位置との合致度合が閾値以上であるか否か、合致度合が閾値未満であるか否かを判定する(ステップS212)。支援部146は、左側の道路区画線の位置と、道路区画線情報63から得られた左側の道路区画線の位置との第1合致度合、および右側の道路区画線の位置と、道路区画線情報63から得られた右側の道路区画線の位置との第2合致度合を導出し、第1合致度合が閾値以上であるか否か、および第2合致度合が第2閾値以上であるか否かを判定する。
合致度合が閾値以上(第1合致度合および第2合致度合が閾値以上)、または合致度合が閾値未満(第1合致度合および第2合致度合が閾値未満)である場合、支援部146は、認識された道路区画線を参照対象とする(ステップS214、図5等の(1)、(4)に相当)。
合致度合が閾値以上、または合致度合が閾値未満でない場合、支援部146は、合致度合が閾値以上である判定された道路区画線を参照対象とする(ステップS216、図5等の(2)、(3)に相当)。換言すると、認識された左側の道路区画線の位置と、道路区画線情報63の左側の道路区画線の位置との合致度合が閾値以上であり、認識された右側の道路区画線の位置と、道路区画線情報63の右側の道路区画線の位置との合致度合が閾値未満である場合、認識された左側の道路区画線が参照対象とされる。これにより本フローチャートの処理が終了する。
上記のように、自動運転制御装置100は、処理に用いる道路区画線(参照対象)を適切に決定することができる。
[フローチャート(その3)]
図14は、支援部146が実行する作動判断に関する処理の流れの一例を示すフローチャートである。まず、支援部146は、車両Mが参照対象(図13参照)とされた道路区画線から逸脱する可能性が所定度合以上であるか否かを判定する(ステップS300)。逸脱する可能性が所定度合以上である場合、支援部146は、車両Mが参照対象とされた道路区画線から逸脱しないように車両Mを制御(支援処理を実行)する(ステップS302)。これにより、本フローチャートの1ルーチンの処理が終了する。
上記のように、自動運転制御装置100が、参照対象の道路区画線を参照して支援を実行することにより、より適切且つ精度よく車両Mが道路区画線から逸脱することを抑制することができる。
以上説明した第1実施形態によれば、自動運転制御装置100が、認識した第1側の第1道路区画線の第1位置と、第1側の第2道路区画線の第2位置との合致度合が第1閾値以下である場合、車両が第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制することにより、より適切に車両を制御することができる。
<第1実施形態の変形例>
以下、第1実施形態の変形例について説明する。第1実施形態では、第1側および第2側の道路区画線を用いた処理を行ったが、第1実施形態の変形例では、車両Mが逸脱する可能性が高い道路区画線の認識結果を用いた処理を行う。以下、第1実施形態との相違点を中心に説明する。
図15は、第1実施形態での変形例の処理の流れの一例を示すフローチャートである。まず、支援部146は、第1側の道路区画線から車両Mが逸脱する可能性が高いか否かを判定する(ステップS400)。第1側の道路区画線から車両Mが逸脱する可能性が高い場合、支援部146は、第1側の道路区画線が認識部130により認識されたか否かを判定する(ステップS402)。第1側の道路区画線が認識されていない場合、支援部146は、車両Mが第1側から逸脱するのを抑制する支援を行わない(ステップS404)。
第1側の道路区画線が認識された場合、支援部146は、道路区画線情報(地図情報)の第1側の道路区画線の位置と、認識された道路区画線の位置とが合致するか否を判定する(ステップS406)。道路区画線情報の第1側の道路区画線の位置と、認識された道路区画線の位置とが合致しない場合、ステップS404の処理に進む。
道路区画線情報の第1側の道路区画線の位置と、認識された道路区画線の位置とが合致する場合、支援部146は、車両Mが第1側から逸脱するのを抑制する支援を行う(ステップS408)。これにより、本フローチャートの1ルーチンの処理が終了する。
上記の処理において、認識された道路区画線の道路区画線情報が存在しない場合、支援部146は、認識された道路区画線の位置に基づいて、車両Mが第1側から逸脱するのを抑制する支援を行う。
上記の例では、車両Mが第1側の道路区画線から逸脱する可能性が高い場合の処理について説明したが、同様に車両Mが第2側の道路区画線から逸脱する可能性が高い場合、同等の処理が第2側の道路区画線について実行される。
以上説明した第1実施形態の変形例によれば、第1実施形態と同様の効果を奏する。
上述した実施形態では、自動運転制御装置100が、各種処理を実行するものとしたが、乗員の運転を支援する支援装置が上述した実施形態で説明した支援部146が実行する処理を行ってもよい。支援装置は、例えば、運転者がステアリングホイールを操作や把持している場合、操舵を制御して運転者の運転を支援し、認識部130が認識した第1側の第1道路区画線の第1位置と、取得部144が取得した第1側の第2道路区画線の第2位置との合致度合が第1閾値以下である場合、車両Mが第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制する。
[ハードウェア構成]
図16は、実施形態の自動運転制御装置100(支援装置100A)のハードウェア構成の一例を示す図である。図示するように、自動運転制御装置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道路区画線の情報を取得し、
前記車両が道路区画線から逸脱する可能性が所定度合以上である場合に、前記車両が道路区画線から逸脱しないように支援する支援処理を実行し、
前記認識した前記第1側の前記第1道路区画線の第1位置と、前記取得した前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下である場合、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制する、
車両制御装置。
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
1‥車両システム、100‥自動運転制御装置、100A‥支援装置、120‥第1制御部、130‥認識部、140‥行動計画生成部、142‥自己位置認識部、144‥取得部、146‥支援部、148‥逸脱抑制支援部、150‥車線変更抑制支援部、160‥第2制御部

Claims (7)

  1. 車両の周辺を撮像する撮像部により撮像された画像から前記車両が走行する車線の第1側の第1道路区画線を認識する認識部と、
    地図情報から前記車両が走行する車線の前記第1側の第2道路区画線の情報を取得する取得部と、
    前記車両が道路区画線から逸脱する可能性が所定度合以上である場合に、前記車両が道路区画線から逸脱しないように支援する支援処理を実行する支援部であって、
    前記認識部が認識した前記第1側の前記第1道路区画線の第1位置と、前記取得部が取得した前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下である場合、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制する、支援部と、を備え、
    前記認識部は、更に、前記車線の前記第1側とは反対の第2側の第3道路区画線を認識し、
    前記取得部は、更に、地図情報から前記第2側の第4道路区画線の情報を取得し、
    前記支援部は、
    前記第1側の前記第1道路区画線の第1位置と、前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下であり、且つ前記第2側の前記第3道路区画線の第3位置と、前記第2側の前記第4道路区画線の第4位置との合致度合が第2閾値以下である場合において、
    前記第1側の前記第1道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第1道路区画線に基づいて前記車両が前記第1道路区画線から逸脱しないように支援する支援処理を実行し、
    前記第2側の前記第3道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第3道路区画線に基づいて前記車両が前記第3道路区画線から逸脱しないように支援する支援処理を実行する、
    車両制御装置。
  2. 前記支援部は、
    前記第1側の前記第1道路区画線の第1位置と、前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下であり、且つ前記第2側の前記第3道路区画線の第3位置と、前記第2側の前記第4道路区画線の第4位置との合致度合が第2閾値以上である場合において、
    前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理を実行せず、且つ、前記第2側の前記第3道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第3道路区画線に基づいて前記車両が前記第3道路区画線から逸脱しないように支援する支援処理を実行する、
    請求項1に記載の車両制御装置。
  3. 前記支援部は、
    前記取得部が前記車線の道路区画線の情報を取得することができない場合、前記認識部が認識した前記道路区画線に基づいて、前記車両が前記道路区画線から逸脱しないように支援する、
    請求項1または2に記載の車両制御装置。
  4. 前記認識部は、前記第1側の第1道路区画線または前記車線の前記第1側とは反対の第2側の第3道路区画線の一方または双方を認識し、
    前記取得部は、地図情報から前記第1側の第2道路区画線の情報または前記第2側の第4道路区画線の情報の一方または双方を取得し、
    前記支援部は、
    前記認識部が前記第1道路区画線および前記第3道路区画線を認識した場合、前記認識部の認識結果に加え、前記第2道路区画線の第2位置または前記第4道路区画線の第4位置を用いて、前記車両が前記道路区画線から逸脱しないように支援する支援処理を実行し、
    前記認識部が前記第1道路区画線または前記第3道路区画線を認識していない場合、前記第2道路区画線の第2位置または前記第4道路区画線の第4位置を用いず、前記認識部の認識結果を用いて、前記車両が前記道路区画線から逸脱しないように支援する支援処理を実行する、
    請求項1から3のうちいずれか1項に記載の車両制御装置。
  5. 前記支援部は、前記第1位置の方位角と前記第2位置の方位角との差分、前記第1道路区画線と前記第2道路区画線とが形成するなす角、前記第1道路区画線と前記第2道路区画線との横方向の距離に基づいて、前記第1道路区画線の第1位置と、前記第2道路区画線の第2位置との合致度合を判定する、
    請求項1から4のうちいずれか1項に記載の車両制御装置。
  6. コンピュータが、
    車両の周辺を撮像する撮像部により撮像された画像から前記車両が走行する車線の第1側の第1道路区画線を認識し、
    地図情報から前記車両が走行する車線の前記第1側の第2道路区画線の情報を取得し、
    前記車両が道路区画線から逸脱する可能性が所定度合以上である場合に、前記車両が道路区画線から逸脱しないように支援する支援処理を実行し、
    前記認識した前記第1側の前記第1道路区画線の第1位置と、前記取得した前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下である場合、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制する、車両制御方法であって、
    更に、前記車線の前記第1側とは反対の第2側の第3道路区画線を認識し、
    更に、地図情報から前記第2側の第4道路区画線の情報を取得し、
    前記第1側の前記第1道路区画線の第1位置と、前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下であり、且つ前記第2側の前記第3道路区画線の第3位置と、前記第2側の前記第4道路区画線の第4位置との合致度合が第2閾値以下である場合において、
    前記第1側の前記第1道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第1道路区画線に基づいて前記車両が前記第1道路区画線から逸脱しないように支援する支援処理を実行し、
    前記第2側の前記第3道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第3道路区画線に基づいて前記車両が前記第3道路区画線から逸脱しないように支援する支援処理を実行する、
    車両制御方法。
  7. コンピュータに、
    車両の周辺を撮像する撮像部により撮像された画像から前記車両が走行する車線の第1側の第1道路区画線を認識する処理と、
    地図情報から前記車両が走行する車線の前記第1側の第2道路区画線の情報を取得する処理と、
    前記車両が道路区画線から逸脱する可能性が所定度合以上である場合に、前記車両が道路区画線から逸脱しないように支援する支援処理を実行する処理と、
    前記認識した前記第1側の前記第1道路区画線の第1位置と、前記取得した前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下である場合、前記車両が前記第1側の道路区画線から逸脱しないように支援する支援処理の実行を抑制する処理と、を実行させるプログラムであって、
    更に、前記車線の前記第1側とは反対の第2側の第3道路区画線を認識させる処理と、
    更に、地図情報から前記第2側の第4道路区画線の情報を取得させる処理と、
    前記第1側の前記第1道路区画線の第1位置と、前記第1側の前記第2道路区画線の第2位置との合致度合が第1閾値以下であり、且つ前記第2側の前記第3道路区画線の第3位置と、前記第2側の前記第4道路区画線の第4位置との合致度合が第2閾値以下である場合において、
    前記第1側の前記第1道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第1道路区画線に基づいて前記車両が前記第1道路区画線から逸脱しないように支援する支援処理を実行させる処理と、
    前記第2側の前記第3道路区画線から前記車両が逸脱する可能性が所定度合以上である場合に、前記第3道路区画線に基づいて前記車両が前記第3道路区画線から逸脱しないように支援する支援処理を実行させる処理と、
    を実行させるプログラム。
JP2020196085A 2020-11-26 2020-11-26 車両制御装置、車両制御方法、およびプログラム Active JP7225185B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2020196085A JP7225185B2 (ja) 2020-11-26 2020-11-26 車両制御装置、車両制御方法、およびプログラム
CN202111194516.0A CN114537386A (zh) 2020-11-26 2021-10-13 车辆控制装置、车辆控制方法及计算机可读取的存储介质
US17/503,352 US20220161794A1 (en) 2020-11-26 2021-10-17 Vehicle control device, vehicle control method, and non-transitory computer-readable recording medium recording program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020196085A JP7225185B2 (ja) 2020-11-26 2020-11-26 車両制御装置、車両制御方法、およびプログラム

Publications (2)

Publication Number Publication Date
JP2022084303A JP2022084303A (ja) 2022-06-07
JP7225185B2 true JP7225185B2 (ja) 2023-02-20

Family

ID=81657913

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020196085A Active JP7225185B2 (ja) 2020-11-26 2020-11-26 車両制御装置、車両制御方法、およびプログラム

Country Status (3)

Country Link
US (1) US20220161794A1 (ja)
JP (1) JP7225185B2 (ja)
CN (1) CN114537386A (ja)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008249639A (ja) 2007-03-30 2008-10-16 Mitsubishi Electric Corp 自己位置標定装置、自己位置標定方法および自己位置標定プログラム
JP2017105383A (ja) 2015-12-11 2017-06-15 トヨタ自動車株式会社 車両の運転支援装置
JP2018189900A (ja) 2017-05-11 2018-11-29 日立オートモティブシステムズ株式会社 車両制御装置、車両制御方法および車両制御システム
JP2019046363A (ja) 2017-09-06 2019-03-22 株式会社デンソー 運転支援装置
JP2019152896A (ja) 2018-02-28 2019-09-12 本田技研工業株式会社 走行制御装置、走行制御方法およびプログラム
JP2020003463A (ja) 2018-07-02 2020-01-09 トヨタ自動車株式会社 自車位置推定装置

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5997797B2 (ja) * 2015-03-03 2016-09-28 富士重工業株式会社 車両の地図データ処理装置
JP6690506B2 (ja) * 2016-11-17 2020-04-28 トヨタ自動車株式会社 車両の車線内走行支援装置
EP3971866B1 (en) * 2019-05-15 2024-02-28 Nissan Motor Co., Ltd. Vehicle travel control method and vehicle travel control device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008249639A (ja) 2007-03-30 2008-10-16 Mitsubishi Electric Corp 自己位置標定装置、自己位置標定方法および自己位置標定プログラム
JP2017105383A (ja) 2015-12-11 2017-06-15 トヨタ自動車株式会社 車両の運転支援装置
JP2018189900A (ja) 2017-05-11 2018-11-29 日立オートモティブシステムズ株式会社 車両制御装置、車両制御方法および車両制御システム
JP2019046363A (ja) 2017-09-06 2019-03-22 株式会社デンソー 運転支援装置
JP2019152896A (ja) 2018-02-28 2019-09-12 本田技研工業株式会社 走行制御装置、走行制御方法およびプログラム
JP2020003463A (ja) 2018-07-02 2020-01-09 トヨタ自動車株式会社 自車位置推定装置

Also Published As

Publication number Publication date
CN114537386A (zh) 2022-05-27
US20220161794A1 (en) 2022-05-26
JP2022084303A (ja) 2022-06-07

Similar Documents

Publication Publication Date Title
JP6710710B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7199150B2 (ja) 車両制御装置、車両制御方法、及びプログラム
JP7112374B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7345349B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP2019131077A (ja) 車両制御装置、車両制御方法、およびプログラム
JP7000202B2 (ja) 車両制御システム、車両制御方法、およびプログラム
JP7406432B2 (ja) 移動体制御装置、移動体制御方法、およびプログラム
JP7080091B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7308880B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7159267B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7125969B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7191065B2 (ja) 処理装置、処理方法、およびプログラム
JP7141421B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7474136B2 (ja) 制御装置、制御方法、およびプログラム
CN114954511A (zh) 车辆控制装置、车辆控制方法以及存储介质
CN115158347A (zh) 移动体控制装置、移动体控制方法及存储介质
JP7225185B2 (ja) 車両制御装置、車両制御方法、およびプログラム
CN113492845A (zh) 车辆控制装置、车辆控制方法及存储介质
JP2021160399A (ja) 車両制御装置、車両制御方法、およびプログラム
JP7431081B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7050098B2 (ja) 車両制御装置、車両制御方法、およびプログラム
JP7429556B2 (ja) 車両制御装置、車両制御方法、およびプログラム
US20220289025A1 (en) Mobile object control device, mobile object control method, and storage medium
JP2022152206A (ja) 車両制御装置、車両制御方法、およびプログラム
JP2023112396A (ja) 移動体制御装置、移動体制御方法、およびプログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210727

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220802

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221003

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230208

R150 Certificate of patent or registration of utility model

Ref document number: 7225185

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150