JP2022148761A - 車両制御装置及び車両制御用コンピュータプログラム - Google Patents

車両制御装置及び車両制御用コンピュータプログラム Download PDF

Info

Publication number
JP2022148761A
JP2022148761A JP2021050569A JP2021050569A JP2022148761A JP 2022148761 A JP2022148761 A JP 2022148761A JP 2021050569 A JP2021050569 A JP 2021050569A JP 2021050569 A JP2021050569 A JP 2021050569A JP 2022148761 A JP2022148761 A JP 2022148761A
Authority
JP
Japan
Prior art keywords
vehicle
lane
stop
adjacent
driving
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.)
Pending
Application number
JP2021050569A
Other languages
English (en)
Inventor
純平 桐木
Jumpei Kiriki
太陽 上島
Taiyo Uejima
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2021050569A priority Critical patent/JP2022148761A/ja
Priority to US17/648,749 priority patent/US11753034B2/en
Priority to CN202210250338.7A priority patent/CN115195755A/zh
Publication of JP2022148761A publication Critical patent/JP2022148761A/ja
Pending legal-status Critical Current

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
    • 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/08Estimation 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 drivers or passengers
    • 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/181Preparing for stopping
    • 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
    • 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/10Estimation 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 vehicle motion
    • B60W40/105Speed
    • 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/001Planning or execution of driving tasks
    • B60W60/0015Planning or execution of driving tasks specially adapted for safety
    • 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/08Estimation 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 drivers or passengers
    • B60W2040/0818Inactivity or incapacity of driver
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/225Direction of gaze
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/229Attention level, e.g. attentive to driving, reading or sleeping
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/26Incapacity
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2302/00Responses or measures related to driver conditions
    • B60Y2302/05Leading to automatic stopping of the vehicle

Abstract

【課題】ドライバに異常が生じた時、他の車両が走行車線と他の車線との間を移動することを妨げないように、他の車線と隣接している走行車線上に車両を停車させることが可能な車両制御装置を提供する。【解決手段】車両制御装置は、ドライバの運転に対する関与レベルに異常があるか否かを判定し、ドライバに異常がある場合、少なくとも地図情報に基づいて、停車位置を走行車線上に決定し、停車位置に対して追い越し車線とは反対側に他の車線が隣接しているか否かを判定し、他の車線が隣接している場合、他の車線が走行車線と隣接することを開始する隣接開始位置又は他の車線が走行車線と隣接することを終了する隣接終了位置に基づいて走行車線上に決定される停車回避領域に停車位置が含まれるか否かを判定し、停車回避領域に停車位置が含まれる場合、隣接開始位置と隣接終了位置との間において停車回避領域を除いた位置に車両を停車させる停車計画を生成する。【選択図】図2

Description

本発明は、車両制御装置及び車両制御用コンピュータプログラムに関する。
車両に搭載される自動制御装置は、車両の現在位置と、車両の目的位置と、地図情報とに基づいて、車両のナビルートを生成して、車両をこのナビルートに沿って走行するように制御する。
自動制御装置は、車両と他の車両との間に安全な距離が維持されるように、車両の動作を制御する。そして、自動制御装置は、自動制御で車両と他の車両との間に安全な距離が維持できなくなると判定した場合、車両の制御をドライバに移管して、車両の運転を自動制御から手動制御へ変更する。
また、自動制御装置は、ドライバに異常が生じた場合、車両が走行している走行車線上で停車するように車両を制御する。これは、自動制御装置が安全な走行が行えないと判定された時に、車両の制御をドライバに移管できないためである。
例えば、特許文献1には、ドライバによる操作が行われないと判定された場合に車両を所定の位置に停車させる時、高速道路等における合流区間と、合流区間からの規定の距離からなる区間とを、車両の停車することを禁止する停車禁止区間とすることが提案されている。これにより、自動制御装置は、自動制御で車両と他の車両との間に安全な距離が維持することが困難となりそうな区間を避けて車両を停車できる。
特開2020-111092号公報
合流区間では、高速道路の本線車線に対して合流する加速車線と、本線車線とが隣接しており、加速車線を走行する車両は隣接する本線車線へ移動可能である。ここで、合流区間の距離が長い場合、合流区間の全体にわたって停車することが禁止されると、ドライバに異常が生じた時に、自動制御装置は車両を速やかに停車すること困難になる。
そこで、本発明は、ドライバに異常が生じた時、加速車線等の他の車線を走行する他の車両が、高速道路の本線車線等の走行車線と他の車線との間を移動することを妨げないように、他の車線と隣接している走行車線上に車両を安全に停車させることが可能な車両制御装置を提供することを目的とする。
一の実施形態によれば、車両制御装置が提供される。この車両制御装置は、ドライバの運転に対する関与レベルに異常があるか否かを判定するドライバ判定部と、ドライバ判定部によってドライバに異常があると判定された場合、車両の現在位置と、車両の速度と、地図情報とに基づいて、車両を停車させるための停車位置を、車両が走行している走行車線上に決定する停車位置決定部と、地図情報に基づいて、停車位置に対して追い越し車線とは反対側に他の車線が隣接しているか否かを判定する車線判定部と、車線判定部によって他の車線が隣接していると判定された場合、他の車線が走行車線と隣接することを開始する隣接開始位置、又は、他の車線が走行車線と隣接することを終了する隣接終了位置に基づいて走行車線上に決定される停車回避領域に停車位置が含まれるか否かを判定する回避領域判定部と、回避領域判定部によって停車回避領域に停車位置が含まれると判定された場合、隣接開始位置と隣接終了位置との間において停車回避領域を除いた位置に車両を停車させる停車計画を生成する車両停車計画部と、を有することを特徴とする。
この車両制御装置において、車両停車計画部によって、隣接開始位置と隣接終了位置との間に車両を停車させることができないと判定された場合、車両が隣接終了位置を通過した後に走行車線と隣接して車両を停車可能な路肩上の位置を選択する路肩選択部を有し、車両停車計画部は、路肩選択部によって選択された路肩上の位置に車両を停車させる停車計画を生成することが好ましい。
また、この車両制御装置において、隣接開始位置から手前側の第1位置と、隣接開始位置から車両の進行方向側の第2位置との間の走行車線の範囲を停車回避領域として決定するか、又は、隣接終了位置から手前側の第3位置と、隣接終了位置から車両の進行方向側の第4位置との間の走行車線の範囲を停車回避領域として決定する停車回避領域決定部を有する停車回避領域決定部を有することが好ましい。
他の実施形態によれば、車両制御用コンピュータプログラムが提供される。この車両制御用コンピュータプログラムは、ドライバの運転に対する関与レベルに異常があるか否かを判定し、ドライバに異常があると判定された場合、車両の現在位置と、車両の速度と、地図情報とに基づいて、車両を停車させるための停車位置を、車両が走行している走行車線上に決定し、地図情報に基づいて、停車位置に対して追い越し車線とは反対側に他の車線が隣接しているか否かを判定し、他の車線が隣接していると判定された場合、他の車線が走行車線と隣接することを開始する隣接開始位置、又は、他の車線が走行車線と隣接することを終了する隣接終了位置に基づいて走行車線上に決定される停車回避領域に停車位置が含まれるか否かを判定し、停車回避領域に停車位置が含まれると判定された場合、隣接開始位置と隣接終了位置との間において停車回避領域を除いた位置に車両を停車させる停車計画を生成する、ことをプロセッサに実行させることを特徴とする。
本発明に係る車両制御装置は、ドライバに異常が生じた時、他の車両が走行車線と他の車線との間を移動することを妨げないように、他の車線と隣接している走行車線上に車両を安全に停車できる。
本実施形態の車両制御装置の一例である車両制御システムの動作の概要を説明する図である。 本実施形態の車両制御システムが実装される車両の概略構成図である。 本実施形態の車両制御システムの動作フローチャートである。 本実施形態の停車回避領決定装置の動作フローチャートである。 本実施形態の車両制御システムの動作フローチャートである。 車両制御システムの動作を説明する図である(その1)。 車両制御システムの動作を説明する図である(その2)。 車両制御システムの動作を説明する図である(その3)。 車両制御システムの動作を説明する図である(その4)。 車両制御システムの動作を説明する図である(その5)。 車両制御システムの動作を説明する図である(その6)。 車両制御システムの動作を説明する図である(その7)。
図1は、本実施形態の車両制御装置の一例である車両制御システム1の動作の概要を説明する図である。以下、図1を参照しながら、本明細書に開示する停車計画システムの動作の概要を説明する。
図1に示す例において、車両10は、2つの車線51、52及び路肩53を有する道路50の車線51上を走行している。車線52は、車線51に対して追い越し車線となる。車線51及び車線52は、車線区画線54により区画されており、車線51及び路肩53は、車線区画線55により区画されている。
道路50には、車線63を有する道路60が合流している。道路60と道路50とは道路60の車線63が道路50の車線51と隣接することを開始する隣接開始位置61と、隣接することを終了する隣接終了位置62との間で接続している。道路60の車線63と、道路50の車線51とは、車線区画線56により区画されている。
車両10に搭載される車両制御システム1は、ドライバの運転に対する関与レベルの異常を判定し、ドライバの異常判定後に車両10を停車させるための停車位置を走行車線上に決定し、走行車線上で車両10の停車することを回避する停車回避領域を決定して、ドライバの異常判定後の停車計画を生成する。
時刻T101で、ドライバに異常があると車両制御システム1により判定される。車両制御システム1は、ナビルートの直近の運転区間内に車両10を停車させるための停車位置70を、車両10が走行している車線51上に決定する。
図1に示す例では、車線51上の停車位置70に対して追い越し車52線とは反対側に道路60の車線63が隣接しているので、車両制御システム1は、ナビルートの直近の運転区間内において、道路60の車線63が車両10の走行する車線51と隣接することを開始する隣接開始位置61に基づいて停車回避領域80を車線51上に決定する。また、車両制御システム1は、ナビルートの直近の運転区間内において、車線63が車両10の走行する車線51と隣接することを終了する隣接終了位置62に基づいて停車回避領域90を車線51上に決定する。
図1に示す例では、停車位置70が停車回避領域80に含まれるので、車両制御システム1は、隣接開始位置61と隣接終了位置62との間において停車回避領域80及び停車回避領域90を除いた停車許容領域71に車両10を停車させる停車計画を生成する。その結果、車両10は時刻T102に、車線51上の停車許容領域71に停車する。なお、停車位置70が停車回避領域90に含まれる場合には、車両制御システム1は、隣接開始位置61と隣接終了位置62との間において停車回避領域80及び停車回避領域90を除いた停車許容領域71内に車両10を停車させる停車計画を生成する。そして、時刻T102に、車両10は停車計画に基づいて車線51上の停車位置72に停車する。
車両10が停車許容領域71内に停車することにより、道路60から車両10が走行している道路50へ進入する他の車両は、隣接開始位置61の近傍では、道路60の車線63から道路50の車線51の車回避領域80へ移動可能となる。同様に、他の車両は、隣接終了位置62の近傍では、道路60の車線63から道路50の車線51の停車回避領域90へ移動可能となる。
上述したように、車両制御システム1は、ドライバの運転に対する関与レベルに異常が生じた場合、道路50へ合流する道路60から車両10が走行している道路50へ進入する他の車両が、道路60の車線63と車両10が走行している車線51との間を移動することを妨げないように、道路60の車線63と隣接している車線51上に車両10を停車できる。
図2は、車両制御システム1が実装される車両10の概略構成図である。車両制御システム1は、カメラ11と、レーダセンサ12a~12eと、測位情報受信機13と、地図情報記憶装置14と、ナビゲーション装置15と、監視装置16と、ユーザインターフェース(UI)17と、位置推定装置18と、物体検出装置19と、走行車線計画装置20と、運転計画装置21と、車両制御装置22と、ドライバ判定装置23と、停車位置決定装置24と、車線判定装置25と、停車回避領域決定装置26と、回避領域判定装置27と、車両停車計画装置28と、路肩選択装置29等とを有する。ドライバ判定装置23と、停車位置決定装置24と、車線判定装置25と、停車回避領域決定装置26と、回避領域判定装置27と、車両停車計画装置28と、路肩選択装置29は、ドライバに異常が生じた場合、協働して走行車線上に車両10を停車させる停車計画を生成する。なお、車両10は、道路特徴物又は他の物体を検出するためにLiDARセンサを有していてもよい。
カメラ11と、レーダセンサ12a~12dと、測位情報受信機13と、地図情報記憶装置14と、ナビゲーション装置15と、監視装置16と、ユーザインターフェース(UI)17と、位置推定装置18と、物体検出装置19と、走行車線計画装置20と、運転計画装置21と、車両制御装置22と、ドライバ判定装置23と、停車位置決定装置24と、車線判定装置25と、停車回避領域決定装置26と、回避領域判定装置27と、車両停車計画装置28と、路肩選択装置29は、コントローラエリアネットワークといった規格に準拠した車内ネットワーク30を介して通信可能に接続される。
カメラ11は、車両10に設けられる撮像部の一例である。カメラ11は、車両10の前方を向くように、車両10に取り付けられる。カメラ11は、例えば所定の周期で、車両10の前方の所定の領域の環境が表されたカメラ画像を撮影する。カメラ画像には、車両10の前方の所定の領域内に含まれる道路と、その路面上の車線区画線等の道路特徴物が表わされ得る。カメラ11は、CCDあるいはC-MOS等、可視光に感度を有する光電変換素子のアレイで構成された2次元検出器と、その2次元検出器上に撮影対象となる領域の像を結像する撮像光学系を有する。
カメラ11は、カメラ画像を撮影する度に、カメラ画像及びカメラ画像が撮影されたカメラ画像撮影時刻を、車内ネットワーク30を介して、位置推定装置18及び物体検出装置19へ出力する。カメラ画像は、位置推定装置18において、車両10の位置を推定する処理に使用される。また、カメラ画像は、物体検出装置19において、車両10の周囲の他の物体を検出する処理に使用される。
レーダセンサ12a~12fのそれぞれは、車両10の前方、左前側方、右前側方、後方、左後側方、右後側方を向くように、例えば、車両10の外面に取り付けられる。レーダセンサ12a~12fのそれぞれは、所定の周期で設定される反射波情報取得時刻において、車両10の前方、左前側方、右前側方、後方、左後側方、右後側方に向けてミリ波を同期して発射し、反射物により反射された反射波を受信する。反射波が戻ってくるのに要する時間は、ミリ波が照射された方向に位置する他の物体と車両10との間の距離情報を有する。レーダセンサ12a~12fのそれぞれは、ミリ波の出射方向及び反射波が戻ってくるのに要する時間を含む反射波情報を、ミリ波を出射した反射波情報取得時刻と共に、車内ネットワーク30を介して物体検出装置19へ出力する。反射波情報は、物体検出装置19において、車両10の周囲の他の物体を検出する処理に使用される。
測位情報受信機13は、車両10の現在位置を表す測位情報を出力する。例えば、測位情報受信機13は、GNSS受信機とすることができる。測位情報受信機13は、所定の受信周期で測位情報を取得する度に、測位情報及び測位情報を取得した測位情報取得時刻を、地図情報記憶装置14及びナビゲーション装置15等へ出力する。
地図情報記憶装置14は、車両10の現在位置を含む相対的に広い範囲(例えば10~30km四方の範囲)の広域地図情報を記憶する。この広域地図情報は、路面の3次元情報と、道路上の車線区画線等の道路特徴物、構造物の種類及び位置を表す情報と、道路の法定速度等を含む高精度地図情報を有する。地図情報記憶装置14は、車両10の現在位置に応じて、車両10に搭載される無線通信装置(図示せず)を介した無線通信により、基地局を介して外部のサーバから広域地図情報を受信して記憶装置に記憶する。地図情報記憶装置14は、測位情報受信機13から測位情報を入力する度に、記憶している広域地図情報を参照して、測位情報により表される現在位置を含む相対的に狭い領域(例えば、100m~10km四方の範囲)の地図情報を、車内ネットワーク30を介して位置推定装置18、走行車線計画装置20及び運転計画装置21等へ出力する。
ナビゲーション装置15は、ナビゲーション用地図情報と、UI17から入力された車両10の目的位置と、測位情報受信機13から入力された車両10の現在位置を表す測位情報とに基づいて、車両10の現在位置から目的位置までのナビルートを生成する。ナビルートは、右折、左折、合流、分岐等の位置に関する情報を含む。ナビゲーション装置15は、目的位置が新しく設定された場合、又は、車両10の現在位置がナビルートから外れた場合などに、車両10のナビルートを新たに生成する。ナビゲーション装置15は、ナビルートを生成する度に、そのナビルートを、車内ネットワーク30を介して、位置推定装置18、走行車線計画装置20及び運転計画装置21等へ出力する。
監視装置16は、ドライバの状態を監視して、ドライバの運転に関与する動作が検知されなかった場合に、ドライバの運転に関与する動作が検知されなかったことを表す運転不関与信号を生成する。監視装置16は、運転不関与信号を、車内ネットワーク31を介して運転計画装置21へ出力する。監視装置16は、ドライバの頭部を含む頭部画像を撮影する監視カメラ161と、ドライバがステアリングを保持していることを検知するタッチセンサ162と、ステアリングのトルクを検知するトルクセンサ163とを有する。監視装置16は、所定の周期を有する監視時刻において撮影された頭部画像に基づいて、ドライバの視線方向、眼の開き度合い(以下、開眼度ともいう)及び口の開き度合い(以下、開口度ともいう)を検出し、検出された視線方向、開眼度及び開口度に基づいて、ドライバの運転に対する関与レベルを判定する。監視装置16は、視線方向が、車両10の前方を含む所定の範囲から外れている場合、ドライバの運転に対する関与レベルは低いと判定する。また、監視装置16は、開眼度が所定の開眼度基準値未満であるか、又は、開口度が所定の開口度基準値以上である場合、ドライバの運転に対する関与レベルは低いと判定する。ドライバの運転に対する関与レベルが低いと判定された場合、ドライバの体調に異常があるか、又は、ドライバの運転に対する集中度合いに異常のあることが考えられる。一方、監視装置16は、視線方向が、車両10の前方を含む所定の範囲内にあるか、開眼度が所定の開眼度基準値以上であるか、又は、開口度が所定の開口度基準値未満である場合、ドライバの運転に対する関与レベルは高いと判定する。
監視装置16は、ドライバの運転に対する関与レベルが低いと判定した場合、UI17を介して、ドライバに対して運転に関与することを求める警告を与える。監視装置16は、ドライバに対して警告を与えた後の所定の時間内に、検出された視線方向、開眼度及び開口度に基づいて、ドライバの運転に対する関与レベルが高いと判定された場合、ドライバは運転に関与していると判定する。また、監視装置16は、ドライバに対して警告を与えた後の所定の時間内に、タッチセンサ162によってドライバがステアリングを保持していることが検知された場合、又は、トルクセンサ163によってドライバによるステアリングの操作が検知された場合、ドライバは運転に関与していると判定する。また、監視装置16は、ドライバに対して警告を与えた後の所定の時間内に、ドライバによるアクセルペダル又はブレーキペダルの操作が検知された場合、ドライバは運転に関与していると判定する。一方、ドライバに対して警告を与えた後の所定の時間内に、ドライバの運転に対する関与レベルが高いと判定されず、且つ、タッチセンサ162によってドライバがステアリングを保持していることが検知されず、且つ、トルクセンサ163によってドライバによるステアリングの操作が検知されず、且つドライバによるアクセルペダル及びブレーキペダルの操作が検知されない場合、ドライバは運転に関与していないと判定する。そして、監視装置16は、ドライバの運転に関与する動作が検知されなかったことを表す運転不関与信号を生成する。監視装置16は、運転不関与信号をドライバ判定装置23へ出力する。なお、上述したのは運転不関与信号を生成する一例であって、監視装置16は、他の方法を用いて運転不関与信号を生成するか否かを判定しても良い。また、上述した例では、運転不関与信号を生成する前にドライバに対して警告を一度行っているが、監視装置16は、複数回警告を行っても、警告を行わずに運転不関与信号を生成しても良い。
UI17は、通知部の一例である。UI17は、ナビゲーション装置15、監視装置16及び運転計画装置21等に制御されて、車両10の走行情報、運転に関与することを求める警告等をドライバへ通知する。また、UI17は、ドライバから車両10に対する操作に応じた操作信号を生成する。車両10の走行情報は、車両の現在位置、ナビルート等の車両の現在及び将来の経路に関する情報等を含む。UI17は、走行情報及び警告等を表示するために、液晶ディスプレイ又はタッチパネル等の表示装置171を有する。また、UI17は、走行情報及び警告等をドライバへ通知するための音響出力装置(図示せず)を有していてもよい。また、UI17は、ドライバから車両10への操作情報を入力する入力装置として、例えば、タッチパネル又は操作ボタンを有する。操作情報として、例えば、目的位置、経由地、車両速度及びその他の車両の制御情報等が挙げられる。UI17は、入力された操作情報を、車内ネットワーク30を介してナビゲーション装置15及び運転計画装置21等へ出力する。
位置推定装置18は、カメラ画像内に表された車両10の周囲の道路特徴物に基づいて、カメラ画像撮影時刻における車両10の位置を推定する。例えば、位置推定装置18は、カメラ画像内に識別した車線区画線と、地図情報記憶装置14から入力された地図情報に表された車線区画線とを対比して、カメラ画像撮影時刻における車両10の推定位置及び推定方位角を求める。また、位置推定装置18は、地図情報に表された車線区画線と、車両10の推定位置及び推定方位角とに基づいて、車両10が位置する道路上の走行車線を推定する。位置推定装置18は、カメラ画像撮影時刻における車両10の推定位置、推定方位角及び走行車線を求める度に、これらの情報を、物体検出装置19、走行車線計画装置20、運転計画装置21及び車両制御装置22へ出力する。
物体検出装置19は、カメラ画像及び反射波情報に基づいて、車両10の周囲の他の物体及びその種類(例えば、車両)を検出する。他の物体には、車両10の周囲を走行する他の車両が含まれる。物体検出装置19は、検出された他の物体を追跡して、他の物体の軌跡を求める。物体検出装置19は、地図情報に表された車線区画線と、他の物体位置とに基づいて、他の物体が走行している走行車線を特定する。物体検出装置19は、検出された他の物体の種類を示す情報と、その位置を示す情報及び走行車線を示す情報を含む物体検出情報を、走行車線計画装置20及び運転計画装置21等へ出力する。
走行車線計画装置20は、所定の周期で設定される走行車線計画生成時刻において、ナビルートから選択された直近の運転区間(例えば、10km)において、地図情報と、ナビルート及び周辺環境情報と、車両10の現在位置とに基づいて、車両10が走行する道路内の車線を選択して、車両10が走行する予定走行車線を表す走行車線計画を生成する。走行車線計画装置20は、例えば、車両10が追い越し車線以外の車線を走行するように、走行車線計画を生成する。走行車線計画装置20は、走行車線計画を生成する度に、この走行車線計画を運転計画装置21へ出力する。
また、走行車線計画装置20は、ナビルートから選択された直近の運転区間において、地図情報と、ナビルートと、車両10の現在位置とに基づいて、車線変更の要否を判定する。走行車線計画装置20は、車線変更の要否の判定に、周辺環境情報又は車両状態情報を更に利用してもよい。周辺環境情報は、車両の10の周囲を走行する他の車両の位置及び速度等を含む。車両状態情報は、車両10の現在位置、車両速度、加速度及び進行方向等を含む。具体的には、走行車線計画装置20は、ナビルートと車両10の現在位置とに基づいて、車両10の目的位置へ向かう車線へ移動するために、車線変更の要否を判定する。車両10が現在走行している走行道路から合流先の他の道路へ進入すること(合流)、及び、車両10が走行道路から分岐先の他の道路へ退出すること(分岐)の有無を判定する。合流及び分岐では、車両が走行道路の車線から他の道路の車線へ移動するので、車線変更が行われる。
運転計画装置21は、所定の周期で設定される運転計画生成時刻において、走行車線計画と、地図情報と、車両10の現在位置と、周辺環境情報と、車両状態情報とに基づいて、所定の時間(例えば、5秒)先までの車両10の予定走行軌跡を表す運転計画を生成する運転計画処理を実行する。運転計画は、現時刻から所定時間先までの各時刻における、車両10の目標位置及びこの目標位置における目標車両速度の集合として表される。運転計画が生成される周期は、走行車線計画が生成される周期よりも短いことが好ましい。運転計画装置21は、走行車線計画が車両10の車線間を移動する車線変更を含む場合、車両10と他の車両との間に所定の距離を維持できるように、車線変更を含む運転計画を生成する。運転計画装置21は、走行車線計画が車両10の車線間を移動する車線変更を含んでいても、車両10と他の車両との間に所定の距離を確保できない場合、車両を停車するように運転計画を生成する。運転計画装置21は、運転計画を生成する度に、運転計画を車両制御装置22へ出力する。
車両制御装置22は、車両10の現在位置と、車両速度及びヨーレートと、運転計画装置21によって生成された運転計画とに基づいて、車両10がナビルートに沿って走行するように車両10の各部を制御する。例えば、車両制御装置22は、運転計画、車両10の車両速度及びヨーレートに従って、車両10の操舵角、加速度及び角加速度を求め、その操舵角、加速度及び角加速度となるように、操舵量、アクセル開度又はブレーキ量を設定する。そして車両制御装置22は、設定された操舵量に応じた制御信号を、車両10の操舵輪を制御するアクチュエータ(図示せず)へ出力する。また、車両制御装置22は、設定されたアクセル開度に従って燃料噴射量を求め、その燃料噴射量に応じた制御信号を車両10のエンジンなどの駆動装置(図示せず)へ出力する。あるいは、車両制御装置22は、設定されたブレーキ量に応じた制御信号を車両10のブレーキ(図示せず)へ出力する。
ドライバ判定装置23は、ドライバの運転に対する関与レベルに異常があるか否かを判定する。停車位置決定装置24は、ドライバに異常があると判定された場合、少なくとも地図情報に基づいて、車両10を停車させるための停車位置を、車両10が走行している走行車線上に決定する。車線判定装置25は、地図情報に基づいて、停車位置に対して追い越し車線とは反対側に他の車線が隣接しているか否かを判定する。停車回避領域決定装置26は、停車位置に対して追い越し車線とは反対側に他の車線が隣接していると判定された場合、他の車線が走行車線と隣接することを開始する隣接開始位置、又は、他の車線が走行車線と隣接することを終了する隣接終了位置に基づいて停車回避領域を決定する。回避領域判定装置27は、停車位置が停車回避領域に含まれるか否かを判定する。車両停車計画装置28は、停車位置が停車回避領域に含まれると判定された場合、隣接開始位置と隣接終了位置との間において停車回避領域を除いた位置に車両を停車させる停車計画を生成する。路肩選択装置29は、隣接開始位置と隣接終了位置との間に車両10を停車させることができない場合、車両10が停車区間を通過した後に走行車線と隣接して車両10を停車可能な路肩上の位置を選択する。
位置推定装置18、物体検出装置19、走行車線計画装置20、運転計画装置21、車両制御装置22、ドライバ判定装置23、停車位置決定装置24、車線判定装置25、停車回避領域決定装置26、回避領域判定装置27、車両停車計画装置28及び路肩選択装置29は、通信インターフェース(図示せず)と、メモリ(図示せず)と、プロセッサ(図示せず)とを有する。通信インターフェースは、各装置を車内ネットワーク30に接続するためのインターフェース回路を有する。
位置推定装置18、物体検出装置19、走行車線計画装置20、運転計画装置21、車両制御装置22、ドライバ判定装置23、停車位置決定装置24、車線判定装置25、停車回避領域決定装置26、回避領域判定装置27、車両停車計画装置28及び路肩選択装置29が有する機能の全て又は一部は、例えば、プロセッサ上で動作するコンピュータプログラムにより実現される機能モジュールである。あるいは、プロセッサが有する機能モジュールは、プロセッサに設けられる、専用の演算回路であってもよい。メモリは、記憶部の一例であり、例えば、揮発性の半導体メモリ及び不揮発性の半導体メモリを有する。そしてメモリは、各装置のプロセッサにより実行される情報処理において使用されるアプリケーションのコンピュータプログラム及び各種のデータを記憶する。プロセッサは、1個又は複数個のCPU(Central Processing Unit)及びその周辺回路を有する。プロセッサは、論理演算ユニット、数値演算ユニットあるいはグラフィック処理ユニットといった他の演算回路を更に有していてもよい。
位置推定装置18、物体検出装置19、走行車線計画装置20、運転計画装置21、車両制御装置22、ドライバ判定装置23、停車位置決定装置24、車線判定装置25、停車回避領域決定装置26、回避領域判定装置27、車両停車計画装置28及び路肩選択装置29は、別々の装置として説明されているが、これらの装置の全て又は一部は、一つの装置として構成されていてもよい。
ドライバ判定装置23、停車位置決定装置24、車線判定装置25、停車回避領域決定装置26、回避領域判定装置27、車両停車計画装置28及び路肩選択装置29は、協働して停車計画処理を実行する。
図3は、車両制御システム1の動作フローチャートの一例である。図3を参照しながら、車両制御システム1の処理について、以下に説明する。車両制御システム1は、車両10の走行中に、図3に示される動作フローチャートに従って停車計画処理を繰り返して実行する。
まず、車両制御システム1のドライバ判定装置23は、所定の周期で設定されるドライバ判定時刻において、ドライバの運転に対する関与レベルに異常があるか否かを判定する(ステップS101)。ドライバ判定部41は、監視装置16からドライバの運転に関与する動作が検知されなかったことを表す運転不関与信号が入力されている場合、ドライバに異常があると判定する(ステップS101-Yes)。一方、監視装置16から運転不関与信号が入力されていない場合(ステップS101-No)、ドライバ判定装置23によってドライバに異常はないと判定されて、処理はステップS101の前に戻る。図5に示す例では、時刻T101に、ドライバ判定部41は、ドライバに異常があると判定する。
ドライバに異常があると判定された場合、車両制御システム1の停止位置決定装置24は、車両10の現在位置と、車両10の速度と、地図情報とに基づいて、車両10を停車させるための停車位置を、直近の運転区間内において車両10が走行している車線上に決定する(ステップS102)。
図4に示す例では、停止位置決定装置24は、車両10の速度と、速度に応じて設定される目標減速度とを用いて、車両10の速度がゼロとなって停車する停車位置70を車線51上に決定する。停止位置決定装置24の有するメモリ(図示せず)には、車両10の速度と、目標減速度との関係が記憶されている。目標減速度の大きさは、目標減速度と関連付けられている速度から車両10が停車するまでの間に、車両10の挙動がドライバに対して不安を感じさせない程度の大きさに設定されることが好ましい。また、目標減速度は、車両10が運転区間内で停止可能な大きさになるように設定されることが好ましい。停止区間決定部42は、メモリ32から読み出された、車両10の速度と関連付けられている目標減速度と車両10の速度とを用いて、速度がゼロとなる停車位置70を、車両10が走行している車線51上に決定する。停車位置70は、車両10の寸法を含めた領域とすることが好ましい。
次に、車両制御システム1の車線判定装置25は、地図情報に基づいて、停車位置70に対して追い越し車線52とは反対側に他の車線が隣接しているか否かを判定する(ステップS103)。図6に示す例では、停車位置70に対して追い越し車線52とは反対側に、車両10が走行する道路50に対して合流する道路60の車線63が隣接しているので、車線判定装置25は、停車位置70に対して追い越し車線52とは反対側に他の車線が隣接していると判定する(ステップS103-Yes)。なお、車両10が走行している車線に隣接した追い越し車線がない場合、車線判定装置25は、追い越し車線があると仮定される側とは反対側に、他の車線が隣接しているか否かを判定する。追い越し車線があると仮定される側とは反対側は、車両が左側通行の場合には走行車線の左側であり、車両が右側通行の場合には走行車線の右側である。
次に、車両制御システム1の停車回避領域決定装置26は、図6に示すように、ナビルートの直近の運転区間内において、道路60の車線63が車両10の走行する車線51と隣接することを開始する隣接開始位置61に基づいて停車回避領域80を車線51上に決定する。また、停車回避領域決定装置26は、ナビルートの直近の運転区間内において、車線63が車両10の走行する車線51と隣接することを終了する隣接終了位置62に基づいて停車回避領域90を車線51上に決定する(ステップS104)。ステップS104における停車回避領域決定装置26の処理については、図4を用いて後述する。
次に、車両制御システム1の回避領域判定装置27は、停車位置70は停車回避領域80、90に含まれるか否かを判定する(ステップS105)。回避領域判定装置27は、停車位置70が、停車回避領域80の第1位置61aと第2位置61bとの間に含まれる場合、停車位置70は停車回避領域80に含まれると判定する。また、回避領域判定装置27は、停車位置70が停車回避領域90の第3位置62aと第4位置62bとの間に含まれる場合、停車位置70は停車回避領域90に含まれると判定する。
図7に示す例では、停車位置70は停車回避領域80の第1位置61aと第2位置61bとの間に含まれるので、回避領域判定装置27は、停車位置70は停車回避領域80に含まれると判定する(ステップS105-Yes)。なお、停車位置70が、車両10の寸法程度の領域を有する場合、停車位置70の一部でも停車回避領域80に含まれる場合、回避領域判定装置27は、停車位置70は停車回避領域80に含まれると判定する。
次に、車両制御システム1の車両停車計画装置28は、隣接開始位置61と隣接終了位置62との間において停車回避領域80、90を除いた位置に車両10を停車可能であるか否かを判定する(ステップS106)。
図7に示す例では、車両停車計画装置28は、隣接開始位置61と隣接終了位置62との間において停車回避領域80、90を除いた停車許容領域71内の位置に車両10を停車可能であると判定する(ステップS106-Yes)。ステップS106における車両停車計画装置28の処理については、図5を用いて後述する。
次に、車両停車計画装置28は、隣接開始位置61と隣接終了位置62との間において停車回避領域80、90を除いた停車許容領域71内の位置72に停車位置を変更する(ステップS107)。
次に、車両停車計画装置28は、車両10の現在位置と、車両10の速度と、ナビルートと、地図情報とに基づいて、停車許容領域71内に変更された停車位置72に、車両10を停車させる停車計画を生成する(ステップS108)。車両停車計画装置28は、車両10が停車するまでの車両10の予定走行軌跡を表す停車計画を生成する停車計画処理を実行する。停車計画は、現時刻から所定時間先までの各時刻における、車両10の目標位置及びこの目標位置における目標車両速度の集合として表される。車両停車計画装置28は、停車計画を運転計画装置21へ通知する。運転計画装置21は、通知された停車計画に基づいて運転計画を生成して、この運転計画を車両制御装置22へ通知する。そして、図7に示すように、車両制御装置22は、運転計画に基づいて車両10を走行させて、時刻T102に、車線51上の停車位置72に停車させる。
一方、隣接開始位置61と隣接終了位置62との間において停車回避領域80、90を除いた位置に車両10を停車可能でない場合(ステップS106-No)、車両制御システム1の路肩選択装置29は、車両10が隣接終了位置62を通過した後に車線51と隣接して車両10を停車可能な路肩53上の位置を選択して、車両10の停車位置を選択された位置へ変更する(ステップS109)。
図8に示す例では、隣接開始位置61と隣接終了位置62との間では、停車回避領域80と停車回避領域90とが重なっており、車両10を停車可能な位置はない。そこで、路肩選択装置29は、地図情報とナビルートとを参照して、車両10が隣接終了位置62を通過した後に車線51と隣接して車両10を停車可能な路肩53上の位置を選択して、車両10の停車位置をこの選択された位置73に変更する。路肩選択装置29は、新たな停車位置73を車両停車計画装置28へ通知する。
次に、車両停車計画装置28は、車両10の現在位置と、車両10の速度と、ナビルートと、地図情報とに基づいて、車両10を停車位置73に停車させる停車計画を生成する(ステップS108)。車両停車計画装置28は、停車計画を運転計画装置21へ通知する。運転計画装置21は、通知された停車計画に基づいて運転計画を生成して、この運転計画を車両制御装置22へ通知する。そして、図8に示すように、車両制御装置22は、運転計画に基づいて、車両10を走行させて、時刻T103に、路肩53上の停車位置73に停車させる。
一方、停車位置70を停車回避領域80、90に含まれないと判定された場合(ステップS105-No)、車両停車計画装置28は、車両10の現在位置と、車両10の速度と、ナビルートと、地図情報とに基づいて、停車許容領域71内の停車位置70に、車両10を停車させる停車計画を生成する(ステップS108)車両停車計画装置28は、停車計画を運転計画装置21へ通知する。運転計画装置21は、通知された停車計画に基づいて運転計画を生成して、この運転計画を車両制御装置22へ通知する。そして、図9に示すように、車両制御装置22は、運転計画に基づいて、車両10を走行させて、時刻T102に、車線51上の停車位置70に車両10を停車させる。
又は、停車位置70に対して追い越し車線52とは反対側に他の車線が隣接していない場合(ステップS103-No)、車両停車計画装置28は、車両10の現在位置と、車両10の速度と、ナビルートと、地図情報とに基づいて、停車位置70に車両10を停車させる停車計画を生成する(ステップS108)。車両停車計画装置28は、停車計画を運転計画装置21へ通知する。運転計画装置21は、通知された停車計画に基づいて運転計画を生成して、この運転計画を車両制御装置22へ通知する。そして、図10に示すように、車両制御装置22は、運転計画に基づいて、車両10を走行させて、時刻T102に、車線51上の停車位置70に車両10を停車させる。
図4は、本実施形態の停車回避領域決定装置26の動作フローチャートである。まず、停車回避領域決定装置26は、車両の現在位置と、ナビルートと、地図情報とを参照して、ナビルートの直近の運転区間内に、他の車線が車両10の走行する車線51と隣接することを開始する隣接開始位置が含まれるか否かを判定する(ステップS201)。図7に示す例では、ナビルートの直近の運転区間内には、道路60の車線63が道路50の車線51と隣接することを開始する隣接開始位置61が含まれているので、停車回避領域決定装置26は、ナビルートの直近の運転区間内に、隣接開始位置が含まれると判定する(ステップS201-Yes)。
次に、停車回避領域決定装置26は、隣接開始位置61に基づいて、車両10が停車することを回避する停車回避領域80を車両10が走行する車線51上に決定する(ステップS202)。停車回避領域決定装置26は、隣接開始位置61から手前側の第1位置61aと、隣接開始位置61から車両10の進行方向側の第2位置61bとの間の車線51の範囲を停車回避領域80として決定する。第1位置61aは、隣接開始位置61から所定の距離L1(例えば、50m)だけ、手前の位置としてもよい。第2位置61bは、隣接開始位置61から所定の距離L2(例えば、100m)だけ、進行方向側の位置としてもよい。また、距離L1及び距離L2は、車両10の直近の平均速度に基づいて、決定されてもよい。例えば、距離L1及び距離L2は、平均速度が早い程距離L1及び距離L2が長くなるように決定されてもよい。停車回避領域80が、隣接開始位置61の手前側の第1位置61aから進行方向側の第2位置61bとの間の範囲にわたって配置されることにより、道路60から車両10が走行している道路50へ進入する他の車両は、隣接開始位置61の近傍では、道路60の車線63から道路50の車線51の車回避領域80へ移動可能となる。
次に、停車回避領域決定装置26は、車両の現在位置と、ナビルートと、地図情報とを参照して、ナビルートの直近の運転区間内に、他の車線が車両10の走行する車線51と隣接することを終了する隣接終了位置が含まれるか否かを判定する(ステップS203)。図7に示す例では、ナビルートの直近の運転区間内には、道路50と合流する道路60の車線63が、道路50の車線51と隣接することを終了する隣接終了位置62が含まれているので、停車回避領域決定装置26は、ナビルートの直近の運転区間内に、隣接終了位置が含まれると判定する(ステップS203-Yes)。
次に、停車回避領域決定装置26は、隣接終了位置62に基づいて、車両10が停車することを回避する停車回避領域90を車両10が走行する車線51上に決定する(ステップS204)。停車回避領域決定装置26は、隣接終了位置62から手前側の第3位置62aと、隣接終了位置62から車両10の進行方向側の第4位置62bとの間の車線51の範囲を停車回避領域90として決定する。第1位置62aは、隣接終了位置62から所定の距離L3(例えば、100m)だけ、手前の位置としてもよい。第2位置62bは隣接終了位置62から所定の距離L4(例えば、150m)だけ、進行方向側の位置としてもよい。また、距離L3及び距離L4は、車両10の直近の平均速度に基づいて決定されてもよい。例えば、距離L3及び距離L4は、平均速度が早い程距離L3及び距離L4が長くなるように決定されてもよい。停車回避領域90が、隣接終了位置62の手前側の第1位置62aから進行方向側の第2位置62bとの間の範囲にわたって配置されることにより、道路60から車両10が走行している道路50へ進入する他の車両は、隣接終了位置62の近傍では、道路60の車線63から道路50の車線51の停車回避領域90へ移動可能となる。そして、処理はステップS105の前に進む。
一方、ナビルートの直近の運転区間内に隣接開始位置が含まれない場合(ステップS201-No)、処理はステップS203の前に進む。また、ナビルートの直近の運転区間内に隣接終了位置が含まれない場合(ステップS203-No)、処理はステップS105の前に進む。以上が、ステップS104における停車回避領域決定装置26の処理の説明である。
図5は、本実施形態の車両停車計画装置28の動作フローチャートである。まず、車両停車計画装置28は、隣接開始位置61と隣接終了位置62との間において停車回避領域80、90を除いた範囲に、車両10を停車可能な停車許容領域が有るか無いかを判定する(ステップS301)。車両停車計画装置28は、車両10の寸法以上の長さを有する領域がある場合、車両10を停車可能な停車許容領域が有ると判定する(ステップS301-Yes)。車両10の寸法は、例えば、車両停車計画装置28のメモリに記憶されている。
停車可能な停車許容領域がある場合、車両停車計画装置28は、車両10の速度と目標減速度以下の減速度とを用いて、車両10が停車許容領域内に停車可能であるか否かを判定する(ステップS302)。車両10の速度と目標減速度以下の減速度とを用いて、車両10が停車許容領域内に停車可能である場合(ステップS302-Yes)、車両停車計画装置28は、隣接開始位置61と隣接終了位置62との間において停車回避領域80、90を除いた位置に車両10を停車可能であると判定する(ステップS303)。車両停車計画装置28は、停車許容領域内の車両10が停車する位置に、停車位置を変更する(ステップS304)。
一方、車両停車計画装置28は、隣接開始位置61と隣接終了位置62との間において停車回避領域80、90を除いた範囲に停車許容領域が無いか(ステップS301-No)、又は、車両10の速度と目標減速度以下の減速度とを用いて、車両10が停車許容領域71内に停車可能でない(ステップS302-No)場合、車両停車計画装置28は、隣接開始位置61と隣接終了位置62との間において停車回避領域80、90を除いた位置に車両10を停車可能でないと判定する(ステップS305)。ここで、車両10が、標減速度以下の減速度を用いて停車許容領域内に停車できない場合には、ドライバに対して不安を感じさせるおそれのある減速度を用いないと、車両10を停車許容領域内に停車できないことになるので、車両10を停車可能でないと判定する。以上が、ステップS106における車両停車計画装置28の処理の説明である。
以上に説明してきたように、この車両制御装置は、ドライバの運転に対する関与レベルに異常があるか否かを判定し、ドライバに異常があると判定された場合、車両10の現在位置と、車両10の速度と、地図情報とに基づいて、車両10を停車させるための停車位置を、車両10が走行している走行車線上に決定する。また、車両制御装置は、地図情報に基づいて、停車位置に対して追い越し車線とは反対側に他の車線が隣接しているか否かを判定し、他の車線が隣接していると判定された場合、他の車線が走行車線と隣接することを開始する隣接開始位置、又は、他の車線が走行車線と隣接することを終了する隣接終了位置に基づいて走行車線上に決定される停車回避領域に、停車位置が含まれるか否かを判定する。車両制御装置は、停車回避領域に停車位置が含まれると判定された場合、隣接開始位置と隣接終了位置との間において停車回避領域を除いた位置に車両10を停車させる停車計画を生成する。これにより、車両制御装置は、ドライバに異常が生じた時、他の車両が走行車線と他の車線との間を移動することを妨げないように、他の車線と隣接している走行車線上に車両を停車できる。
次に、上述した車両制御装置の他の動作例を、図11及び図12を参照しながら以下に説明する。
図11に示す動作例では、車両10は、2つの車線151、152及び路肩153を有する道路150の車線151上を走行している。車線152は、車線151に対して追い越し車線となる。車線151及び車線152は、車線区画線154により区画されており、車線151及び路肩153は、車線区画線155により区画されている。
車線163を有する道路160が、道路150から分岐している。道路160と道路150とは道路160の車線163が道路150の車線51と隣接することを開始する隣接開始位置161と、隣接することを終了する隣接終了位置162との間で接続している。道路160の車線163と、道路150の車線151とは、車線区画線156により区画されている。
時刻T201で、ドライバの運転に対する関与レベルに異常があると車両制御システム1により判定される。車両制御システム1は、ナビルートの直近の運転区間内に車両10を停車させるための停車位置170を、車両10が走行している車線151上に決定する。
図11に示す例では、停車位置170に対して追い越し車152線とは反対側に道路160の車線163が隣接しているので、車両制御システム1は、ナビルートの直近の運転区間内において、道路160の車線163が車両10の走行する車線151と隣接することを開始する隣接開始位置161に基づいて停車回避領域180を車線151上に決定する。また、車両制御システム1は、ナビルートの直近の運転区間内において、車線163が車両10の走行する車線151と隣接することを終了する隣接終了位置162に基づいて停車回避領域190を車線151上に決定する。
図11に示す例では、停車位置170は停車回避領域180に含まれるので、車両制御システム1は、隣接開始位置161と隣接終了位置162との間において停車回避領域180及び停車回避領域190を除いた領域171内に車両10を停車させる停車計画を生成する。その結果、車両10は時刻T202に、車線151上の停車許容領域171内の停車位置172に停車する。なお、停車回避領域190が停車位置170を含む場合には、車両制御システム1は、隣接開始位置161と隣接終了位置162との間において停車回避領域180及び停車回避領域190を除いた停車許容領域171内の位置に車両10を停車させる停車計画を生成する。そして、車両10は、停車計画に基づいて、時刻T202に、車線151上の停車位置172に停車する。
車両10が領域171内の停車位置172に停車することにより、車両10が走行している道路150から道路160へ退出する他の車両は、隣接開始位置161の近傍では、道路150の車線151の停車回避領域180から道路160の車線163へ移動可能となる。同様に、他の車両は、隣接終了位置162の近傍では、道路150の車線151の停車回避領域190から道路160の車線163へ移動可能となる。
図12に示す動作例では、車両10は、2つの車線251、252及び路肩253を有する道路250の車線251上を走行している。車線252は、車線251に対して追い越し車線となる。車線251及び車線252は、車線区画線254により区画されており、車線251及び路肩253は、車線区画線255により区画されている。
また、道路250は、車線251と部分的に隣接する車線255を有する。車線255と車線251とは、車線255が車線251と隣接することを開始する隣接開始位置261と、隣接することを終了する隣接終了位置262との間で接続している。車線255と、道路150の車線251とは、車線区画線256により区画されている。
時刻T301で、ドライバに異常があると車両制御システム1により判定される。車両制御システム1は、ナビルートの直近の運転区間内に車両10を停車させるための停車位置370を、車両10が走行している車線251上に決定する。
図12に示す例では、停車位置270に対して追い越し車252線とは反対側に車線255が隣接しているので、車両制御システム1は、ナビルートの直近の運転区間内において、車線255が車両10の走行する車線251と隣接することを開始する隣接開始位置261に基づいて停車回避領域280を車線251上に決定する。また、車両制御システム1は、ナビルートの直近の運転区間内において、車線255が車両10の走行する車線251と隣接することを終了する隣接終了位置262に基づいて停車回避領域290を車線251上に決定する。
図12に示す例では、停車位置270は停車回避領域280に含まれるので、車両制御システム1は、隣接開始位置261と隣接終了位置262との間において停車回避領域280及び停車回避領域290を除いた領域271内の位置に車両10を停車させる停車計画を生成する。その結果、車両10は時刻T302に、車線251上の停車許容領域271に停車する。なお、停車位置270が停車回避領域290に含まれる場合には、車両制御システム1は、隣接開始位261と隣接終了位置262との間において停車回避領域280及び停車回避領域290を除いた停車許容領域271内の位置に車両10を停車させる停車計画を生成する。そして、車両10は、停車計画に基づいて、時刻T302に、車線251上の停車位置272に停車する。
車両10が停車許容領域271内の停車位置272に停車することにより、車両10が走行している車線251から車線255へ移動する他の車両は、隣接開始位置261の近傍では、車線251から車線255の停車回避領域280へ移動可能となる。同様に、他の車両は、隣接終了位置262の近傍では、車線255から車線251の停車回避領域290へ移動可能となる。
上述したように、車両制御システム1は、ドライバの運転に対する関与レベルに異常が生じた場合、車両10が走行している車線251から車線255へ移動する他の車両が、車両10が走行している車線251と車線255との間を移動することを妨げないように、車線255と隣接している車線251上に車両10を停車できる。
本発明では、上述した実施形態の車両制御装置及び車両制御用コンピュータプログラムは、本発明の趣旨を逸脱しない限り適宜変更が可能である。また、本発明の技術範囲はそれらの実施形態に限定されず、特許請求の範囲に記載された発明とその均等物に及ぶものである。
例えば、ドライバに異常があると判定された場合、上述した実施形態では、目標減速度に基づいて、停車位置を走行車線上に決定していたが、以下のような状況が発生した時には、目標減速度よりも大きな減速度を用いて停車位置を決定してもよい。(1)ブレーキペダル(図示せず)が操作された時、アクセサリスイッチが操作された時、(3)シフトポジションがニュートラルの位置に操作された時、(4)車両の現在位置が地図情報記憶装置に記憶される高精度な地図情報に表される地域の境界に接近した時、(5)車両の現在位置が、車両が走行している道路と他の道路との合流位置に接近した時、(6)車両の前方に障害物が検知された時、(7)レーダセンサ及びカメラ等の他の物体を検知する装置等に異常が検知された時、(8)車両が所定の距離を連続して走行した時又は車両が所定の時間の間連続して走行時、(9)車両の位置が運転計画の予定走行軌跡上の位置から所定の距離以上逸脱した時、(10)位置推定装置に異常が検知されたときには、目標減速度よりも大きな減速度を用いて、車両を走行車線上に停車させてもよい。
10 車両
1 車両制御システム
11 カメラ
12a~12f レーダセンサ
13 測位情報受信機
14 地図情報記憶装置
15 ナビゲーション装置
16 監視装置
17 ユーザインターフェース
18 位置推定装置
19 物体検出装置
20 走行車線計画装置
21 運転計画装置
22 車両制御装置
23 ドライバ判定装置
24 停車位置決定装置
25 車線判定装置
26 停車回避領域決定装置
27 回避領域判定装置
28 車両停車計画装置
29 路肩選択装置
30 車内ネットワーク
31 停車計画システム

Claims (4)

  1. ドライバの運転に対する関与レベルに異常があるか否かを判定するドライバ判定部と、
    前記ドライバ判定部によって前記ドライバに異常があると判定された場合、少なくとも地図情報に基づいて、前記車両を停車させるための停車位置を、前記車両が走行している走行車線上に決定する停車位置決定部と、
    前記地図情報に基づいて、前記停車位置に対して追い越し車線とは反対側に他の車線が隣接しているか否かを判定する車線判定部と、
    前記車線判定部によって前記他の車線が隣接していると判定された場合、前記他の車線が前記走行車線と隣接することを開始する隣接開始位置、又は、前記他の車線が前記走行車線と隣接することを終了する隣接終了位置に基づいて前記走行車線上に決定される停車回避領域に前記停車位置が含まれるか否かを判定する回避領域判定部と、
    前記回避領域判定部によって前記停車回避領域に前記停車位置が含まれると判定された場合、前記隣接開始位置と前記隣接終了位置との間において前記停車回避領域を除いた位置に前記車両を停車させる停車計画を生成する車両停車計画部と、
    を有することを特徴とする車両制御装置。
  2. 前記車両停車計画部によって、前記隣接開始位置と前記隣接終了位置との間に前記車両を停車させることができないと判定された場合、前記車両が前記隣接終了位置を通過した後に前記走行車線と隣接して前記車両を停車可能な路肩上の位置を選択する路肩選択部を有し、
    前記車両停車計画部は、前記路肩選択部によって選択された前記路肩上の位置に前記車両を停車させる停車計画を生成する請求項1に記載の車両制御装置。
  3. 前記隣接開始位置から手前側の第1位置と、前記隣接開始位置から前記車両の進行方向側の第2位置との間の前記走行車線の範囲を前記停車回避領域として決定するか、又は、前記隣接終了位置から手前側の第3位置と、前記隣接終了位置から前記車両の進行方向側の第4位置との間の前記走行車線の範囲を前記停車回避領域として決定する停車回避領域決定部を有する請求項1又は2に記載の車両制御装置。
  4. ドライバの運転に対する関与レベルに異常があるか否かを判定し、
    前記ドライバに異常があると判定された場合、少なくとも地図情報に基づいて、前記車両を停車させるための停車位置を、前記車両が走行している走行車線上に決定し、
    前記地図情報に基づいて、前記停車位置に対して追い越し車線とは反対側に他の車線が隣接しているか否かを判定し、
    前記他の車線が隣接していると判定された場合、前記他の車線が前記走行車線と隣接することを開始する隣接開始位置、又は、前記他の車線が前記走行車線と隣接することを終了する隣接終了位置に基づいて前記走行車線上に決定される停車回避領域に前記停車位置が含まれるか否かを判定し、
    前記停車回避領域に前記停車位置が含まれると判定された場合、前記隣接開始位置と前記隣接終了位置との間において前記停車回避領域を除いた位置に前記車両を停車させる停車計画を生成する、
    ことをプロセッサに実行させることを特徴とする車両制御用コンピュータプログラム。
JP2021050569A 2021-03-24 2021-03-24 車両制御装置及び車両制御用コンピュータプログラム Pending JP2022148761A (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2021050569A JP2022148761A (ja) 2021-03-24 2021-03-24 車両制御装置及び車両制御用コンピュータプログラム
US17/648,749 US11753034B2 (en) 2021-03-24 2022-01-24 Vehicle control device, medium for storing computer program for vehicle control, and method for controlling vehicle
CN202210250338.7A CN115195755A (zh) 2021-03-24 2022-03-15 车辆控制装置、存储介质以及车辆控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021050569A JP2022148761A (ja) 2021-03-24 2021-03-24 車両制御装置及び車両制御用コンピュータプログラム

Publications (1)

Publication Number Publication Date
JP2022148761A true JP2022148761A (ja) 2022-10-06

Family

ID=83362954

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021050569A Pending JP2022148761A (ja) 2021-03-24 2021-03-24 車両制御装置及び車両制御用コンピュータプログラム

Country Status (3)

Country Link
US (1) US11753034B2 (ja)
JP (1) JP2022148761A (ja)
CN (1) CN115195755A (ja)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7347375B2 (ja) * 2020-08-31 2023-09-20 トヨタ自動車株式会社 走行車線計画装置及び走行車線計画用コンピュータプログラム
US20220340161A1 (en) * 2021-04-26 2022-10-27 Steering Solutions Ip Holding Corporation Always-on motion controller

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4798127B2 (ja) 2007-12-20 2011-10-19 トヨタ自動車株式会社 緊急退避システム、緊急退避方法
EP2671768B1 (en) 2011-02-03 2019-05-08 Toyota Jidosha Kabushiki Kaisha Vehicle control apparatus
US8698639B2 (en) * 2011-02-18 2014-04-15 Honda Motor Co., Ltd. System and method for responding to driver behavior
JP6545507B2 (ja) * 2015-03-31 2019-07-17 アイシン・エィ・ダブリュ株式会社 自動運転支援システム、自動運転支援方法及びコンピュータプログラム
JP6586930B2 (ja) 2016-08-04 2019-10-09 トヨタ自動車株式会社 車両走行制御装置
JP6974367B2 (ja) * 2019-01-08 2021-12-01 本田技研工業株式会社 車両の制御システム、車両の制御方法、およびプログラム
JP7307549B2 (ja) * 2019-02-15 2023-07-12 株式会社Subaru 車両の運転制御システム

Also Published As

Publication number Publication date
US20220306158A1 (en) 2022-09-29
US11753034B2 (en) 2023-09-12
CN115195755A (zh) 2022-10-18

Similar Documents

Publication Publication Date Title
JP7120260B2 (ja) 車両制御装置
JP7047824B2 (ja) 車両制御装置
US11118933B2 (en) Method and system for providing an automation function for a transportation vehicle
JP7167963B2 (ja) 車線変更計画装置及び車線変更計画用コンピュータプログラム
JP2021115983A (ja) 自動運転装置
US20230264698A1 (en) Drive planning device, storage medium storing computer program for drive planning and drive planning method
US11753034B2 (en) Vehicle control device, medium for storing computer program for vehicle control, and method for controlling vehicle
CN114103954B (zh) 行驶车道计划装置、存储介质以及行驶车道计划方法
JP7327298B2 (ja) 通知位置決定装置及び通知位置決定用コンピュータプログラム
WO2020189238A1 (ja) 車両用表示制御装置、車両用表示制御方法、車両用表示制御プログラム
US20220315028A1 (en) Vehicle control device, storage medium for storing computer program for vehicle control, and method for controlling vehicle
US20220306116A1 (en) Vehicle control device, medium for storing computer program for vehicle control, and method for controlling vehicle
JP7251577B2 (ja) 運転計画装置及び運転計画用コンピュータプログラム
JP7251576B2 (ja) 運転計画装置及び運転計画用コンピュータプログラム
US11892316B2 (en) Map information assessment device, medium storing computer program for map information assessment, and map information assessment method
JP2020201647A (ja) 車両用表示制御装置、車両用表示制御方法、車両用表示制御プログラム
US20230080630A1 (en) Traveling lane planning device, storage medium storing computer program for traveling lane planning, and traveling lane planning method
JP7347453B2 (ja) 車両制御装置及び車両制御用コンピュータプログラム
US20220306162A1 (en) Vehicle control device, medium for storing computer program for vehicle control, and method for controlling vehicle
US20220306115A1 (en) Vehicle control device, medium for storing computer program for vehicle control, and method for controlling vehicle
CN117141515A (zh) 车辆控制装置、存储介质及车辆控制方法
JP2023083942A (ja) 位置精度判定装置、位置精度判定用コンピュータプログラム及び位置精度判定方法
JP2021028587A (ja) 車載表示制御装置
JP2021095080A (ja) 車両制御装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230510

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20240112

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240227

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240328