JP5113543B2 - 車両進行路推定装置 - Google Patents

Description

本発明は、自車両の挙動から自車進行路を推定する車両進行路推定装置に関する。

従来、自車両の走行状態に基づいて自車が走行するであろう進行路を推定する技術が種々提案されている。例えば、特許文献１（特開２００３−３０８５９８号公報）には、車速センサで検出した車速、舵角（ハンドル角）センサで検出した操舵角（ハンドル角）、ヨーレートセンサで検出したヨーレート等のパラメータ、及び車載カメラで検出した自車前方の走行環境（白線、ガードレール等）に基づいて自車進行路を推定する技術が開示されている。

更に、同文献には、車間距離制御（ＡＣＣ：Adaptive Cruise Control）システムがＯＮされた場合、車載カメラからの情報に基づき、推定した自車進行路の走行領域内に先行車があるか否かを調べ、先行車が検出された場合は、当該先行車に追従する追従走行制御を実行し、一方、先行車が検出されない場合は、運転者が設定したセット車速で走行する定速走行制御を実行する技術が開示されている。
特開２００３−３０８５９８号公報

しかし、上述した文献に開示されている技術では、例えばヨーレートは自車両が動作した後に検出されるものであるため、ヨーレートセンサで検出したヨーレートに基づいて自車進行路を推定した場合、当該自車進行路と実際の道路形状とにずれが生じる。

例えば、車両がほぼ直線状の走行レーンを走行している際に、運転者は走行レーンのほぼ中央を走行するように心がけるため、車両が走行レーンの一方へ偏った場合には、ステアリングを操作して車両を走行レーンのほぼ中央へ戻す操作を行う。

ヨーレートに基づいて推定する自車進行路は所定曲率のカーブとなるが、その際、運転者が自車両を走行レーンの中央に戻すようなステアリング操作を行った場合、その瞬間は自車両が戻る方向に作用するヨーレートは未だ検出されないため、自車両が実際に走行しようとする方向とは異なる方向に自車進行路（曲線路）が推定されてしまう可能性がある。このことは、舵角センサで検出した操舵角に基づいて自車進行路を推定した場合も同様の問題として生じる。

その結果、ＡＣＣシステムが搭載されている車両では、自車両の実際の走行方向と推定した進行路とが相違するため、先行車を認識することができなかったり、先行車を誤認する可能性がある。

本発明は、上記事情に鑑み、自車進行路を車両の挙動に基づいて推定するに際し、自車進行路を実際の走行方向にほぼ沿った状態で推定することのできる車両進行路推定装置を提供することを目的とする。

上記目的を達成するため本発明は、自車両の運転状態に基づいて自車進行路を推定する車両進行路推定装置において、前記自車両の挙動に基づいて求めた自車進行方向の旋回曲率から第１進行路を設定する第１進行路演算手段と、前記自車両の現在位置を基準として第１設定時間後に到達する前記第１進行路上の位置から接線方向に延出する第２進行路を求める第２進行路演算手段と、前記第２進行路上の、前記自車両の現在位置から前記第１設定時間よりも長い第２設定時間後に到達する位置と該自車両の現在位置を基準として前方の予め設定した遠方到達位置との交点を結んで第３進行路を設定する第３進行路演算手段と、前記第１進行路と前記第２進行路と前記第３進行路とをつないで前記自車両の進行路を想定する進行路演算手段とを備えることを特徴とする。

本発明によれば、自車進行路を自車両の挙動に基づいて求めた所定旋回曲率の第１進行路と、この第１進行路の所定時間経過後の位置から延出させた接線と、この接線の所定時間経過後の位置と自車両前方の所定遠位置との交点を結ぶ進行路とに基づいて自車進行路を想定するようにしたので、自車の直線進行路を実際の走行方向にほぼ沿った状態で推定することができる。

以下、図面に基づいて本発明の一実施形態を説明する。図１に走行制御装置を搭載した車両の概略構成図を示す。

図１の符号１は自動車等の車両（自車両）であり、この車両１に、車両１の運転状態を制御する制御ユニット２が搭載されている。この制御ユニット２は、マイクロコンピュータを主体に構成され、周知のＣＰＵ、ＲＯＭ、ＲＡＭ、及びＥＥＰＲＯＭ等の不揮発性記憶手段等を有している。ＣＰＵは、ＲＯＭに記憶されている制御プログラムに従い、各センサ・スイッチ類からの検出信号等を処理し、ＲＡＭに格納される各種データ、及び不揮発性メモリに格納されている各種学習値データ等に基づき、エンジン制御、ブレーキ制御等の車両走行制御を行う。

この制御ユニット２の入力側に、自車両１の前方を撮像し、その画像から自車両前方の走行環境を認識する前方認識装置３、自車両１の車速（自車速）Ｖ[Km/h]を検出する車速センサ４、ＡＣＣ制御をＯＮ/ＯＦＦするクルーズスイッチ５、ステアリングコラムに配設されているターンシグナルスイッチ１１、ステアリングホイール１０に連設するステアリング軸に連設されてステアリングホイール１０の回転角である操舵角θｓｔを検出する舵角センサ１２、車体に作用するヨーレートγを検出するヨーレートセンサ１３、スロットル弁の開度を検出するスロットル開度センサ８ｂ等が接続されている。

又、この制御ユニット２の出力側に、速度メータ、回転メータ等が所定に配設されているコンビネーションメータ６が接続されており、更に、エンジン７の吸気系に配設されている電子制御スロットル装置８に設けられていると共にスロットル弁を開閉動作させるスロットルアクチュエータ８ａ、及びブレーキブースタ９が接続されている。ブレーキブースタ９は、４輪に併設されているブレーキホイールシリンダ９ａに対してブレーキ油圧を強制的に供給するものであり、ブレーキブースタ９を介して各ブレーキホイールシリンダ９ａにブレーキ油圧が供給されると各車輪が制動され、走行中の自車両１は強制的に減速される。

前方認識装置３にステレオカメラ３ａとステレオ画像処理部３ｂが設けられている。ステレオカメラ３ａは、ステレオ光学系として例えば電荷結合素子（ＣＣＤ）等の固体撮像素子を用いた左右一対のＣＣＤカメラで構成されている。この各ＣＣＤカメラは、それぞれ車室内の天井前方に一定の間隔を持って取り付けられ、車外の対象を異なる視点からステレオ撮像し、画像データをステレオ画像処理部３ｂに入力する。

又、ステレオ画像処理部３ｂは、左右一対のステレオカメラ３ａで撮像した、自車両１の前方のステレオ画像に対し、対応する位置のずれ量から距離情報を求めて距離画像を生成する。そして、このデータを基に自車両１前方の走行環境を認識する共に、自車両１前方の走行領域を走行する先行車を検出した場合、自車両と先行車との相対距離Ｌｓ、及び相対車速Ｖｓを求める。そして、認識した走行環境の情報や相対距離Ｌｓ、相対車速Ｖｓ等の各種データを制御ユニット２へ出力する。

又、先行車と自車両１との車間距離を適切に維持した状態で走行するＡＣＣ制御は制御ユニット２で実行される。ＡＣＣ制御は、ステレオ画像処理部３ｂで認識した先行車に関する情報と、車速センサ４で検出した自車速Ｖとに基づき、先行車と自車両１との車間距離を適切に維持する制御が行われる。このＡＣＣ制御は、クルーズスイッチ５をＯＮすることで起動される。

すなわち、クルーズスイッチ５がＯＮされると、制御ユニット２はステレオ画像処理部３ｂで認識した先行車情報を読込み、自車両１前方の進行路（自車進行路）に先行車が走行しているか否かを識別する。そして、先行車が検出されていない場合は、運転者が設定したセット車速に自車両１の車速Ｖを維持させる定速走行制御を行う。又、先行車が検出され、且つ先行車の車速がセット車速以下の場合は先行車に対して所定の車間距離を維持した状態で追従する追従走行制御が実行される。

定速走行制御では、セット車速を目標車速として設定し、電子制御スロットル装置８に設けられているスロットルアクチュエータ８ａの動作によりスロットル弁を開閉動作させ、自車速Ｖを目標車速に維持させる制御を行う。又、追従走行制御では、先行車の車速に基づいて目標車間距離を設定し、この目標車間距離を維持するための目標車速を設定し、自車速Ｖが目標車速となるようにスロットルアクチュエータ８ａを介してスロットル弁を開閉制御する。

その際、先行車がブレーキを作動させる等して減速した結果、自車両１と先行車との車間距離が目標車間距離よりも短くなり、エンジンブレーキだけでは、車間距離を目標車間距離まで戻すことが出来ない場合は、ブレーキブースタ９を作動させ、４輪に併設されているブレーキホイールシリンダ９ａに対してブレーキ油圧を供給し、各車輪を強制的に制動させて減速させる自動ブレーキ制御が実行される。

又、追従走行制御中に先行車の離脱が検出された場合、ＡＣＣ制御では走行制御を追従走行制御から定速走行制御へ切換え、予め設定されている加速度に従って自車速Ｖをセット車速まで増速させる過渡制御を実行する。

このようにＡＣＣ制御、及び自動ブレーキ制御では、先ず、自車進行路を推定する必要がある。本実施形態では、自車進行路を推定するに際し、基本進行路Ｒｏを、自車両１の挙動に応じて、直線進行路、右左折後半進行路、曲線進行路の３パターンから選択し、選択した基本進行路Ｒｏを補正して最終的な自車進行路Ｒを推定する。

制御ユニット２で処理される自車進行路推定は、具体的には、図２〜図８に示すフローチャートに従って行われる。

運転者がイグニッションスイッチをＯＮした後、クルーズスイッチ５をＯＮすると、図１に示す自車進行路選択ルーチンが、設定演算周期毎に起動される。このルーチンでは、先ず、ステップＳ１で、ターンシグナルスイッチ１１がＯＮされたか否かを調べる。そして、ターンシグナルスイッチ１１がＯＮのときはステップＳ２へ進み、ＯＦＦのときはステップＳ３へ分岐する。

ステップＳ２へ進むと、舵角センサ１２で検出した操舵角θｓｔの変化に基づいて算出した、ステアリングホイール１０の戻し角θｓｒの絶対値｜θｓｒ｜と、予め設定されている戻し大舵角判定値θｓｒｏとを比較する。そして、｜θｓｒ｜≧θｓｒｏの場合は、図１０（ｂ）に示すように、自車両１が右折或いは左折（以下、便宜的に「右左折」と称する）の後半を想定した進行路を走行していると判定し、ステップＳ４へ進み、進行路判定フラグＦＬの値を、右左折後半進行路を示す「１」でセットして（ＦＬ←１）、ルーチンを抜ける。又、｜θｓｒ｜＜θｓｒｏの場合は、ステップＳ３へ分岐する。

そして、ステップＳ１或いはステップＳ２からステップＳ３へ進むと、ステレオ画像処理部３ｂで認識した情報に基づき、進行路上に描画されている白線を検出し、ステップＳ５で白線がほぼ直線か否かを調べる。そして、白線がほぼ直線と認識された場合、ステップＳ６へ進み、又、白線が曲線と認識され、或いは白線が検出されなかった場合はステップＳ９へジャンプする。

ステップＳ６へ進むと、操舵角θｓｔと予め設定されている大転舵判定値θｓｔｏとを比較する。そして、θｓｔ≦θｓｔｏの小転舵或いは転舵無しと判定されたときはステップＳ７へ進み、θｓｔ＞θｓｔｏの大転舵と判定されたときはステップＳ９へジャンプする。又、ステップＳ７へ進むと、操舵角θｓｔの変化に基づいて算出した転舵速度ωθと予め設定されている急転舵判定値ωθｏとを比較する。そして、ωθ≦ωθｏの緩転舵と判定されたときは、直線を想定した進行路を走行していると判定し、ステップＳ８へ進み、進行路判定フラグＦＬの値を、直線進行路を示す「０」でセットして（ＦＬ←０）、ルーチンを抜ける。又、ωθ＞ωθｏの大転舵と判定されたときはステップＳ９へ進む。

そして、ステップＳ５、ステップＳ６、或いはステップＳ７からステップＳ９へ分岐すると、曲線を想定した進行路を走行していると判定し、進行路判定フラグＦＬの値を、曲線進行路を示す「２」でセットして（ＦＬ←２０）、ルーチンを抜ける。

上述した進行路判定フラグＦＬの値は、図３に示す自車進行路設定サブルーチンにおいて読込まれる。このルーチンは、設定演算周期毎に実行され、先ず、ステップＳ１１，Ｓ１２で進行路判定フラグＦＬの値を参照する。そして、ＦＬ＝０のときはステップＳ１３へ進み、直線進行路想定処理を実行して、ステップＳ１６へ進む。又、ＦＬ＝１のときは、ステップＳ１４へ進み、右左折後半進行路想定処理を実行して、ステップＳ１６へ進む。又、ＦＬ＝２のときは、ステップＳ１５へ進み、曲線進行路想定処理を実行して、ステップＳ１６へ進む。

ステップＳ１３で実行される直線進行路想定処理は、図４に示す直線進行路想定サブルーチンに従って行われる。このサブルーチンでは、先ず、ステップＳ２１で、自車両１の挙動を表すパラメータとして車速センサ４で検出した車速Ｖと、舵角センサ１２で検出した操舵角θｓｔとを読込み、ステップＳ２２で車速Ｖと操舵角θｓｔとに基づき、自車進行方向の旋回曲率ｒを求め、この旋回曲率ｒに基づいて第１進行路としての曲線路Ｌ１を設定する。尚、ステップＳ２２での処理が本発明の第１進行路演算手段に対応している。

次いで、ステップＳ２３で曲線路Ｌ１の、自車両１の現在位置を基準として予め設定した第１設定時間としての時間Ｔａ秒（例えば２秒）後に到達する位置（Ｖ・Ｔａ）から延出する第２進行路としての接線路Ｌ２を求める。尚、このステップＳ２３での処理が本発明の第２進行路演算手段に対応している。

その後、ステップＳ２４へ進み、自車両１の進行方向正面の遠方設定距離ｍｐ（例えば１２０[ｍ]）の到達点（遠方到達位置）Ｐｚと、自車両１の現在位置を基準として、時間Ｔａよりも長い予め設定した第２設定時間としての時間Ｔｂ秒（例えば４秒）後に到達する位置（Ｖ・Ｔｂ）にある接線路Ｌ２とを結ぶ第２進行路としての直線路Ｌ３を設定する（図９(a)参照）。尚、ステップＳ２４での処理が本発明の第３進行路演算手段に対応している。

そして、ステップＳ２５へ進み、設定した各線路Ｌ１，Ｌ２，Ｌ３をつないで直線進行路を想定した基本進行路Ｒｏを推定し（図９(b)参照）、図３のステップＳ１６へ進む。尚、ステップＳ２５での処理が進行路演算手段に対応している。

自車両１が直線路を走行している状態において、ステアリングホイール１０が僅かに転舵されることにより、自車両１が走行レーンの一方に偏った場合、運転者はステアリングホイール１０を逆方向へ転舵させて、自車両１を走行レーンの中央に戻そうとする。例えば、自車両１が高速道路を高速で走行している場合、ステアリングホイール１０を大きく転舵させることができないため、自車両１が走行レーンの中央に復帰されると予想される位置（遠方到達点Ｐｚ）の白線は、ステレオカメラ３ａでは認識できない可能性がある。そのため、本実施形態では、自車進行路として直線を想定した場合、最初の曲線路Ｌ１に基づいて遠方到達点Ｐｚまでの進行路を推定する。

ところで、一般に、自車進行路をヨーレートγに基づいて推定する場合、ヨーレートγは自車両１の挙動を検出するものであるため、ヨーレートγを検出して自車進行路を修正することになる。その結果、直線路を走行中に自車両１の進行方向が隣の走行レーン側に傾いた場合、そのときのヨーレートγに基づいて自車進行路が隣の走行レーン方向に修正されるため、自車両１が走行している走行レーンの前方を走行している先行車を見失ってしまう可能性がある。

これに対し、本実施形態では、自車進行路として直線が想定されている場合は、遠方到達点Ｐｚにおいて自車両１が走行レーンの中央に復帰されるとの前提で、基本進行路Ｒｏを想定しているため、比較的早期に自車両１の走行している走行レーン前方の先行車を認識することができる。尚、基本進行路Ｒｏは後述するように、走行環境に応じて補正されるため、自車進行路が直線と想定されても、実際の走行レーンが曲線路等である場合には、最終的に求める自車進行路が修正されるため、最終的には走行レーンに沿った自車進行路を推定することができる。

又、図３のステップＳ１４で実行される右左折後半進行路想定処理は、図５に示す右左折後半進行路想定サブルーチンに従って行われる。このサブルーチンでは、先ず、ステップＳ３１で、車速センサ４で検出した車速Ｖと、舵角センサ１２で検出した操舵角θｓｔとを読込み、ステップＳ３２で車速Ｖと操舵角θｓｔとに基づき、自車進行方向の旋回曲率ｒを求め、この旋回曲率ｒに基づいて曲線路Ｌ１を設定する。次いで、ステップＳ３３で曲線路Ｌ１の、自車両１の現在位置を基準として予め設定した時間Ｔｃ秒（例えば１秒）後に到達する位置（Ｖ・Ｔｃ）からの接線路Ｌ２を求める（図１０(a)参照）。

その後、ステップＳ３４へ進み、設定した各線路Ｌ１，Ｌ２をつないで基本進行路Ｒｏを推定し（図１０(b)参照）、図３のステップＳ１６へ進む。

尚、図３のステップＳ１４で実行される右左折後半進行路想定処理は、図６に示す右左折後半進行路想定サブルーチンに従って簡易的に行うようにしても良い。

すなわち、このサブルーチンでは、先ず、ステップＳ４１で、舵角センサ１２で検出した操舵角θｓｔを読込み、ステップＳ４２で、操舵角θｓｔに舵角補正値θｋ（予め設定されている固定値）を加算した値（θｓｔ＋θｋ）に基づいて直線路Ｌ４を求める（図１１参照）。そして、この直線路Ｌ４に基づき基本進行路Ｒｏを推定し、図３のステップＳ１６へ進む。

ところで、ヨーレートγに基づいて自車進行路を推定する場合、ステアリングホイール１０を戻している右左折後半であっても、ヨーレートγが検出されているため、推定する自車進行路は大きな曲線となる。その結果、自車両１の進行方向と推定した自車進行路とが一致せず、自車両１前方の先行車を認識することができなくなる。

これに対し、本実施形態では、自車進行路が右左折後半進行路と想定した場合は、操舵角θｓｔに基づいて、基本進行路Ｒｏを推定するようにしているため、ステアリングホイール１０を戻している右左折後半（図１０(b)の状態）であっても、自車両１の進行方向にほぼ沿った基本進行路Ｒｏを推定することができる。

又、図３のステップＳ１５で実行される曲線進行路想定処理は、図７に示す曲線進行路想定サブルーチンに従って行われる。

このサブルーチンでは、先ず、ステップＳ５１で、ヨーレートセンサ１３で検出した車体に作用するヨーレートγ、舵角センサ１２で検出した操舵角θｓｔを読込み、ステップＳ５２で、ヨーレートγに基づいて曲線路Ｌ５ａを設定する。又、ステップＳ５３へ進むと、操舵角θｓｔに基づいて曲線路Ｌ５ｂを設定する（図１２参照）。尚、ヨーレートγ、或いは操舵角θｓｔに基づいて曲線路Ｌ５ａ，Ｌ５ｂを算出する方法は、例えば特許文献１に開示されている。

すなわち、曲線路Ｌ５ａは、
Ｌ５ａ＝γ／Ｖ
により算出する。

又、曲線路Ｌ５ｂは、
Ｌ５ｂ＝１／（（１＋Ａ・Ｖ^２）・（Ｌｂ／θｓｔ））
から算出する。ここで、Ａは車両のスタビリティファクタ、Ｌｂはホイールベースである。

その後、ステップＳ５４へ進み、曲線路Ｌ５ａに基づいて設定した走行領域と曲線路Ｌ５ｂに基づいて設定した走行領域との少なくとも一方に、先行車が存在しているか否かを、ステレオ画像処理部３ｂで認識した情報に基づいて調べる。そして、先行車が存在している場合は、ステップＳ５５へ進み、又、先行車が検出されない場合はステップＳ５６へ分岐する。

ステップＳ５５へ進むと、曲線路Ｌ５ａ，Ｌ５ｂのうちで、先行車に近い方の曲線路を選択し、ステップＳ５７で選択した曲線路に基づいて基本進行路Ｒｏを推定して、図３のステップＳ１６へ進む。一方、ステップＳ５４からステップＳ５６へ分岐すると、ヨーレートγに基づいて設定した曲線路Ｌ５ａから基本進行路Ｒｏを想定して、図３のステップＳ１６へ進む。従って、曲線進行路想定処理では、先行車が曲線路Ｌ５ｂに近い位置に存在している場合以外は、ヨーレートγに基づいて設定した曲線路Ｌ５ａにて、基本進行路Ｒｏが設定されることになる。

又、図３のステップＳ１６で実行される自車進行路推定処理は、図８に示す自車進行路推定サブルーチンに従って行われる。このサブルーチンでは、先ず、ステップＳ６１〜Ｓ６３で、ステレオ画像処理部３ｂからの情報に基づき、自車両１前方の走行環境を調べ、ステップＳ６４〜Ｓ７０で、走行環境に応じた進行路補正値ｋを設定する。

すなわち、ステップＳ６１では、白線が認識されているか否かを調べ、白線が認識されている場合は（図１３(a)参照）、ステップＳ６４へ進み、白線が認識されていない場合はステップＳ６２へ分岐する。ステップＳ６２では、直近（自車走行レーン前方や隣接する走行レーン等）に順方向（自車両１と同方向）へ移動する移動体があるか否かを調べる。この移動体は車両と認識されている必要はなく、自車両１の直近を順方向へ移動している一連の移動体群が対象となる。

そして、当該移動体が認識されている場合はステップＳ６６へ進み、認識されていない場合はステップＳ６３へ分岐する。ステップＳ６３では、ガードレールが認識されているか否かを調べ、認識されている場合はステップＳ６８へ進み、認識されていない場合はステップＳ７０へ分岐し、進行路補正値ｋをクリアして（ｋ←０）、ステップＳ７１へ進む。尚、本実施形態では側壁もガードレールと認識される。

そして、白線が認識されていると判定されてステップＳ６４へ進むと、白線に並行する補正進行路ｋ１を設定する。すなわち、先ず、認識されている白線のエッジ或いは中央を示す一連の座標に基づき、当該座標を結ぶ線の自車進行方向に対する傾きを求め、この傾きに基づいて、補正進行路ｋ１を設定する。その後、ステップＳ６５で、当該補正進行路ｋ１で進行路補正値ｋを設定し（ｋ←ｋ１）、ステップＳ７１へ進む。

又、白線は認識されていないが、側近に順方向移動体が認識されていると判定されてステップＳ６２へ進むと、順方向へ移動している移動体群に並行する補正進行路ｋ２を設定する。この補正進行路ｋ２は認識した各移動体の横方向速度Ｖｘを求めその平均値である平均横方向速度ＡＶｘと予め設定した時間Ｔｄ秒（例えば３秒）とに基づき、
ｋ２←ＡＶ・Ｔｄ・α
から算出する。尚、αは補正係数（固定値）である。

上式から明らかなように、補正進行路ｋ２はＴｄ秒の横方向の目標到達点（Ｔｄ秒後の位置）に達するまでの距離情報となる。この場合、直線路では各移動体の横方向速度Ｖｘがほぼ０となるため、ｋ２≒０となる。

本実施形態は、自車両１の直近を順方向へ移動する一連の移動体群を検出対象としているので、図１３（ｂ）に示すように、当該移動体群が曲線路を同じ方向へ移動している場合には、走行レーンが曲線であると推定することができる。又、移動体群中の一台が分岐路へ進入しても、平均横方向速度ＡＶｘの値が大きくずれることがないため、補正進行路ｋ２が分岐路側に設定されてしまうこともない。

その後、ステップＳ６７へ進み、補正進行路ｋ２で進行路補正値ｋを設定し（ｋ←ｋ２）、ステップＳ７１へ進む。

又、白線及び順方向移動体は認識されていないが、ガードレールが認識されていると判定されてステップＳ６８へ進むと、ガードレールに並行する補正進行路ｋ３を設定する。すなわち、先ず、認識されているガードレールのエッジ或いは中央を示す一連の座標に基づき、当該座標を結ぶ線の自車進行方向に対する傾きを求め、この傾きに基づいて、補正進行路ｋ３を設定する。

次いで、ステップＳ６９へ進み、当該補正進行路ｋ３で進行路補正値ｋを設定し（ｋ←ｋ３）、ステップＳ７１へ進む。尚、上述したステップＳ６１〜Ｓ７０までの処理が、本発明の補正進行路演算手段に対応している。

ステップＳ７１では、基本進行路Ｒｏを進行路補正値ｋで修正して、最終的な自車進行路Ｒを算出する。具体的には、基本進行路Ｒｏに進行路補正値ｋを加算し、その平均から自車進行路Ｒを算出する（Ｒ←（Ｒｏ＋ｋ）／２））。尚、ステップＳ７１での処理が本発明の自車進行路推定手段に対応している。

その結果、例えば高速道路の緩いカーブを大転舵判定値θｓｔｏ以下の操舵角θｓｔで走行している場合、図２のステップＳ６では、θｓｔ≦θｓｔｏと判定されるため、進行路が直線進行路（ＦＬ←０）と想定される可能性が高いが、白線や順方向へ移動する移動体群やガードレールに基づいて設定された進行路補正値ｋで、基本進行路Ｒｏが補正されるため、最終的には曲線路に沿った自車進行路Ｒを推定することができる。

尚、この自車進行路Ｒは、ＡＣＣ制御装置や自動ブレーキ制御装置にて読込まれ、自車進行路Ｒに基づいて設定された自車両１の走行領域に先行車等の障害物があるか否かが調べられる。

走行制御装置が搭載されている車両の概略構成図 自車進行路選択ルーチンを示すフローチャート 自車進行路設定サブルーチンを示すフローチャート 直線進行路想定サブルーチンを示すフローチャート 右左折後半進行路想定サブルーチンを示すフローチャート 別態様による右左折後半進行路想定サブルーチンを示すフローチャート 曲線進行路想定サブルーチンを示すフローチャート 自車進行路推定サブルーチンを示すフローチャート 直線進行路を想定した基本進行路の作成手順を示す説明図 右左折を想定した基本進行路の作成手順を示す説明図 別態様による右左折を想定した基本進行路の作成手順を示す説明図 曲線進行路を想定した基本進行路の作成手順を示す説明図 補正進行路を設定する際の走行環境を表す説明図

符号の説明

１…自車両、
２…制御ユニット、
３…前方認識装置、
４…車速センサ、
１０…ステアリングホイール、
１２…舵角センサ、
１３…ヨーレートセンサ、
ＡＶｘ…平均横方向速度、
Ｌ１…曲線路、
Ｌ２…接線路、
Ｌ３，Ｌ４…直線路、
Ｌ５ａ，Ｌ５ｂ…曲線路、
Ｐｚ…遠方到達点、
Ｒ…自車進行路、
Ｒｏ…基本進行路、
Ｔａ，Ｔｂ，Ｔｃ，Ｔｄ…時間、
Ｖ…自車速、
Ｖｓ…相対車速、
Ｖｘ…横方向速度、
ｋ…進行路補正値、
ｋ１，ｋ２，ｋ３…補正進行路、
Ｌ５ａ，Ｌ５ｂ…曲線路、
ｒ…旋回曲率、
θｓｔ…操舵角、

Claims (3)

1. 自車両の運転状態に基づいて自車進行路を推定する車両進行路推定装置において、
   前記自車両の挙動に基づいて求めた自車進行方向の旋回曲率から第１進行路を設定する第１進行路演算手段と、
   前記自車両の現在位置を基準として第１設定時間後に到達する前記第１進行路上の位置から接線方向に延出する第２進行路を求める第２進行路演算手段と、
   前記第２進行路上の、前記自車両の現在位置から前記第１設定時間よりも長い第２設定時間後に到達する位置と該自車両の現在位置を基準として前方の予め設定した遠方到達位置との交点を結んで第３進行路を設定する第３進行路演算手段と、
   前記第１進行路と前記第２進行路と前記第３進行路とをつないで前記自車両の進行路を想定する進行路演算手段と
   を備えることを特徴とする車両進行路推定装置。
2. 前記自車両の走行環境に基づいて補正進行路を求める補正進行路演算手段と、
   前記直線進行路演算手段で推定した前記直線進行路を前記補正進行路で補正して最終的な自車進行路を推定する自車進行路推定手段と
   を備えることを特徴とする請求項１記載の車両進行路推定装置。
3. 前記補正進行路演算手段で求める前記補正進行路は、少なくとも自車両の近くを順方向へ走行する一連の移動体群を検出し、該移動体群の移動方向に基づいて設定される
   ことを特徴とする請求項２記載の車両進行路推定装置。

Images