JP7458743B2 - 車両制御方法及び車両制御装置 - Google Patents

Description

本発明は、車両制御方法及び車両制御装置に関する。

特許文献１には、車両の前方を撮影した画像に基づいて信号機と停止線とを認識し、信号機が赤信号である場合には停止線で停止するように車両を制御する技術が記載されている。

特開２０１１－１２３６１３号公報

しかしながら、車両に搭載されるカメラの画角や搭載位置、配向によっては、信号機に対応して定められた停止位置（例えば停止線位置）まで車両が進むと、カメラの画角範囲から信号機が外れてしまうことがある。このような場合、車両が停止位置に停止する前に信号機の表示が「進行」に変化しても、それを認識できずに停止位置に車両を停止させてしまうおそれがある。
本発明は、撮像画像による信号機の認識結果に基づく自動運転において、自車両に搭載したカメラの撮像画像から信号機の現示を判定できない停止位置に自車両を停止させるのを抑制することを目的とする。

本発明の一態様による車両制御方法では、信号機の設置位置の情報と信号機が設けられた道路の情報とを少なくとも含む地図情報に基づいて、信号機により規制される車線において信号機に応じて車両を停止すべき交通規則上の第１停止位置を決定し、自車両に搭載されたカメラの光学情報及び設置情報と地図情報とに基づいて、カメラによる撮像画像から信号機の現示を判定可能な車線上の領域で信号機に最も近い位置を第２停止位置として算出し、第１停止位置及び第２停止位置のうち信号機から遠い一方を目標停止位置として設定し、撮像画像から信号機の現示を判定し、信号機の現示が停止を示す場合に目標停止位置に停止するように前記自車両を制御する。

本発明の一形態によれば、撮像画像による信号機の認識結果に基づく自動運転において、自車両に搭載したカメラの撮像画像から信号機の現示を判定できない停止位置に自車両を停止させるのを抑制できる。

実施形態の車両制御装置の概略構成図である。 実施形態の車両制御方法の一例の説明図である。 実施形態の車両制御方法の一例の説明図である。 実施形態の車両制御装置の機能構成の一例を示すブロック図である。 第１停止位置の決定方法の第１例の説明図である。 第１停止位置の決定方法の第２例の説明図である。 第１停止位置の決定方法の第３例の説明図である。 上下方向の画角範囲に信号機が入る条件の説明図である。 水平方向の画角範囲に信号機が入る条件の説明図である。 第２停止位置の算出方法の第１例の説明図である。 第２停止位置の算出方法の第２例の説明図である。 第２停止位置の算出方法の第３例の説明図である。 目標停止位置の設定方法の説明図である。 目標停止位置の設定方法の説明図である。 実施形態の車両制御方法の一例のフローチャートである。

以下、図面を参照して、本発明の実施形態を説明する。図面の記載において、同一又は類似の部分には同一又は類似の符号を付し、重複する説明を省略する。各図面は模式的なものであり、現実のものとは異なる場合が含まれる。以下に示す実施形態は、本発明の技術的思想を具体化するための装置や方法を例示するものであって、本発明の技術的思想は、下記の実施形態に例示した装置や方法に特定するものでない。本発明の技術的思想は、特許請求の範囲に記載された技術的範囲内において、種々の変更を加えることができる。

（構成）
自車両１は、自車両１の走行を自動的に制御する車両制御装置１０を備える。車両制御装置１０は、自車両１の現在位置である自己位置を検出し、検出した自己位置に基づいて自車両１の走行を制御することにより、自車両１の運転を支援する。
例えば、車両制御装置１０は、検出した自己位置と周囲の走行環境とに基づいて、運転者が関与せずに自車両１を自動で運転する自律走行制御を行うことによって運転を支援する。

車両制御装置１０は、推定した自己位置と周囲の走行環境に基づいて加減速のみを制御することによって運転を支援してもよい。例えば、車両制御装置１０は、自車両１の前方の信号機の現示に応じて、信号機の手前に自車両１を停止させる自動停止制御を行ってよい。なお、信号機の現示とは信号機の点灯色や矢印信号等の進行可/不可や進行可能な方向に関する表示を表し、一般に灯火現示あるいは信号現示とも言われる。
車両制御装置１０は、物体センサ１１と、車両センサ１２と、測位装置１３と、地図データベース１４と、通信装置１５と、ナビゲーションシステム１７と、コントローラ１８と、アクチュエータ１９を備える。図面において地図データベースを「地図ＤＢ」と表記する。

物体センサ１１は、自車両１の周囲の物体を検出する複数の異なる種類のセンサを備える。
例えば物体センサ１１は、自車両１に搭載されたカメラ２０を備える。カメラ２０は、自車両１の前方の所定の画角範囲（撮影範囲）の画像を撮影し、撮像画像をコントローラ１８へ出力する。
また物体センサ１１は、レーザレーダやミリ波レーダ、LIDAR（Light Detection and Ranging、Laser Imaging Detection and Ranging）などの測距センサを備えてもよい。

車両センサ１２は、自車両１に搭載され、自車両１から得られる様々な情報（車両信号）を検出する。車両センサ１２には、例えば、自車両１の走行速度（車速）を検出する車速センサ、自車両１が備える各タイヤの回転速度を検出する車輪速センサ、自車両１の３軸方向の加速度（減速度を含む）を検出する３軸加速度センサ（Ｇセンサ）、操舵角（転舵角を含む）を検出する操舵角センサ、自車両１に生じる角速度を検出するジャイロセンサ、ヨーレートを検出するヨーレートセンサ、自車両のアクセル開度を検出するアクセルセンサと、運転者によるブレーキ操作量を検出するブレーキセンサが含まれる。

測位装置１３は、全地球型測位システム（ＧＮＳＳ）受信機を備え、複数の航法衛星から電波を受信して自車両１の現在位置を測定する。ＧＮＳＳ受信機は、例えば地球測位システム（ＧＰＳ）受信機等であってよい。測位装置１３は、例えば慣性航法装置であってもよい。
地図データベース１４は、自動運転用の地図情報として好適な高精度地図データ（以下、単に「高精度地図」という。）を記憶してよい。高精度地図は、ナビゲーション用の地図データ（以下、単に「ナビ地図」という。）よりも高精度の地図データである。
高精度地図が有する道路の情報は、道路単位の情報よりも詳細な車線単位の情報を含む。以下、高精度地図データに含まれる車線単位の情報を「車線情報」と表記することがある。

例えば、高精度地図は、車線情報として、車線基準線（例えば車線内の中央の線）上の基準点を示す車線ノードの情報と、車線ノード間の車線の区間態様を示す車線リンクの情報を含む。
車線ノードの情報は、その車線ノードの識別番号、位置座標、接続される車線リンク数、接続される車線リンクの識別番号を含む。車線リンクの情報は、その車線リンクの識別番号、車線の種類、車線の幅員、車線境界線の種類、車線の形状、車線の勾配、車線区分線の形状、車線基準線の形状を含む。
高精度地図は更に、車線上又はその近傍に存在する停止線、標識、建物、電柱、縁石、横断歩道等の地物の種類及び位置座標と、地物の位置座標に対応する車線ノードの識別番号及び車線リンクの識別番号等の地物の情報を含む。

高精度地図は更に、車線上又はその近傍に設けられた信号機の情報を含む。高精度地図データに含まれる信号機の情報を「信号機情報」と表記することがある。
信号機情報は、各信号機の設置位置の情報と、信号機に対応する停止線の識別情報を含む。信号機情報は、信号機に対応する停止線の識別情報を介して、この信号機によって交通が規制される車線を特定する。
信号機に対応する停止線が存在しない場合、信号機情報は、例えば信号機が設けられた交差点の車線ノードの情報や、信号機が設けられた横断歩道の情報を含んでよい。信号機情報は、これらの情報を介して、この信号機によって交通が規制される車線を特定する。

ここで「信号機によって交通が規制される車線」とは、当該信号機に対応して設けられた停止線よりも先に進行することが、当該信号機の表示によって許可又は禁止される車線、又は当該信号機が設けられた交差点もしくは横断歩道へ進入することが、当該信号機の表示によって許可又は禁止される車線である。
信号機の設置位置の情報は、少なくとも信号機が設置される位置の地図座標系（もしくは世界座標系）の２次元座標を含む。信号機の設置位置の情報は、信号機が設置される位置の２次元座標に加えて、信号機の高さ情報を含んでもよい。

通信装置１５は、自車両１の外部の通信装置との間で無線通信を行う。通信装置１５による通信方式は、例えば公衆携帯電話網による無線通信や、車車間通信、路車間通信、又は衛星通信であってよい。
ナビゲーションシステム１７は、測位装置１３により自車両１の現在位置を認識し、その現在位置における地図情報を地図データベース１４から取得する。ナビゲーションシステム１７は、乗員が入力した目的地までの走行経路を設定し、この走行経路に従って乗員に経路案内を行う。
またナビゲーションシステム１７は、設定した走行経路の情報をコントローラ１８へ出力する。自律走行制御を行う際に、コントローラ１８は、ナビゲーションシステム１７が設定した走行経路に沿って走行するように自車両１を自動で運転する。

コントローラ１８は、自車両１の車両制御を行う電子制御ユニット（ＥＣＵ：Electronic Control Unit）である。コントローラ１８は、プロセッサ２１と、記憶装置２２等の周辺部品とを含む。プロセッサ２１は、例えばＣＰＵ（Central Processing Unit）やＭＰＵ（Micro-Processing Unit）であってよい。
記憶装置２２は、半導体記憶装置や、磁気記憶装置、光学記憶装置等を備えてよい。記憶装置２２は、レジスタ、キャッシュメモリ、主記憶装置として使用されるＲＯＭ（Read Only Memory）及びＲＡＭ（Random Access Memory）等のメモリを含んでよい。
以下に説明するコントローラ１８の機能は、例えばプロセッサ２１が、記憶装置２２に格納されたコンピュータプログラムを実行することにより実現される。

なお、コントローラ１８を、以下に説明する各情報処理を実行するための専用のハードウエアにより形成してもよい。
例えば、コントローラ１８は、汎用の半導体集積回路中に設定される機能的な論理回路を備えてもよい。例えばコントローラ１８はフィールド・プログラマブル・ゲート・アレイ（ＦＰＧＡ：Field-Programmable Gate Array）等のプログラマブル・ロジック・デバイス（ＰＬＤ：Programmable Logic Device）等を有していてもよい。

アクチュエータ１９は、コントローラ１８からの制御信号に応じて、自車両１のステアリングホイール、アクセル開度及びブレーキ装置を操作して、自車両１の車両挙動を発生させる。アクチュエータ１９は、ステアリングアクチュエータと、アクセル開度アクチュエータと、ブレーキ制御アクチュエータを備える。ステアリングアクチュエータは、自車両１のステアリングの操舵方向及び操舵量を制御する。アクセル開度アクチュエータは、自車両１のアクセル開度を制御する。ブレーキ制御アクチュエータは、自車両１のブレーキ装置の制動動作を制御する。

次に、コントローラ１８による自車両１の走行制御の一例を説明する。コントローラ１８は、カメラ２０による撮像画像から、自車両１が走行する車線の交通を規制する信号機を認識する。コントローラ１８は、認識した信号機の現示にしたがって自車両１を自動的に走行させ又は停止する。
上記のとおり、カメラ２０の画角や搭載位置、配向によっては、停止線位置のような交通規則で定められた停止位置まで車両が進むと、カメラ２０の画角範囲から信号機が外れてしまうことがある。

このような場合には、車両が停止位置で停止する前に信号機の表示が「進行」に変化しても、それを認識できずに停止位置に車両を停止させてしまうおそれがある。
また、車両が停止位置に停止すると、その後に信号機の表示が「進行」に変化しても、それを認識できずに発進できなくなる。
そこでコントローラ１８は、信号機が停止を示す場合には、交通規則上の第１停止位置と、カメラによる撮像画像から信号機の現示を判定できる第２停止位置のうち、信号機から遠い一方の停止位置に自車両を停止させる。

図２Ａ及び図２Ｂを参照する。自車両１の前方に信号機３０が存在する場合を想定する。信号機３０は、複数の車線３１及び３２の交通を規制する信号機である。車線３１及び３２の通行方向は同じであり、車線３１は自車両１の走行車線、車線３２は車線３１の隣接車線である。
コントローラ１８は、地図データベース１４の地図情報に基づいて、信号機３０により規制される車線３１において信号機３０の現示に応じて車両を停止すべき交通規則上の第１停止位置を決定する。

例えば、地図情報に含まれる信号機３０の信号機情報が、信号機３０に対応する停止線の識別情報を含んでいる場合には、コントローラ１８は、第１停止位置３３として停止線の位置座標を地図情報から取得する。
また、コントローラ１８は、自車両１に搭載されたカメラ２０の光学情報（例えばカメラ２０の画角情報）及び設置情報（例えば自車両１へのカメラの搭載位置と光学系の配向）と地図データベース１４の地図情報とに基づいて、カメラ２０による撮像画像から信号機３０の現示を判定可能な車線３１上の領域で、信号機３０に最も近い位置３４を第２停止位置として算出する。カメラ２０の光学情報と設置情報は、例えば予め設定して記憶装置２２に格納しておく。

そして、コントローラ１８は、第１停止位置３３及び第２停止位置３４のうち信号機３０から遠い一方を目標停止位置として設定する。図２Ａの場合には、第１停止位置３３を目標停止位置に設定する。図２Ｂの場合には、第２停止位置３４を目標停止位置に設定する。
次にコントローラ１８は、カメラ２０の撮像画像から信号機３０の現示を判定し、信号機３０の現示が停止を示す場合に、上記のとおり決定した目標停止位置に停止するように自車両１を制御する。

この結果、例えば図２Ａに示すように、交通規則で定められた第１停止位置３３において、カメラ２０による撮像画像から信号機３０の現示を判定可能である場合には第１停止位置３３に自車両１を停止させることができる。
一方で、例えば図２Ｂに示すように、第１停止位置３３においてカメラ２０による撮像画像から信号機３０の現示を判定できない場合には、カメラ２０による撮像画像から信号機３０の現示を判定できる第２停止位置３４に自車両１を停止させることができる。
この結果、カメラ２０の撮像画像による信号機３０の認識結果に基づく自動運転において、自車両１に搭載したカメラ２０の撮像画像から信号機３０の現示を判定できない停止位置に自車両１を停止させるのを抑制できる。

以下、コントローラ１８の機能を詳しく説明する。図３を参照する。コントローラ１８は、地図取得部４０と、信号認識部４１と、停止位置設定部４２と、自車両経路生成部４３と、車両制御部４４を備える。
地図取得部４０は、地図データベース１４から自車両１が走行する道路の地図情報を取得する。地図取得部４０は、通信装置１５により外部の地図データサーバから地図情報を取得してもよい。

地図取得部４０により取得される地図情報には、自車両１の進路前方に存在する信号機の信号機情報と、この信号機によって交通が規制される車線の車線情報と、この車線と交差する他の車線の車線情報と、車線上又はその近傍に存在する地物の情報と、を含む。
信号認識部４１は、カメラ２０による撮像画像を解析して信号機を認識して、その現示を判定する。信号認識部４１は、信号機の現示の判定結果を自車両経路生成部４３へ出力する。

停止位置設定部４２は、自車両１の走行車線を規制する自車両１の前方の信号機の現示が「停止」を示す場合に自車両１を停止させる目標停止位置を設定する。
停止位置設定部４２は、第１停止位置決定部５０と、第２停止位置算出部５１と、目標停止位置設定部５２を備える。

第１停止位置決定部５０は、地図取得部４０が取得した地図情報に基づいて、自車両１の前方の信号機により規制される車線において信号機の現示に応じて車両を停止すべき交通規則上の第１停止位置を決定する。
図４Ａ～４Ｃを参照する。自車両１の前方に信号機３０が存在する場合を想定する。信号機３０は、複数の車線３１及び３２の交通を規制する信号機である。車線３１及び３２の通行方向は同一の互いに隣接する車線である。

例えば、図４Ａに示すように、地図取得部４０が取得した地図情報に含まれる信号機３０の信号機情報が、信号機３０に対応する停止線の識別情報を有する場合には、第１停止位置決定部５０は、車線３１及び３２上の第１停止位置３３として停止線の位置座標を地図情報から取得する。

信号機３０の信号機情報が、信号機３０に対応する停止線の識別情報を持たない場合も考えられる。例えば、信号機３０に対応する停止線が存在しない場合がある。また、実際には停止線が存在していても、その情報が地図データベース１４に記憶されていない場合もある。
図４Ｂは、車線３１及び３２と交差する横断歩道６０に設けられた信号機３０に対応する停止線が存在しない場合の一例を示し、図４Ｃは、車線３１及び３２と交差車線６２との交差点６３に設けられた信号機３０に対応する停止線が存在しない場合の一例を示す。
第１停止位置決定部５０は、車線３１及び３２と交差するこれらの地物と車線３１及び３２との交差位置に基づいて、車線３１及び３２上の第１停止位置３３を決定する。

図４Ｂを参照する。第１停止位置決定部５０は、横断歩道６０の位置座標を地図情報から取得して、横断歩道６０の側端６１より所定距離Ｄだけ手前の位置を第１停止位置３３として決定する。
図４Ｃを参照する。第１停止位置決定部５０は、信号機３０の信号機情報から信号機３０が設けられた交差点６３の車線ノードの情報を取得する。第１停止位置決定部５０は、この車線ノードに接続される車線リンクの識別番号から交差車線６２を識別し、交差車線６２の車線情報を地図情報から取得する。第１停止位置決定部５０は、交差車線６２の側端６４より所定距離Ｄだけ手前の位置を第１停止位置３３として決定する。

図３を参照する。第２停止位置算出部５１は、信号機３０の設置位置及び高さ情報と、車線３１の道路構造及び勾配と、カメラ２０の光学情報及び設置情報に基づいて、第１停止位置３３に自車両１が位置する場合にカメラ２０による撮像画像から信号機３０の現示を判定できるか否かを判定する。
第２停止位置算出部５１は、カメラ２０が信号機３０を撮影できるか否かに応じて、撮像画像から信号機３０の現示を判定できるか否かを判定してよい。

例えば第２停止位置算出部５１は、カメラ２０の上下方向及び水平方向の画角範囲の両方に信号機３０が位置する場合に、カメラ２０が信号機３０を撮影できると判定し、上下方向及び水平方向の画角範囲のいずれかから信号機３０が外れる場合に、カメラ２０が信号機３０を撮影できないと判定してよい。
図５Ａを参照する。第２停止位置算出部５１は、例えば次式（１）及び（２）を満足する場合に、カメラ２０の上下方向の画角範囲に信号機３０が位置すると判断する。

（ｘｂ＋ｘ０）ｔａｎθ１ ＞ ｙｓ１－ｙｃ …（１）
（ｘｂ＋ｘ０）ｔａｎθ２ ＜ ｙｓ２－ｙｃ …（２）
ｘｂは自車両１から信号機３０までの水平距離であり、ｘ０は自車両１の前端からカメラ２０の搭載位置までの前後方向距離であり、ｙｃはカメラ２０の搭載位置の高さであり、ｙｓ１か信号機３０の上端の高さであり、ｙｓ２は信号機３０の下端の高さである。

θ１はカメラ２０の画角範囲の上限６５の仰角であり、θ２はカメラ２０の画角範囲の下限６６の仰角である。
なお、地図情報に信号機３０の高さ情報がない場合には、行政機関等によって定められた設置基準に基づいて一般的な信号機の高さとして仮定される値を、信号機３０の高さとして用いてもよい。例えば、ｙｓ１を５．７ｍと仮定し、ｙｓ２を４．７ｍと仮定してよい。

図５Ｂを参照する。第２停止位置算出部５１は、カメラ２０の光学中心２０ｃに対する信号機３０の横方向の偏位と、カメラ２０から信号機３０までの水平距離（ｘｂ＋ｘ０）と、カメラ２０の水平画角θｈに基づいて、カメラ２０の水平方向の画角範囲に信号機３０が位置するか否かを判定する。
このとき、自車両１が車線３１の中央に位置すると仮定してもよい。また、地図情報に含まれる信号機３０の設置位置情報が、信号機３０の支柱３７の２次元座標である場合には、支柱３７の座標を信号機３０の座標として使用してもよい。

第１停止位置３３においてカメラ２０による撮像画像から信号機３０の現示を判定できないと判定した場合に、第２停止位置算出部５１は、カメラ２０による撮像画像から信号機３０の現示を判定できる車線３１上の第２停止位置を算出する。
図６Ａを参照する。例えば、第２停止位置算出部５１は、図５Ａ及び図５Ｂを参照して説明した方法を用いて信号機３０を撮影可能な地点を車線３１上で探索することにより、信号機３０から所定距離の範囲内で、信号機３０の現示を判定可能な車線３１上の領域を算出し、この領域で最も信号機３０に近い位置を第２停止位置３４として算出する。

車線３２についても同様に、信号機３０から所定距離の範囲内で、信号機３０の現示を判定可能な車線３２上の領域を算出し、この領域で最も信号機３０に近い位置を第２停止位置３５として算出する。
図６Ｂを参照する。自車両１の前方に複数の信号機３０ａ及び３０ｂが存在する場合を想定する。信号機３０ａ及び３０ｂは、いずれも複数の車線３１及び３２の交通を規制する信号機である。

この場合に第２停止位置算出部５１は、複数の信号機３０ａ及び３０ｂの各々について、車線３１上の第２停止位置の候補３４ａ及び３４ｂを算出する。
車線３２についても同様に、第２停止位置算出部５１は、複数の信号機３０ａ及び３０ｂの各々について、車線３２上の第２停止位置の候補３５ａ及び３５ｂを算出する。
第２停止位置算出部５１は、これらの候補３４ａ及び３４ｂのいずれかを、車線３１上の第２停止位置として選択する。また、第２停止位置算出部５１は、候補３５ａ及び３５ｂのいずれかを、車線３２上の第２停止位置として選択する。

図６Ｃを参照する。例えば第２停止位置算出部５１は、候補３４ａ及び３４ｂのうち第１停止位置３３により近い候補３４ｂを、車線３１上の第２停止位置として選択してよい。例えば第２停止位置算出部５１は、候補３５ａ及び３５ｂのうち第１停止位置３３により近い候補３５ａを、車線３２上の第２停止位置として選択してよい。

このように第１停止位置３３により近い候補を選択することにより、第２停止位置に自車両１を停止させた場合の違和感を軽減できる。
第２停止位置算出部５１は、候補３４ａ及び３４ｂのうち第１停止位置３３により遠い候補３４ａを、第２停止位置として選択してもよい。この位置では、信号機３０ａ及び３０ｂの両方をカメラ２０で認識できるので、信号機の現示の認識精度が向上する。

図３を参照する。目標停止位置設定部５２は、信号機３０の現示が「停止」を示す場合に自車両１を停止させる目標停止位置を設定する。
図７Ａを参照する。第１停止位置３３においてカメラ２０による撮像画像から信号機３０の現示を判定できないと第２停止位置算出部５１が判定した場合に、目標停止位置設定部５２は、第２停止位置３４を目標停止位置に設定する。

図７Ｂを参照する。第１停止位置３３においてカメラ２０による撮像画像から信号機３０の現示を判定できると第２停止位置算出部５１が判定した場合に、目標停止位置設定部５２は、第１停止位置３３を目標停止位置に設定する。
これにより、目標停止位置設定部５２は、第１停止位置３３及び第２停止位置３４のうち、信号機３０からより遠い一方の停止位置を目標停止位置として設定する。

図３を参照する。自車両経路生成部４３は、物体センサ１１による自車両１の周囲の物体の検出結果と、車両センサ１２からの車両信号とに基づいて、自車両１の走行車線に沿って他車両と衝突せずに交通規則に従って走行するように、自車両１の目標走行軌道と速度プロファイルを生成する。
自車両１の前方の信号機３０の現示が停止を示すと信号認識部４１が判定した場合、自車両経路生成部４３は、停止位置設定部４２により設定された目標停止位置に自車両１を停止させる目標走行軌道と速度プロファイルを生成する。

車両制御部４４は、自車両経路生成部４３が生成した速度プロファイルに従う速度で自車両１が目標走行軌道を走行するようにアクチュエータ１９を駆動する。
この結果、第１停止位置３３においてカメラ２０による撮像画像から信号機３０の現示を判定でき、且つ信号機３０の現示が停止を示す場合、車両制御部４４は、第１停止位置３３に自車両１が停止するように自車両１の走行を制御する。
一方で、第１停止位置３３においてカメラ２０による撮像画像から信号機３０の現示を判定できず、且つ信号機３０の現示が停止を示す場合、車両制御部４４は、第２停止位置３４に自車両１が停止するように自車両１の走行を制御する。

（動作）
次に、図８を参照して実施形態の車両制御方法の一例を説明する。
ステップＳ１において地図取得部４０は、自車両１が走行する道路の地図情報を取得する。
ステップＳ２において第１停止位置決定部５０は、自車両１の前方の信号機の現示に応じて車両を停止すべき交通規則上の第１停止位置を決定する。

ステップＳ３において第２停止位置算出部５１は、第１停止位置に自車両１が位置する場合にカメラ２０による撮像画像から信号機の現示を判定できるか否かを判定する。信号機の現示を判定できる場合（ステップＳ３：Ｙ）に処理はステップＳ４に進む。信号機の現示を判定できない場合（ステップＳ３：Ｎ）に処理はステップＳ５に進む。
ステップＳ４において目標停止位置設定部５２は、第１停止位置を目標停止位置に設定する。その後に処理はステップＳ７に進む。

ステップＳ５において第２停止位置算出部５１は、カメラ２０による撮像画像から信号機の現示を判定可能な車線上の領域で信号機に最も近い位置を第２停止位置として算出する。
ステップＳ６において目標停止位置設定部５２は、第２停止位置を目標停止位置に設定する。その後に処理はステップＳ７に進む。

ステップＳ７において信号認識部４１は、カメラ２０による撮像画像を解析して信号機を認識して、その現示を判定する。
ステップＳ８において自車両経路生成部４３は、現示が停止を指示するか否かを判定する。現示が停止を指示する場合（ステップＳ８：Ｙ）に処理はステップＳ９に進む。現示が停止を指示しない場合（ステップＳ８：Ｎ）に処理はステップＳ１０に進む。

ステップＳ９において自車両経路生成部４３は、目標停止位置設定部５２により設定された目標停止位置に自車両１を停止させる目標走行軌道と速度プロファイルを生成する。
車両制御部４４は、自車両経路生成部４３が生成した速度プロファイルに従う速度で自車両１が目標走行軌道を走行するようにアクチュエータ１９を駆動する。これにより、自車両１は目標停止位置に停止するように制御される。その後に処理は終了する。

ステップＳ１０において自車両経路生成部４３は、信号機を通過して、走行車線に沿って自車両１を走行させる目標走行軌道と速度プロファイルを生成する。
車両制御部４４は、自車両経路生成部４３が生成した速度プロファイルに従う速度で自車両１が目標走行軌道を走行するようにアクチュエータ１９を駆動する。これにより、自車両１は、信号機を通過してナビゲーションシステム１７が設定した走行経路に沿って走行するように制御される。その後に処理は終了する。

（実施形態の効果）
（１）第１停止位置決定部５０は、信号機の設置位置の情報と信号機が設けられた道路の情報とを少なくとも含む地図情報に基づいて、信号機により規制される車線において信号機に応じて車両を停止すべき交通規則上の第１停止位置を決定する。第２停止位置算出部５１は、自車両１に搭載されたカメラ２０の光学情報及び設置情報と地図情報とに基づいて、カメラ２０による撮像画像から信号機の現示を判定可能な車線上の領域で信号機に最も近い位置を第２停止位置として算出する。目標停止位置設定部５２は、第１停止位置及び第２停止位置のうち信号機から遠い一方を目標停止位置として設定する。自車両経路生成部４３は、撮像画像から信号機の現示を判定する。自車両経路生成部４３と車両制御部４４は、信号機の現示が停止を示す場合に目標停止位置に停止するように自車両１を制御する。

これにより、交通規則で定められた第１停止位置においてカメラ２０による撮像画像から信号機３０の現示を判定可能である場合には、第１停止位置に自車両１を停止させることができる。一方で、第１停止位置においてカメラ２０による撮像画像から信号機の現示を判定できない場合には、カメラ２０による撮像画像から信号機の現示を判定できる第２停止位置に自車両１を停止させることができる。
この結果、カメラ２０の撮像画像による信号機の認識結果に基づく自動運転において、自車両１に搭載したカメラ２０の撮像画像から信号機の現示を判定できない停止位置に自車両１を停止させるのを抑制できる。

（２）第２停止位置算出部５１は、第１停止位置で撮像画像から信号機の現示が判定できるか否かを判定する。第１停止位置で信号機の現示を判定できない場合にのみ、第２停止位置算出部５１は第２停止位置を算出する。
これにより、第１停止位置で信号機の現示を判定できる場合には第２停止位置の算出を省略できるので、コントローラ１８の処理負荷を軽減できる。

（３）第１停止位置決定部５０は、信号機により規制される複数の車線の各々について、第１停止位置を決定する。第２停止位置算出部５１は、信号機により規制される複数の車線の各々について第２停止位置を算出する。目標停止位置設定部５２は、信号機により規制される複数の車線の各々について目標停止位置を設定する。
このように自車両１の走行車線だけでなく、同じ信号機により規制される他の車線（例えば隣接車線など）についても目標停止位置を設定することにより、車線変更を行っても、信号機の現示を判定できない停止位置に自車両１を停止させるのを抑制できる。

（４）第２停止位置算出部５１は、車線を規制する複数の信号機の各々について、第２停止位置の候補を算出し、第２停止位置の候補の中から第２停止位置を選択する。複数の信号機のいずれかの現示を判定できれば足りるので、自車両１の走行制御における選択肢を増やすことができる。

（５）第２停止位置算出部５１は、第２停止位置の候補のうち第１停止位置に最も近いものを第２停止位置として選択する。これにより、交通規則で定められた第１停止位置以外の第２停止位置に自車両１を停止させた場合の違和感を軽減できる。

（６）地図情報は信号機に対応する停止線の位置情報をさらに含み、第１停止位置決定部５０は、停止線位置情報に基づいて第１停止位置を決定する。地図情報が信号機に対応する停止線の位置情報を含まない場合に、第１停止位置決定部５０は、車線と交差する地物と車線との交差位置に基づいて第１停止位置を決定する。
これにより、交通規則にしたがって第１停止位置を決定することができる。

１…自車両、１０…車両制御装置、１１…物体センサ、１２…車両センサ、１３…測位装置、１４…地図データベース、１５…通信装置、１７…ナビゲーションシステム、１８…コントローラ、１９…アクチュエータ、２０…カメラ、２１…プロセッサ、２２…記憶装置、４０…地図取得部、４１…信号認識部、４２…停止位置設定部、４３…自車両経路生成部、４４…車両制御部、５０…第１停止位置決定部、５１…第２停止位置算出部、５２…目標停止位置設定部、

Claims (7)

1. コントローラが、
   信号機の設置位置の情報と前記信号機が設けられた道路の情報とを少なくとも含む地図情報に基づいて、前記信号機により規制される、少なくとも隣接車線を含む複数の車線の各々について、前記信号機に応じて車両を停止すべき交通規則上の第１停止位置を決定し、
   自車両に搭載されたカメラの光学情報及び設置情報と前記地図情報とに基づいて、前記複数の車線の各々について、前記カメラの水平方向の画角範囲内に前記信号機が位置しており前記カメラによる撮像画像から前記信号機の現示を判定可能な各々の車線上の領域で前記信号機に最も近い位置を第２停止位置として算出し、
   前記複数の車線の各々について、前記第１停止位置及び前記第２停止位置のうち前記信号機から遠い一方を目標停止位置として設定し、
   前記撮像画像から前記信号機の現示を判定し、
   前記信号機の前記現示が停止を示す場合に前記目標停止位置に停止するように前記自車両を制御する、
   ことを特徴とする車両制御方法。
2. 前記コントローラは、
   前記第１停止位置で前記撮像画像から前記信号機の前記現示が判定できるか否かを判定し、
   前記第１停止位置で前記信号機の前記現示を判定できない場合に、前記第２停止位置を算出する、
   ことを特徴とする請求項１に記載の車両制御方法。
3. 前記コントローラは、
   前記車線を規制する複数の信号機の各々について、前記第２停止位置の候補を算出し、
   前記第２停止位置の候補の中から前記第２停止位置を選択する、
   ことを特徴とする請求項１又は２に記載の車両制御方法。
4. 前記コントローラは、前記第２停止位置の候補のうち前記第１停止位置に最も近いものを前記第２停止位置として選択することを特徴とする請求項３に記載の車両制御方法。
5. 前記地図情報は前記信号機に対応する停止線の位置情報をさらに含み、
   前記コントローラは、前記停止線の位置情報に基づいて前記第１停止位置を決定することを特徴とする請求項１～４のいずれか一項に記載の車両制御方法。
6. 前記コントローラは、前記地図情報が前記信号機に対応する停止線の位置情報を含まない場合に、前記車線と交差する地物と前記車線との交差位置に基づいて前記第１停止位置を決定することを特徴とする請求項１～４のいずれか一項に記載の車両制御方法。
7. 自車両に搭載されたカメラと、
   信号機の設置位置の情報と前記信号機が設けられた道路の情報とを少なくとも含む地図情報に基づいて、前記信号機により規制される車線において前記信号機に応じて車両を停止すべき交通規則上の第１停止位置を決定し、前記カメラの光学情報及び設置情報と前記地図情報とに基づいて、前記カメラの水平方向の画角範囲内に前記信号機が位置しており前記カメラによる撮像画像から前記信号機の現示を判定可能な前記車線上の領域で前記信号機に最も近い位置を第２停止位置として算出し、前記第１停止位置及び前記第２停止位置のうち前記信号機から遠い一方を目標停止位置として設定し、前記撮像画像から前記信号機の現示を判定し、前記信号機の前記現示が停止を示す場合に前記目標停止位置に停止するように前記自車両を制御するコントローラと、
   を備え、
   前記コントローラは、前記信号機により規制される、少なくとも隣接車線を含む複数の車線の各々について、前記第１停止位置の決定と、前記第２停止位置の算出と、前記目標停止位置の設定と、を行うことを特徴とする車両制御装置。

Images