JP7193948B2

JP7193948B2 - 自動運転支援装置

Info

Publication number: JP7193948B2
Application number: JP2018152230A
Authority: JP
Inventors: 聡吾金井; 晋平藤森; 和也香園; 修荻野; 徳昭田口
Original assignee: Subaru Corp
Current assignee: Subaru Corp
Priority date: 2018-08-13
Filing date: 2018-08-13
Publication date: 2022-12-21
Anticipated expiration: 2038-08-13
Also published as: JP2020027459A

Description

本発明は、交差点入り口の停止線で自車両を停車させるに際し、交差点から左側通行が規定されている道路では左折方向（右側通行が規定されている道路では右折方向）へ進路転換させる場合、容易に進路転換できるように停止線での停車横位置を設定する自動運転支援装置に関する。

この種の自動運転支援装置は、運転者（操作者）が目的地をセットすると、現在地から目的地までの走行ルートを道路地図上に設定し、その全部又は一部を運転者に代わって自動的に走行させるものである。一般道路における自動運転に際しては、カメラ等のセンシングデバイスにより自車両前方の走行環境を認識し、先行車や障害物の有無、点灯している信号機の灯色や矢印信号機の示している方向等を常時監視する。

そして、自車両の進行路前方に先行車が検出された場合は、先行車との車間距離、相対車速等に基づき自車速を所定に制御する。又、交差点に設置されている信号機の点灯色が青色（青信号）の場合、或いは点灯色が赤色（赤信号）であっても矢印信号機の示す矢印方向が自車両の進行方向である場合には自車両を交差点に進入させ、直進、右左折等、走行ルートに沿って設定した目標進行路に沿って自車両を走行させる。

例えば特許文献１（特開２０１７－１５９６号公報）には、地図データベースに記憶されている道路地図情報に基づき、走行予定経路上の交差点等のエリアを抽出し、当該交差点の信号機の点灯色をカメラで撮像した画像情情報に基づいて調べ、赤色（赤信号）の場合は、交差点入り口の停止線で自車両を停止させる技術が開示されている。

又、自動運転において、自車両を交差点から左側通行が規定されている道路では左折方向（右側通行が規定されている道路では右折方向）に進路転換させる場合、自車両を交差点の手前から路側寄りに移動させ、この路側から一定の離間距離を維持した状態で交差点を通過させる走行制御が行われる。

その際、例えば特許文献２（特開２０１０－１４３４４２号公報）に開示されているように、カメラ等により自車両の旋回方向内側を撮像することで、路側に対し一定の距離を維持した状態で自車両を旋回させることができる。

特開２０１７－１５９６号公報特開２０１０－１４３４４２号公報特開２０１７－２２００２８号公報

特許文献２に開示されているように、カメラ等にて自車両の旋回方向内側を撮像することで、旋回方向内側と障害物との接触を防止するようにしたとしても、進路転換先の道路幅が狭い場合や進路転換先の道路が鋭角に交差している場合には、自車両を路側に沿って旋回させることが困難である。

従って、このような場合は、例えば特許文献３（特開２０１７－２２００２８号公報）に開示されているように、進路転換先の道路幅情報を道路地図データから読込み、進路転換先の道路幅狭い場合、大回りの旋回軌跡を設定し、自車両を交差点で先ず、外側へ膨らませた後、大回り旋回させて進路転換させることになる。

ところで、自車両が交差点入り口の停止線で停車することなく交差点に進入して進路転換させる場合は、走行しながらの操舵であるため、上述した特許文献３に開示されているように交差点内で大回り旋回させて、進路転換先の道路に進入させることが可能となる。

しかし、信号待ちや優先道路に進入する等のために交差点入り口の停止線で自車両を停車させるに際し、左側通行が規定されている道路では左折方向（右側通行が規定されている道路では右折方向）への進行方向の切換えに備えて、自車両を外側へ膨らます姿勢で停車させることは、走行車線を跨いだ状態で停車することになりかねず、後続車の進路を妨害することになる不都合がある。

本発明は、上記事情に鑑み、交差点入り口の停止線で停車した後、左側通行が規定されている道路では左折方向（右側通行が規定されている道路では右折方向）へ進路転換させるに際し、後続車の進路を妨害することなくスムーズに旋回させることのできる自動運転支援装置を提供することを目的とする。

本発明は、自車両の前方の走行環境情報を取得する前方走行環境情報取得手段と、前記自車両の現在位置を推定する自車位置推定手段と、前記自車位置推定手段で推定した前記自車両の現在位置と操作者がセットした目的地とに基づき記憶手段に記憶されている道路地図情報から目標進行路を設定する目標進行路設定手段と、前記目標進行路設定手段で設定した前記目標進行路に沿って前記自車両を走行させる走行制御を行う走行制御手段とを有する自動運転支援装置において、前記走行制御手段は、前記目標進行路設定手段で設定した前記目標進行路に基づき前方の交差点を左側通行が規定されている道路での左折方向又は右側通行が規定されている道路での右折方向へ進路転換するか否かを判定する進路転換判定手段と、前記進路転換判定手段で進路転換を行うと判定した場合、前記前方走行環境情報取得手段で取得した前記走行環境情報或いは前記道路地図情報に基づき前記交差点の周辺情報を取得し、進路転換先の道路に進入する際の進路転換方向内側の路側を基準とする前記自車両の走行車線での横位置を求める横位置演算手段と、前記前方走行環境情報取得手段で取得した前記走行環境情報或いは前記道路地図情報に基づき前記交差点の入り口の停止線で前記自車両を停車させるか否かを調べる停車判定手段と、前記停車判定手段で前記自車両を前記停止線で停止させると判定した場合、前記横位置演算手段で求めた該自車両の横位置に基づき前記停止線で該自車両を停車させる際の停車横位置を算出する停止線停車横位置算出手段と、進路転換方向の道路への旋回が可能か否かを判定する旋回可能判定手段とを有し、前記横位置演算手段は、前記横位置と前記自車両の車幅とに基づいて旋回時外側横位置を求め、前記旋回可能判定手段は、前記前方走行環境情報取得手段で取得した前記走行環境情報或いは前記道路地図情報に基づき前記自車両が走行している交差点手前の車線の車線幅を取得し、前記旋回時外側横位置が該車線幅以内の場合に旋回可能と判定する。

本発明によれば、目標進行路に基づいて前方の交差点を、左側通行が規定されている道路での左折方向又は右側通行が規定されている道路での右折方向へ進路転換すると判定した場合、交差点の周辺情報に基づき進路転換先の道路に進入する際の進路転換方向内側の路側を基準とする自車両の走行車線での横位置を求め、交差点入り口の停止線で自車両を停車させる場合、自車両の横位置に基づき停止線で自車両を停車させる際の停車横位置を算出するようにしたので、交差点入り口の停止線で自車両を停車した後、左側通行が規定されている道路では左折方向（右側通行が規定されている道路では右折方向）へ進路転換させるに際し、旋回外側へ一旦膨らませる必要がなく、従って、後続車の進路を妨害することなくスムーズに旋回させることができる。

自動運転支援装置の概略構成図左折制御処理ルーチンを示すフローチャート（その１）左折背魚処理ルーチンを示すフローチャート（その２）左折時外横位置演算サブルーチンを示すフローチャート目標進行路が交差点を左折する方向に設定されている状態を示す説明図路側に沿って自車両を左折させる状態を示す説明図左折先の道路に障害物が存在する場合の停止線での停車横位置を示す説明図左路側が交差点で直交して交差している場合の停止線での停車横位置を示す説明図左路側が鋭角に交差している場合の停止線での停車横位置を示す説明図左折不可と判定したときの停止線での停車横位置を示す説明図

以下、図面に基づいて本発明の一実施形態を説明する。図１に示す自動運転支援装置１は、自車両Ｍ（図５～図１０参照）に搭載されている。この自動運転支援装置１は、自車位置を検出する手段としてのロケータユニット１１と、前方走行環境情報取得手段としてのカメラユニット２１と、走行制御手段としての車両制御ユニット２３とが搭載されている。

ロケータユニット１１は、道路地図上の自車両Ｍの位置（自車位置）を推定すると共に、自車位置周辺の道路地図データを取得する。一方、カメラユニット２１は自車両Ｍの前方の走行環境情報を取得して、走行車線の左右を区画する区画線、道路形状、先行車両の有無等を認識すると共に、区画線中央の道路曲率、先行車両との車間距離及び相対速度等を求める。更に、カメラユニット２１は障害物を認識し、この障害物の形状及び自車両Ｍからの距離を求める。

ロケータユニット１１は、地図ロケータ演算部１２と記憶手段としての高精度道路地図データベース１６とを有している。この地図ロケータ演算部１２、後述する前方走行環境認識部２１ｄ、及び車両制御ユニット２３は、ＣＰＵ，ＲＡＭ，ＲＯＭ等を備える周知のマイクロコンピュータ、及びその周辺機器で構成されており、ＲＯＭにはＣＰＵで実行するプログラムやベースマップ等の固定データ等が予め記憶されている。

又、地図ロケータ演算部１２の入力側に、ＧＮＳＳ(Global Navigation Satellite System / 全球測位衛星システム)受信機１３、自律走行センサ１４、及び目的地情報入力装置１５、及び後述するカメラユニット２１の前方走行環境認識部２１ｄが接続されている。ＧＮＳＳ受信機１３は複数の測位衛星から発信される測位信号を受信する。又、自律走行センサ１４は、トンネル内走行等ＧＮＳＳ衛生からの受信感度が低く測位信号を有効に受信することのできない環境において、自律走行を可能にするもので、車速センサ、ジャイロセンサ、及び前後加速度センサ等で構成されている。

そして、地図ロケータ演算部１２は、車速センサで検出した車速とジャイロセンサで検出した角速度、及び前後加速度センサで検出した前後加速度等に基づき移動距離と方位からローカライゼーションを行う。

又、目的地情報入力装置１５は、操作者である運転者が目的地情報（住所、電話番号、モニタに表示された登録一覧からの選択等）を入力すると、対応する位置座標（緯度、経度）を取得し、この位置座標を目的地として設定する。

地図ロケータ演算部１２は、自車位置推定手段としての自車位置推定演算部１２ａ、道路地図情報取得部１２ｂ、目標進行路設定手段としての目標進行路設定演算部１２ｃを備えている。自車位置推定演算部１２ａは、ＧＮＳＳ受信機１３で受信した測位信号に基づき自車両Ｍの位置情報である位置座標（緯度、経度）を取得する。又、ＧＮＳＳ受信機１３の感度低下により測位衛星からの有効な測位信号を受信することができない環境では、自律走行センサ１４からの信号に基づいて自車両Ｍの位置座標を推定する。

道路地図情報取得部１２ｂは、自車両Ｍの位置座標と目的地情報入力装置１５で設定した目的地の位置座標（緯度、経度）とを、高精度道路地図データベース１６に記憶されている道路地図上にマップマッチングする。そして、両位置を特定し、現在の自車位置から目的地周辺の道路地図情報を目標進行路設定演算部１２ｃに送信する。この高精度道路地図データベース１６はＨＤＤ等の大容量記憶媒体であり、高精度な道路地図情報（ダイナミックマップ）が記憶されている。この高精度道路地図情報は、自動運転を行う際に必要とする道路データ（車線幅データ、車線中央位置座標データ、車線の進行方位角データ、制限速度、交差点や停止線の位置情報等）を保有しており、この道路データは、道路地図上の各車線に数メートル間隔で格納されている。

目標進行路設定演算部１２ｃは、先ず、道路地図情報取得部１２ｂでマップマッチングした現在位置と目的地とを結ぶ走行ルートを道路地図上に作成する。次いで、この走行ルート上に、自車両Ｍを自動走行させるための目標進行路を設定する。この目標進行路は自車両Ｍの車幅方向中央に設定され、自車両Ｍは目標進行路に沿って走行するように操舵制御が行われる。又、目標進行路は道路のどの位置を走行させるかを示すもので、走行車線(左車線、中央車線、右車線等)、交差点からの右左折、走行車線内の横位置等を、自車両Ｍの前方、数百～数キロ先までを逐次設定し更新する。尚、この目標進行路の情報は車両制御ユニット２３で読込まれる。

一方、カメラユニット２１は、自車両Ｍの車室内前部の上部中央に固定されており、車幅方向中央を挟んで左右対称な位置に配設されているメインカメラ２１ａ及びサブカメラ２１ｂからなる車載カメラ（ステレオカメラ）と、画像処理ユニット（ＩＰＵ）２１ｃ、及び前方走行環境認識部２１ｄとを有している。このカメラユニット２１は、両カメラ２１ａ，２１ｂで、自車両Ｍ前方の所定撮像領域Ｉｆ（図５参照）を撮像した走行環境画像情報をＩＰＵ２１ｃにて所定に画像処理する。

前方走行環境認識部２１ｄは、ＩＰＵ２１ｃで画像処理された走行環境画像情報を読込み、この走行環境画像情報に基づき前方走行環境を認識する。この前方走行環境には、自車両Ｍが走行する進行路（自車進行路）の道路形状（左右を区画する区画線の中央の道路曲率[1/m]、及び左右区画線間の幅（車線幅）)、交差点、信号機の点灯色、道路標識、及び路側障害物（電柱、電信柱、ガードレール、塀、駐車車両等）が含まれている。

車両制御ユニット２３は、右左折情報取得部２３ａと車両制御演算部２３ｂとを備えており、入力側にカメラユニット２１の前方走行環境認識部２１ｄが接続されている。又、この車両制御ユニット２３の出力側に、自車両Ｍを目標進行路に沿って走行させる操舵制御部３１、強制ブレーキにより自車両Ｍを減速させるブレーキ制御部３２、自車両Ｍの車速を制御する加減速制御部３３、及び警報装置３４が接続されている。更に、この車両制御ユニット２３と地図ロケータ演算部１２とが車内通信回線（例えばＣＡＮ:Controller Area Network）を通じて双方向通信自在に接続されている。

右左折情報取得部２３ａは、地図ロケータ演算部１２の目標進行路設定演算部１２ｃで設定した目標進行路に右左折する交差点が設定されているかを調べる。そして、右左折する交差点が自車両Ｍの前方に設定されている場合、カメラユニット２１の前方走行環境認識部２１ｄで取得した情報、及び、道路地図情報取得部１２ｂで取得した道路地図情報に基づき当該交差点の周辺情報を読込む。

車両制御演算部２３ｂは、操舵制御部３１、ブレーキ制御部３２、加減速制御部３３を所定に制御して、ＧＮＳＳ受信機１３で受信した自車位置を示す測位信号に基づき、自車両Ｍを目標進行路設定演算部１２ｃで設定した道路地図上の目標進行路に沿って自動走行させる。その際、前方走行環境認識部２１ｄで認識した前方走行環境に基づき、周知の追従車間距離制御（ＡＣＣ：Adaptive Cruise Control）、及び車線維持制御（ＡＬＫ：Active Lane Keep）を行い、先行車が検出された場合は先行車に追従し、先行車が検出されない場合は制限速度内で走行させる。

又、この車両制御演算部２３ｂは、右左折情報取得部２３ａで取得した情報に基づき、自車両Ｍの右左折制御処理を行う。尚、以下においては、左側通行が規定されている道路を例示して説明し、右側通行が規定されて道路では左折を右折と読み替えて適用する。又、本実施形態は、左側通行が規定されている道路における左折（右ハンドル車では助手席側に曲折）する際の自動運転支援に特徴を有している。従って、以下においては、左折時の自動運転支援制御に特化して説明する。

右左折情報取得部２３ａで実行される左折制御処理は、具体的には、図２に示す左折制御処理ルーチンに従って実行される。このルーチンでは、先ず、ステップＳ１で、目標進行路設定演算部１２ｃで設定した目標進行路とＧＮＳＳ受信機１３で受信した測位信号に基づいて推定した自車位置（緯度、経度）とを読込み、目標進行路上に自車位置をマップマッチングさせて、自車両Ｍの前方の交差点を左折方向へ進路転換（以下、単に「左折」と称する）するか否かを調べる。尚、このステップでの処理が本発明の進路転換判定手段に対応している。

そして、直進、或いは右折の場合は、そのままルーチンを抜け、周知の直進走行制御、或いは右折走行制御を実行する。又、前方の交差点を左折すると判定した場合は、ステップＳ２へ進む。尚、この直進走行制御、或いは右折走行制御は従来通りであるため、説明は省略する。

ステップＳ２へ進むと、地図ロケータ演算部１２の目標進行路設定演算部１２ｃで取得した交差点周辺の道路地図情報を読込む。更に、ステップＳ３で、前方走行環境認識部２１ｄで認識した前方走行環境情報を読込む。そして、ステップＳ４へ進み、ステップＳ２，Ｓ３で読込んだ交差点周辺の道路地図情報、及び前方走行環境情報に基づき、旋回時外側横位置である左折時外横位置Ｗａを求める。図６に示すように、左折時外横位置Ｗａは、進路転換方向内側の路側である左路側（路側帯、及び路肩）４１を基準とし、この左路側４１から自車両Ｍの右側面までの距離に右余裕幅Ｗαを加算した値である。尚、図において、Ｗｉは左折する際に必要とする左路側４１からの横位置（必要内輪横位置）、Ｗｍは自車両Ｍの左右後輪の外幅である。又、右余裕幅Ｗαは省略しても良い。

このステップＳ４での処理は、図４に示す左折時外横位置演算サブルーチンに従って実行される。尚、このサブルーチンでの処理が本発明の横位置演算手段に対応している。

このサブルーチンでは、先ず、ステップＳ２１で、地図ロケータ演算部１２の目標進行路設定演算部１２ｃで取得した左折先（進路転換先）の道路地図情報（道路幅、車線幅等）を読込む。次いで、ステップＳ２２へ進み、前方走行環境認識部２１ｄで認識した前方走行環境情報から交差点の周辺情報を取得する。この交差点の周辺情報は、左路側４１の情報（位置、形状、高さ、交差角θ等）、電柱、電信柱、ガードレール、塀、駐車車両等の路側障害物４２の情報（位置、形状、大きさ等）等である。尚、この交差点の周辺情報は、道路地図情報取得部１２ｂで取得した道路地図情報から得るようにしても良い。

その後、ステップＳ２３へ進み、自車両Ｍの情報（自車情報）を読込む。この自車情報は、車両固有情報（最小回転半径、車幅Ｗｍ、前後長、旋回方向内側後輪である左後輪から旋回方向外側前部コーナである右前部コーナまでの長さ及び傾斜角度等）、及び走行情報（自車位置、自車速、舵角）等である。

そして、ステップＳ２４で、ステップＳ２１～Ｓ２３で読込んだ各種情報に基づき、自車両Ｍを左折先の道路方向へ旋回させるために必要な左後輪の旋回半径（必要左後輪旋回半径）Ｒを算出する。自車両Ｍを交差点から左折させる場合、図５に示すように、基本的には、目標進行路を、直進路で走行している車線中央から交差点手前で左路側４１寄りに移動させ、左路側４１に沿って交差点に進入させて左折させる。

従って、図６に示すように、左折時の目標進行路は、車幅Ｗｍを左右後輪の外幅とし、左後輪から左路側４１までの予め設定されている基本寄せ幅（例えば、１０～１００[cm]）をＷｏとした場合、左路側４１からＷｏ＋Ｗｍ／２の距離に設定される。そして、ここの基本寄せ幅Ｗｏに沿って旋回する際の半径を必要左後輪旋回半径Ｒとして設定する。又、図７～図９に示すように、現在走行している直進路と左折先の道路とが大きな曲率（小さい半径）で交差している場合、この必要左後輪旋回半径Ｒは自車両Ｍの最小回転半径に設定される。

次いで、ステップＳ２５へ進み、自車両Ｍを必要左後輪旋回半径Ｒで旋回させた際の、右前部コーナの旋回軌跡Ｒｆを、必要左後輪旋回半径Ｒと左後輪から右前部コーナまでの長さ及び傾斜角度に基づいて求める。そして、ステップＳ２６へ進み、左路側４１から自車両Ｍの左後輪までの距離（必要内輪横位置）Ｗｉを算出する。

すなわち、図７に示すように、左折先の道路幅が狭く、しかも、電柱等の路側に存在する障害物（路側障害物）４２が認識された場合、自車両Ｍを左路側４１に沿って、基本寄せ幅Ｗｏ（例えば、１０～１００[cm]）を確保した状態のまま旋回軌跡Ｒｆで旋回すると、一点鎖線で囲った枠に示すように、右前部コーナが路側障害物４２に接触してしまう可能性がある。

同様に、図８に示すように現在の走行している車線と左折方向の道路との左路側４１の交差部分が大きな曲率（小さい半径）交差している場合、自車両Ｍの左後輪を左路側４１に対し、基本寄せ幅Ｗｏだけ近接した状態のまま左折すると、一点鎖線で囲った上枠に示すように、自車両Ｍの左側面が左路側４１に接触し易くなる。このような場合、一点鎖線で囲った下枠に示すように、左後輪が左路側４１の交差部分に達した付近でハンドルを切ることになるが、自車両Ｍの前部が左折先の道路に大きくはみ出すため、幅の狭い道路では回りきれない可能性がある。

更に、図９に示すように交差点において左路側４１が鋭角な交差角θで交差している場合、一点鎖線で囲った枠に示すように、上述した図８の場合よりも、左側面が左路側４１に接触する可能性が更に高くなる。

図７～図９に示す態様において、自車両Ｍを旋回軌跡Ｒｆで旋回させて左折先の道路にスムーズに進入させるには、必要内輪横位置Ｗｉを、現在走行している車線の中央方向へ設定する必要がある。その際、図８、図９の態様では、自車両Ｍの左後輪が基本寄せ幅Ｗｏを保持した状態で左路側４１の交差部分を通過させるようにする。

又、例えば、図１０に示すように、左折先の道路が狭く、自車両Ｍを左折させるために、自車両Ｍを走行車線の右寄りに移動させても、一点鎖線で囲った枠に示すように、回りきれない場合は、自車両Ｍを交差点で一旦、対向車線側へ大きく膨らませた後、旋回させる必要がある。その結果、必要内輪横位置Ｗｉは車線中央側へ大きく移動させた位置に設定される。

その後、ステップＳ２７へ進み、左路側４１から自車両Ｍの右側面における必要横位置（左折時外横位置）Ｗａを算出して、ルーチンを抜け、図２のステップＳ５へ進む。

この左折時外横位置Ｗａは、自車両Ｍが左折するに際し、走行車線をはみ出すことなく左折できるか否かを調べるために算出するものであり、必要内輪横位置Ｗｉと自車両Ｍの車幅Ｗｍと右余裕幅Ｗαとを加算して求める。

図２のステップＳ５へ進むと、左折時外横位置Ｗａと現在走行している車線（走行車線）の車線幅Ｗｌとを比較し、走行車線を外側へはみ出すことなく左折（旋回）可能か否かを判定する。尚、この車線幅Ｗｌは、ステップＳ２で読込んだ交差点周辺の道路地図情報、或いはステップＳ３で読込んだ前方走行環境情報から取得する。又、このステップＳ５での処理が本発明の旋回可能判定手段に対応している。

そして、Ｗａ＞Ｗｌの場合は左折不可と判定し、ステップＳ６へ進む。又、Ｗａ≦Ｗｌの場合は、左折かと判定し、ステップＳ８へジャンプする。

ステップＳ６へ進むと、左折制御を中止し、ステップＳ７で目標進行路を再度演算してルーチンを抜ける。例えば、図１０に示すように、自車両Ｍを左折先の道路に進入させるためには、自車両Ｍを一旦対向車線側に大きく膨らませる必要がある場合、交差点手前において、Ｗａ＞Ｗｌとなるため、目標進行路を左折以外の走行ルートで再演算させる。その際、目標進行路が直進の場合、自車両Ｍは走行車線の中央（Ｗｌ／２）を走行して交差点に進入される。

一方、Ｗａ≦Ｗｌと判定されてステップＳ８へジャンプすると、交差点に信号機が設置されているか否かを調べる。この信号機の有無は、前方走行環境情報に基づき、パターンマッチング等の手法により認識しても良いが、交差点周辺の道路地図情報に基づいて認識するようにしても良い。そして、交差点に信号機が設置されていないと判定した場合はステップＳ９へ分岐し、又、信号機が設置されていると判定した場合はステップＳ１０へ進む。

ステップＳ９へ分岐すると、前方交差点の入り口に停止線Ｌｓがあるか否かを調べる。停止線Ｌｓの有無は、ステップＳ２で読込んだ交差点周辺の道路地図情報、或いはステップＳ３で読込んだ前方走行環境情報に基づいて判定する。そして、停止線Ｌｓなしと判定された場合はステップＳ１２へジャンプし、一方、停止線Ｌｓありと判定された場合はステップＳ１３へジャンプする。

又、ステップＳ１０へ進むと、ステップＳ３で読込んだ前方走行環境情報に基づいて、信号機の点灯色が青色（青信号）か否か調べる。そして、黄色（黄信号）、或いは赤色（赤信号）の場合はステップＳ１１へ分岐する。又、青色（青信号）の場合はステップＳ１２へ進む。

ステップＳ１１へ進むと、左折矢印信号機が点灯しているか否かを調べる。そして、左矢印信号機が消灯している、或いは左折矢印信号機は検出（設置）されていない場合、信号機は停止信号であるため、自車両Ｍを交差点手前で停止させるべくステップＳ１３へ分岐する。又、左折矢印信号機が点灯していると判定した場合はステップＳ１２へ進む。尚、前方走行環境認識部２１ｄで実行される信号機の点灯色、及び点灯している矢印信号を認識する処理については、本出願人が先に提出した特許第５８５２６３７号公報等で既に知られているため、ここでの説明は省略する。又、上述したステップＳ８～Ｓ１１での処理が本発明の停車判定手段に対応している。

そして、ステップＳ９～Ｓ１１の何れかからステップＳ１２へ進むと、左折制御を継続させる指令を車両制御演算部２３ｂに送信してルーチンを抜ける。

一方、ステップＳ９、或いはステップＳ１１からステップＳ１３へ進むと、自車両Ｍを停止線Ｌｓで停車させる際の横位置（停止線停車横位置）Ｗｙを
Ｗｙ←Ｗｉ＋Ｗｍ／２
から算出し、ステップＳ１４へ進む。この停止線停車横位置Ｗｙは左路側４１から自車両Ｍの車幅方向中央までの距離であり、この停止線停車横位置Ｗｙに目標進行路が設定される。尚、このステップＳ１３での処理が本発明の停止線停車横位置算出手段に対応している。

ステップＳ１４では、自車両Ｍを停止線Ｌｓで停車させる停止線停車制御指令を車両制御演算部２３ｂに送信してルーチンを抜ける。

車両制御演算部２３ｂは、右左折情報取得部２３ａから左折制御継続の指令を受けた場合、各制御部３１～３３を駆動させて、図５に示すように、自車両Ｍを、交差点手前の直進路を走行中に左路側４１側へ所定に幅寄せし、左路側４１に沿って交差点に進入して左折させる。その際、図７に示すように、左折先の道路が狭く、且つ、路側障害物４２が検出されている場合は、徐行しながら自車両Ｍを交差点で外側へやや膨らませ、自車両Ｍの右前部コーナが路側障害物４２に接触しないように旋回させて、左折先の道路に進入させる。

又、図８に示すように、左路側４１が左折先の道路と小さい曲率で交差している場合は、上述と同様、徐行しながら自車両Ｍを交差点で外側へやや膨らませ、自車両Ｍの左後輪が左路側４１の交差部に対し、基本寄せ幅Ｗｏだけ離間した位置を通過させて左折先の道路に進入させる。更に、図９に示すように、左路側４１が左折先の道路と鋭角に交差している場合も、図８と同様、自車両Ｍの左後輪が左路側４１の交差部に対し、基本寄せ幅Ｗｏだけ離間した位置を通過させる。

一方、車両制御演算部２３ｂが、右左折情報取得部２３ａから停止線停車制御指令を受けた場合、各制御部３１～３３を駆動させて、直進路を走行中の自車両Ｍを左路側４１から、上述した左折制御処理ルーチンのステップＳ１３で設定した停止線停車横位置Ｗｙへ移動させる。同時に、道路地図情報、或いは前方走行環境情報に基づき自車両Ｍから停止線Ｌｓまでの距離を測定し、自車両Ｍが停止線Ｌｓの直前で停車するように車速制御を行う（図７～図９参照）。

このように、自車両Ｍが停止線Ｌｓで停車するに際しては、左折方向の道路環境に対応して設定した停止線停車横位置Ｗｙで停車しているため、発進に際し、自車両Ｍを右方向へ一度膨らませる等の操舵制御が不要となり、スムーズに左折旋回させることができる。又、発進時に自車両Ｍを右方向へ膨らませる操舵が不要となるため、後続車の進路を妨害することもない。

尚、本発明は、上述した実施形態に限るものではなく、例えば、左側通行が規定されている道路において、自車両Ｍを左折させるべく、交差点手前の停止線Ｌｓで右寄りに停車させた場合、その後の発進の際に、左路側４１と自車両Ｍとの間をすり抜けようとする自転車、自動二輪等の車両が検出された場合、当該車両が通過するまで停車状態を維持させるようにしても良い。

１…自動運転支援装置、
１１…ロケータユニット、
１２…地図ロケータ演算部、
１２ａ…自車位置推定演算部、
１２ｂ…道路地図情報取得部、
１２ｃ…目標進行路設定演算部、
１３…ＧＮＳＳ受信機、
１４…自律走行センサ、
１５…目的地情報入力装置、
１６…高精度道路地図データベース、
２１…カメラユニット、
２１ａ…メインカメラ、
２１ｂ…サブカメラ、
２１ｃ…画像処理ユニット（ＩＰＵ）、
２１ｄ…前方走行環境認識部、
２３…車両制御ユニット、
２３ａ…右左折情報取得部、
２３ｂ…車両制御演算部、
３１…操舵制御部、
３２…ブレーキ制御部、
３３…加減速制御部、
３４…警報装置、
４１…左路側、
４２…路側障害物、
Ｉｆ…所定撮像領域、
Ｌｓ…停止線、
Ｍ…自車両、
Ｒ…必要左後輪旋回半径、
Ｒｆ…旋回軌跡、
Ｗａ…左折時外横位置、
Ｗｉ…必要内輪横位置、
Ｗｌ…車線幅、
Ｗｍ…車幅、
Ｗｏ…基本寄せ幅、
Ｗｙ…停止線停車横位置、
Ｗα…右余裕幅、
θ…交差角

Claims

自車両の前方の走行環境情報を取得する前方走行環境情報取得手段と、
前記自車両の現在位置を推定する自車位置推定手段と、
前記自車位置推定手段で推定した前記自車両の現在位置と操作者がセットした目的地とに基づき記憶手段に記憶されている道路地図情報から目標進行路を設定する目標進行路設定手段と、
前記目標進行路設定手段で設定した前記目標進行路に沿って前記自車両を走行させる走行制御を行う走行制御手段と
を有する自動運転支援装置において、
前記走行制御手段は、
前記目標進行路設定手段で設定した前記目標進行路に基づき前方の交差点を左側通行が規定されている道路での左折方向又は右側通行が規定されている道路での右折方向へ進路転換するか否かを判定する進路転換判定手段と、
前記進路転換判定手段で進路転換を行うと判定した場合、前記前方走行環境情報取得手段で取得した前記走行環境情報或いは前記道路地図情報に基づき前記交差点の周辺情報を取得し、進路転換先の道路に進入する際の進路転換方向内側の路側を基準とする前記自車両の走行車線での横位置を求める横位置演算手段と、
前記前方走行環境情報取得手段で取得した前記走行環境情報或いは前記道路地図情報に基づき前記交差点の入り口の停止線で前記自車両を停車させるか否かを調べる停車判定手段と、
前記停車判定手段で前記自車両を前記停止線で停止させると判定した場合、前記横位置演算手段で求めた該自車両の横位置に基づき前記停止線で該自車両を停車させる際の停車横位置を算出する停止線停車横位置算出手段と、
進路転換方向の道路への旋回が可能か否かを判定する旋回可能判定手段と
を有し、
前記横位置演算手段は、前記横位置と前記自車両の車幅とに基づいて旋回時外側横位置を求め、
前記旋回可能判定手段は、前記前方走行環境情報取得手段で取得した前記走行環境情報或いは前記道路地図情報に基づき前記自車両が走行している交差点手前の車線の車線幅を取得し、前記旋回時外側横位置が該車線幅以内の場合に旋回可能と判定する
ことを特徴とする自動運転支援装置。
前記旋回可能判定手段は、前記旋回時外側横位置が前記車線幅を超えている場合は旋回不可と判定し、
前記目標進行路設定手段は、前記旋回可能判定手段で旋回不可と判定した場合、前記目標進行路を再演算する
ことを特徴とする請求項１に記載の自動運転支援装置。
前記横位置演算手段は、前記前方走行環境情報取得手段で取得した前記走行環境情報或いは前記道路地図情報に基づき、進路転換方向の道路へ旋回させるために必要な旋回半径と前記自車両を旋回させた際の旋回方向外側前部コーナの旋回軌跡とに基づき前記横位置を求める
ことを特徴とする請求項１或いは２に記載の自動運転支援装置。
前記横位置演算手段で取得する前記交差点の周辺情報は、進路転換先の道路幅、現在走行している車線と前記進路転換先の道路との交差角、前記進路転換先の道路に設けられた路側障害物である
ことを特徴とする請求項１～３何れか１項に記載の自動運転支援装置。