JP3941677B2 - 車線逸脱防止装置 - Google Patents
車線逸脱防止装置 Download PDFInfo
- Publication number
- JP3941677B2 JP3941677B2 JP2002342055A JP2002342055A JP3941677B2 JP 3941677 B2 JP3941677 B2 JP 3941677B2 JP 2002342055 A JP2002342055 A JP 2002342055A JP 2002342055 A JP2002342055 A JP 2002342055A JP 3941677 B2 JP3941677 B2 JP 3941677B2
- Authority
- JP
- Japan
- Prior art keywords
- lane
- vehicle
- lane marker
- marker
- detected
- 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.)
- Expired - Lifetime
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Regulating Braking Force (AREA)
- Traffic Control Systems (AREA)
Description
【発明の属する技術分野】
本発明は、走行中に自車両が走行車線から逸脱しそうになったときに、その逸脱を防止する車線逸脱防止装置に関するものである。
【0002】
【従来の技術】
従来、このような車線逸脱防止装置としては、例えば自車両が走行車線から逸脱しそうになるのを判断し、走行車線の基準位置に対する自車両の走行位置の横ずれ量に応じて、運転者が容易に打ち勝てる程度の操舵制御トルクを操舵アクチュエータにより出力することで車線逸脱を防止するものがある(例えば特許文献1参照)。
【0003】
また、この車線逸脱防止装置では、操舵アクチュエータを必要とするため、例えばアンチスキッド制御装置や駆動力制御装置を用いて各車輪の制動力或いは駆動力を制御し、その結果、車両にヨーモーメントを発生せしめて自車両の走行方向、或いは走行位置を制御することが考えられる。
また、このような車線逸脱防止装置では、常に車線を検出し続けることが望まれる。そこで、例えば操舵角を道路パラメータとし、その道路パラメータから白線等のレーンマーカモデルを設定するものがある(例えば特許文献2参照)。
【0004】
【特許文献1】
特開平11−96497号公報
【特許文献2】
特開平11−296660号公報
【0005】
【発明が解決しようとする課題】
ところで、通常、走行車線を正しく検出するためには、当該走行車線の両側の白線等のレーンマーカを検出する必要がある(走行車線は二本のレーンマーカの間に存在する)。従って、従来の車線逸脱防止装置では、走行車線両側のレーンマーカを検出できないときには、走行車線を正しく検出できていないとして、車線逸脱防止制御を中止している。しかしながら、少なくとも逸脱方向のレーンマーカが検出できているときは、逸脱防止制御自体は成立するので、このような場合に制御を中止してしまうと、運転者の感覚との間にずれが生じ、違和感となっている。
【0006】
本発明はこれらの諸問題に鑑みて開発されたものであり、運転者の感覚との間のずれをなくし、違和感を払拭することが可能な車線逸脱防止装置を提供することを目的とするものである。
【0007】
【課題を解決するための手段】
前記課題を解決するために、本発明の車線逸脱防止装置は、自車両の走行車線の両側のレーンマーカから当該走行車線を検出し、自車両が走行車線から逸脱傾向にあることが検出されたときに、自車両の走行車線からの逸脱を回避する方向にヨーモーメントが発生するように車両の挙動を制御すると共に、自車両の走行車線の片側のレーンマーカしか検出できず且つその検出されたレーンマーカが逸脱方向のレーンマーカであるときには、前記ヨーモーメントを発生させる車両の挙動制御を行うことを特徴とするものである。
【0008】
【発明の効果】
而して、本発明の車線逸脱防止装置によれば、自車両の走行車線の両側のレーンマーカから当該走行車線を検出し、自車両が走行車線から逸脱傾向にあることが検出されたときに、自車両の走行車線からの逸脱を回避する方向にヨーモーメントが発生するように車両の挙動を制御すると共に、自車両の走行車線の片側のレーンマーカしか検出できず且つその検出されたレーンマーカが逸脱方向のレーンマーカであるときには、前記ヨーモーメントを発生させる車両の挙動制御を継続して行う構成としたため、検出されている片側のレーンマーカが逸脱方向であるときに、運転者の感覚とずれがなく、違和感を払拭することができる。
【0009】
【発明の実施の形態】
以下、本発明の車線逸脱防止装置の第1実施形態を添付図面に基づいて説明する。
図1は、本実施形態の車線逸脱防止装置の一例を示す車両概略構成図である。この車両には、自動変速機及びコンベンショナルディファレンシャルギヤを搭載した後輪駆動車両であり、制動装置は、前後輪とも、左右輪の制動力を独立に制御可能としている。
【0010】
図中の符号1はブレーキペダル、2はブースタ、3はマスタシリンダ、4はリザーバであり、通常は、運転者によるブレーキペダル1の踏込み量に応じ、マスタシリンダ3で昇圧された制動流体圧が、各車輪5FL〜5RRの各ホイールシリンダ6FL〜6RRに供給されるようになっているが、このマスタシリンダ3と各ホイールシリンダ6FL〜6RRとの間には制動流体圧制御回路7が介装されており、この制動流体圧制御回路7内で、各ホイールシリンダ6FL〜6RRの制動流体圧を個別に制御することも可能となっている。
【0011】
前記制動流体圧制御回路7は、例えばアンチスキッド制御やトラクション制御に用いられる制動流体圧制御回路を利用したものであり、この実施形態では、各ホイールシリンダ6FL〜6RRの制動流体圧を、単独で増減圧することができるように構成されている。この制動流体圧制御回路7は、後述する制駆動力コントロールユニット8からの制動流体圧指令値に応じて各ホイールシリンダ6FL〜6RRの制動流体圧を制御する。
【0012】
また、この車両は、エンジン9の運転状態、自動変速機10の選択変速比、並びにスロットルバルブ11のスロットル開度を制御することにより、駆動輪である後輪5RL、5RRへの駆動トルクを制御する駆動トルクコントロールユニット12が設けられている。エンジン9の運転状態制御は、例えば燃料噴射量や点火時期を制御することによって制御することができるし、同時にスロットル開度を制御することによっても制御することができる。なお、この駆動トルクコントロールユニット12は、単独で、駆動輪である後輪5RL、5RRの駆動トルクを制御することも可能であるが、前述した制駆動力コントロールユニット8から駆動トルクの指令値が入力されたときには、その駆動トルク指令値を参照しながら駆動輪トルクを制御する。
【0013】
また、この車両には、自車両の走行車線逸脱防止判断用に走行車線内の自車両の位置を検出するための外界認識センサとして、CCDカメラ13及びカメラコントローラ14を備えている。このカメラコントローラ14では、CCDカメラ13で捉えた自車両前方の撮像画像から、例えば白線等のレーンマーカを検出して走行車線を検出すると共に、その走行車線に対する自車両のヨー角φ、即ち車線に対する自車両の向き、走行車線中央からの横変位X、走行車線の曲率β、走行車線幅L等を算出することができるように構成されている。なお、このカメラコントローラ14は、後述するようにレーンマーカ等を検出するための走行車線検出エリアを用いて走行車線検出を行い、その検出された走行車線に対して前記各データを算出する。
【0014】
また、この車両には、自車両に発生する前後加速度Xg及び横加速度Ygを検出する加速度センサ15、自車両に発生するヨーレートφ' を検出するヨーレートセンサ16、前記マスタシリンダ3の出力圧、所謂マスタシリンダ圧Pm を検出するマスタシリンダ圧センサ17、アクセルペダルの踏込み量、即ちアクセル開度Accを検出するアクセル開度センサ18、ステアリングホイール21の操舵角δを検出する操舵角センサ19、各車輪5FL〜5RRの回転速度、所謂車輪速度Vwi (i=FL〜RR)を検出する車輪速度センサ22FL〜22RR、方向指示器による方向指示操作を検出する方向指示スイッチ20が備えられ、それらの検出信号は前記制駆動力コントロールユニット8に出力される。また、前記カメラコントローラ14で検出された走行車線に対する自車両のヨー角φ、走行車線中央からの横変位X、走行車線の曲率β、走行車線幅L等や、駆動トルクコントロールユニット12で制御された駆動トルクTwも合わせて制駆動力コントロールユニット8に出力される。なお、検出された車両の走行状態データに左右の方向性がある場合には、何れも左方向を正方向とする。即ち、ヨーレートφ' や横加速度Yg、操舵角δ、ヨー角φは、左旋回時に正値となり、横変位Xは、走行車線中央から左方にずれているときに正値となる。
【0015】
次に、前記制駆動力コントロールユニット8で行われる演算処理のロジックについて、図2のフローチャートに従って説明する。この演算処理は、例えば10msec. 毎の所定サンプリング時間ΔT毎にタイマ割込によって実行される。なお、このフローチャートでは通信のためのステップを設けていないが、演算処理によって得られた情報は随時記憶装置に更新記憶されると共に、必要な情報は随時記憶装置から読出される。
【0016】
この演算処理では、まずステップS110で、前記各センサやコントローラ、コントロールユニットからの各種データを読込む。具体的には、前記各センサで検出された前後加速度Xg、横加速度Yg、ヨーレートφ' 、各車輪速度Vwi 、アクセル開度Acc、マスタシリンダ圧Pm 、操舵角δ、方向指示スイッチ信号、また駆動トルクコントロールユニット12からの駆動トルクTwを読込む。また、このステップS110では、合わせて、読込んだ各車輪速度Vwi のうち、非駆動輪である前左右輪速度VwFL、VwFRの平均値から自車両の走行速度Vを算出する。なお、この時点では、カメラコントローラ14からの走行車線に対する自車両のヨー角φ、走行車線中央からの横変位X、走行車線の曲率β、走行車線幅Lは未だ読込まない。
【0017】
次にステップS120に移行して、例えば前記特開平11−296660号公報に記載される手法を用い、前記ステップS110で読込んだ操舵角δに基づいて後述する走行車線検出エリア、具体的にはレーンマーカ検出エリアを設定し、その設定されたレーンマーカ検出エリアに基づいて自車両が走行している走行車線の両側のレーンマーカを検出し、そのレーンマーカを用いて自車両が走行している走行車線を検出するように前記カメラコントローラ14に指示し、合わせて当該走行車線に対する自車両のヨー角φ、走行車線中央からの横変位X、走行車線の曲率β、走行車線幅Lを算出し、それらのデータを読込む。
【0018】
次にステップS130に移行して、前記ステップS120において自車両の走行車線の両側のレーンマーカが検出されているか否かを判定し、両側のレーンマーカが検出されている場合にはステップS140に移行し、そうでない場合にはステップS150に移行する。
前記ステップS150では、前記ステップS120において自車両の走行車線の何れか片側のレーンマーカだけが検出されているか否かを判定し、片側のレーンマーカだけが検出されている場合にはステップS160に移行し、そうでない場合にはステップS170に移行する。
【0019】
前記ステップS160では、検出されているレーンマーカが自車両の走行車線逸脱側のレーンマーカであるか否かを判定し、検出されているレーンマーカが逸脱側である場合には前記ステップS140に移行し、そうでない場合には前記ステップS170に移行する。
ここで、逸脱方向側のレーンマーカか田舎の判定は、例えば下記(1)又は(2)が成立した場合に逸脱方向側であると判定し、そうでない場合には逸脱方向側ではないと判定する。
【0020】
(1)前記ステップS120において左レーンマーカが検出され、且つ前回の演算時に後述するステップS190において算出された推定横変位Xsが正値である。
(2)前記ステップS120において右レーンマーカが検出され、且つ前回の演算時に後述するステップS190において算出された推定横変位Xsが負値である。
【0021】
前記ステップS170では、逸脱防止制御許可フラグFを“0”のリセット状態としてからステップS180に移行する。
また、前記ステップS140では、前記逸脱防止制御許可フラグFを“1”のセット状態としてから前記ステップS180に移行する。
前記ステップS180では、前記逸脱防止制御許可フラグFが“1”のセット状態であるか否かを判定し、当該逸脱防止制御許可フラグFがセット状態である場合にはステップS190に移行し、そうでない場合にはステップS210に移行する。
【0022】
前記ステップS190では、逸脱推定値として将来の推定横変位XSを算出してからステップS200に移行する。具体的には、前記ステップS120で読込んだ自車両の走行車線に対するヨー角φ、走行車線中央からの横変位X、走行車線の曲率β及び前記ステップS110で算出した自車両の走行速度Vを用い、下記2式に従って将来の推定横変位XSを算出する。
【0023】
XS=Tt×V×(φ+Tt×V×β)+X ……… (2)
ここで、Ttは前方注視距離算出用の車頭時間であり、車頭時間Ttに自車両の走行速度Vを乗じると前方注視距離になる。つまり、車頭時間Tt後の走行車線中央からの横変位推定値が将来の推定横変位XSとなる。後述するように、本実施形態では、この将来の推定横変位XSが所定の横変位限界値以上となるときに自車両は走行車線を逸脱する可能性がある、或いは逸脱傾向にあると判断するのである。
【0024】
前記ステップS200では、自車両が走行車線から逸脱傾向にあるか否かの判断を行ってから前記ステップS210に移行する。具体的には、前記ステップS190で算出した逸脱推定値としての将来の推定横変位の絶対値|XS|が、前記横変位限界値XC 以上であるときに自車両が走行車線から逸脱傾向にあるとして逸脱判断フラグFLDをセットし、そうでないときには自車両は走行車線から逸脱傾向にはないとして逸脱判断フラグFLDをリセット状態とする。なお、前記方向指示スイッチ20からの入力によって推定される車線変更方向と、自車両の走行車線からの逸脱方向とが一致するときには逸脱判断フラグFLDをリセット状態とする。また、このステップS200で、自車両が走行車線から逸脱傾向にあることを警報するか否かの判断を行ってもよい。具体的には、前記ステップS190で算出した逸脱推定値としての将来の推定横変位の絶対値|XS|が、前記ステップS120で読込んだ走行車線幅Lの半分値から自車両の車幅L0 の半分値を減じた横変位限界値XC 以上であるときに警報するとし、そうでないときには警報しないものとするなどの手法が考えられる。
【0025】
前記ステップS210では、車線逸脱防止のための目標ヨーモーメントMS を算出設定する。ここでは、前記逸脱判断フラグFLDがセットされているときにだけ目標ヨーモーメントMS を設定するので、当該逸脱判断フラグFLDがセットされているときには、車両諸元から決まる比例係数K1 と、図3に示す車両走行速度Vに応じて設定される比例係数K2 と、前記ステップS190で算出された将来の推定横変位XSと、前記横変位限界値XC とを用いて、下記3式に従って目標ヨーモーメントMS を算出する。
【0026】
MS =−K1 ×K2 ×(XS−XC ) ……… (3)
なお、前記逸脱判断フラグFLDがリセット状態にあるときには目標ヨーモーメントMS は“0”とする。
次にステップS220に移行して、各車輪への目標制動流体圧PSi及び駆動輪の目標駆動力を算出する。具体的には、前記ステップS110で読込んだマスタシリンダ圧Pm に対し、前後制動力配分に基づく後輪用マスタシリンダ圧をPmRとしたとき、前記逸脱判断フラグFLDがリセット状態にあるときには、前左右輪5FL、5FRのホイールシリンダ6FL、6FRへの目標制動流体圧PSFL 、PSFR は共にマスタシリンダ圧Pm となり、後左右輪5RL、5RRのホイールシリンダ6RL、6RRへの目標制動流体圧PSRL 、PSRR は共に後輪用マスタシリンダ圧PmRとなる。
【0027】
一方、前記逸脱判断フラグFLDがセットされているときでも、前記ステップS210で算出された目標ヨーモーメントMS の大きさに応じて場合分けを行う。即ち、前記目標ヨーモーメントの絶対値|MS |が所定値MS0未満であるときには後左右輪の制動力にだけ差を発生させ、当該目標ヨーモーメントの絶対値|MS |が所定値MS0以上であるときには前後左右輪の制動力に差を発生させる。従って、前記目標ヨーモーメントの絶対値|MS |が所定値MS0未満であるときの前左右輪目標制動流体圧差ΔPSFは“0”であり、後左右輪目標制動流体圧差ΔPSRは下記4式で与えられる。同様に、目標ヨーモーメントの絶対値|MS |が所定値MS0以上であるときの前左右輪目標制動流体圧差ΔPSFは下記5式で、後左右輪目標制動流体圧差ΔPSRは下記6式で与えられる。なお、式中のTはトレッド(前後輪で同じとする)、KbF、KbRは、夫々、制動力を制動流体圧に換算するための換算係数であり、ブレーキ諸元によって決まる。
【0028】
ΔPSR=2×KbR×|MS |/T ……… (4)
ΔPSF=2×KbF×(|MS |−MS0)/T ……… (5)
ΔPSR=2×KbR×|MS0|/T ……… (6)
従って、前記目標ヨーモーメントMS が負値であるとき、即ち自車両が左方向に車線逸脱しようとしているときの各ホイールシリンダ6FL〜6RRへの目標制動流体圧PSiは下記7式で与えられる。
【0029】
PSFL =Pm
PSFR =Pm +ΔPSF
PSRL =Pm
PSRR =Pm +ΔPSR ……… (7)
これに対し、前記目標ヨーモーメントMS が正値であるとき、即ち自車両が右方向に車線逸脱しようとしているときの各ホイールシリンダ6FL〜6RRへの目標制動流体圧PSiは下記8式で与えられる。
【0030】
PSFL =Pm +ΔPSF
PSFR =Pm
PSRL =Pm +ΔPSR
PSRR =Pm ……… (8)
また、本実施形態では、前記逸脱判断フラグFLDがセットされており、車線逸脱防止制御が行われるときには、アクセル操作が行われていてもエンジンの出力を絞って加速できなくする。従って、逸脱判断フラグFLDがセットされているときの目標駆動トルクTrqDSは、前記ステップS1で読込んだアクセル開度Accに応じた値から、前記前後輪の目標制動流体圧差ΔPSF、ΔPSRの和に応じた値を減じた値とする。つまり、アクセル開度Accに応じた値とは、当該アクセル開度Accに応じて自車両を加速する駆動トルクであり、前後輪の目標制動流体圧差ΔPSF、ΔPSRの和に応じた値とは、目標制動流体圧差ΔPSF、ΔPSRの和によって生じる制動トルクである。従って、逸脱判断フラグFLDがセットされており、車線逸脱防止制御が行われるときには、前記目標制動流体圧差ΔPSF、ΔPSRの和によって生じる制動トルク分だけ、エンジンのトルクが低減されることになる。なお、逸脱判断フラグFLDがリセットされているときの目標駆動トルクTrqDSは、前記アクセル開度Accに応じて自車両を加速する駆動トルク分だけとなる。
【0031】
次にステップS230に移行して、前記ステップS220で算出された各車輪の目標制動流体圧を前記制動流体圧制御回路7に向けて出力すると共に、駆動輪の目標駆動トルクを前記駆動トルクコントロールユニット12に向けて出力してからメインプログラムに復帰する。
ここで、前記レーンマーカ検出の作用について説明する。この実施形態では、例えば図4に示すように、前記CCDカメラ13で撮像された画像の中から、白線等のレーンマーカを検出するためのレーンマーカ検出エリアを設定する。具体的に、撮像された画像全域でレーンマーカを検出する(走査する)と、演算負荷も大きいし、時間もかかる。そこで、レーンマーカが存在しそうな領域に、更に小さな検出領域(所謂ウインドウ)を設定し、その検出領域内でレーンマーカを検出する。一般に、車線に対する自車両の向きが変わると、画像内に映し出されるレーンマーカの位置も変わるので、例えば前記特開平11−296660号公報では、操舵角δから車線に対する自車両の向きを推定し、画像内のレーンマーカが映し出されているであろう領域に検出領域を設定する。そして、例えばレーンマーカと路面との境界を際立たせるフィルタ処理などを施し、図5に示すように、各レーンマーカ検出領域内において、最もレーンマーカと路面との境界らしい直線を検出し、その直線上の一点(レーンマーカ候補点)をレーンマーカの代表的な部位として検出する。図5の例では、直線検出結果の最上点をレーンマーカ候補点として検出している。一本のレーンマーカに対するレーンマーカ候補点の数が予め設定された所定値以上であるときに、その検出されているレーンマーカは正しいものとする。逆に、レーンマーカ候補点の数が所定値未満であるときには、そのレーンマーカは正しくないものとして検出しない。更に、両側のレーンマーカのレーンマーカ候補点の総数が所定値以上でなければ、両側のレーンマーカを正しく検出していないものとする。
【0032】
前記図2の演算処理によれば、図6に示すように、走行車線の両側のレーンマーカが検出されているときには前記逸脱防止制御許可フラグFがセットされ、運転者の意図的な車線変更でもなく、且つ将来の推定横変位XSが横変位限界値XC 以上となったときに、自車両は走行車線から逸脱する傾向にあると判断されて逸脱判断フラグFLDがセットされ、前記将来の推定横変位XSと横変位限界値XC との差に基づいて目標ヨーモーメントMS を算出し、その目標ヨーモーメントMS が達成されるように各車輪の制動力が制御される。これにより、例えば操舵入力が小さいときには、車両に車線逸脱を防止するヨーモーメントが発生して車線逸脱が防止されると共に、制動力によって車両の走行速度が減速されるため、より安全に車線の逸脱を防止することが可能となる。また、この実施形態では、車線逸脱防止制御が行われている間は、エンジンの出力トルクが低減されて自車両の走行速度が減速されるため、更に安全に車線に逸脱を防止することが可能となる。
【0033】
また、この実施形態では、走行車線の片側のレーンマーカしか検出できないときでも、そのレーンマーカが自車両逸脱側のレーンマーカであるときには前記逸脱防止制御許可フラグFがセットされ、これにより前記両側レーンマーカ検出時と同様に車線逸脱防止制御が行われる。これにより、逸脱方向のレーンマーカのみが検出できたときには車線逸脱防止制御が継続されることになり、運転者の感覚に合致し、違和感がない。
【0034】
以上より、図1の各センサ及びカメラコントローラ14及び図2の演算処理のステップS110及びステップS120が本発明の走行状態検出手段を構成し、以下同様に、図2の演算処理のステップS120が走行車線検出手段及びレーンマーカ検出手段を構成し、図2の演算処理のステップS190、ステップS200が逸脱判断手段を構成し、図2の演算処理のステップS130乃至ステップS230及び図1の制動流体圧制御回路7及び駆動トルクコントロールユニット12が車両挙動制御手段を構成し、図2の演算処理のステップS220が制駆動力制御量算出手段を構成し、図2の演算処理のステップS230及び図1の制動流体圧制御回路7及び駆動トルクコントロールユニット12が制駆動力制御手段を構成している。
【0035】
次に、本発明の車線逸脱防止装置の第2実施形態について説明する。この実施形態における車両概略構成は、前記第1実施形態の図1のものと同様である。
本実施形態では、前記制駆動力コントロールユニット8で行われる演算処理が、前記第1実施形態の図2のものから図7のものに変更されている。この図7の演算処理は、前記図2の演算処理に類似しており、同等のステップもある。そこで、同等のステップには同等の符号を附して詳細な説明を省略する。具体的な相違点を挙げると、前記ステップS160とステップS140との間にステップS161が介装されている。
【0036】
前記ステップS161では、検出できなかった(図ではロスト)側のレーンマーカの前記レーンマーカ候補点数が所定値以上であるか否かを判定し、ロスト側レーンマーカ候補点が所定値以上である場合には前記ステップS140に移行し、そうでない場合には前記ステップS170に移行する。なお、ここで言うレーンマーカ候補点数の所定値とは、前記レーンマーカを正しく検出していると判定するための所定値とは異なり、それより小さな値を示す。
【0037】
この演算処理によれば、前記第1実施形態の作用に加え、何れか片側のレーンマーカしか検出できなくなったときに、検出できない側のレーンマーカ候補点数が所定値以上であればステップS140で逸脱防止制御許可フラグFがセットされ、前記第1実施形態と同様に車線逸脱防止制御が行われる。ここで、レーンマーカが白い点線であるような場合、仮にレーンマーカを正しく検出していても、そのレーンマーカ候補点は、前記正しく検出しているか否かの所定値未満である可能性がある。そこで、片側のレーンマーカしか正しく検出できていない場合でも、反対側のレーンマーカ候補点数が所定値以上である、つまりそのレーンマーカの確からしさが大きいときには、車線逸脱防止制御が継続することにより自車両の車線逸脱を確実に抑制防止することができる。
【0038】
なお、このレーンマーカの確からしさは、これ以外にも、例えば走行車線の両側のレーンマーカを検出している時間でも判定できる。即ち、例えば自車両が走行している走行車線の両側のレーンマーカを検出しているときに両側レーンマーカ検出カウンタCNTをインクリメントし、何れか片側のレーンマーカしか検出できなくなったとき、当該両側レーンマーカ検出カウンタCNTが所定値CNT0 以上であれば前記逸脱防止制御許可フラグFをセットするようにしてもよい。通常、車両が走行車線から逸脱しようとするときには、前記図4或いは図6に示すように、最初は走行車線の両側のレーンマーカが検出されており、やがて逸脱方向のレーンマーカのみが検出されるようになる。従って、両側のレーンマーカ検出時間が長く、その後、何れか片側のレーンマーカしか検出できなくなったとしたら、その方向に逸脱しようとしているので、逸脱防止制御を継続することにより自車両の車線逸脱を確実に抑制防止することができる。
【0039】
以上より、図1の各センサ及びカメラコントローラ14及び図7の演算処理のステップS110及びステップS120が本発明の走行状態検出手段を構成し、以下同様に、図7の演算処理のステップS120が走行車線検出手段及びレーンマーカ検出手段を構成し、図7の演算処理のステップS161がレーンマーカ確からしさ検出手段を構成し、図7の演算処理のステップS190、ステップS200が逸脱判断手段を構成し、図7の演算処理のステップS130乃至ステップS230及び図1の制動流体圧制御回路7及び駆動トルクコントロールユニット12が車両挙動制御手段を構成し、図7の演算処理のステップS220が制駆動力制御量算出手段を構成し、図7の演算処理のステップS230及び図1の制動流体圧制御回路7及び駆動トルクコントロールユニット12が制駆動力制御手段を構成している。
【0040】
次に、本発明の車線逸脱防止装置の第3実施形態について説明する。この実施形態における車両概略構成は、前記第1実施形態の図1のものと同様である。
本実施形態では、前記制駆動力コントロールユニット8で行われる演算処理が、前記第1実施形態の図2のものから図8のものに変更されている。この図8の演算処理は、前記図2の演算処理に類似しており、同等のステップもある。そこで、同等のステップには同等の符号を附して詳細な説明を省略する。具体的な相違点を挙げると、前記ステップS130とステップS140との間にステップS132が介装され、前記ステップS160とステップS140との間にステップS164が介装され、前記ステップS210がステップS211に変更されている。
【0041】
前記ステップS132では、目標ヨーモーメント比例係数kを“1”としてから前記ステップS140に移行する。
また、前記ステップS164では、前記目標ヨーモーメント比例係数kを“1”より小さい所定値k0 としてから前記ステップS140に移行する。
そして、前記ステップS211では、前記3式で算出される目標ヨーモーメントMS に前記目標ヨーモーメント比例係数kを乗じ、その値を新たな目標ヨーモーメントMS に設定してから前記ステップS220に移行する。
【0042】
この演算処理によれば、前記第1実施形態の作用に加え、何れか片側のレーンマーカしか検出できなくなり、且つそのレーンマーカが逸脱側のレーンマーカであったときには、“1”より小さい所定値k0 からなる目標ヨーモーメント比例係数kが設定され、その目標ヨーモーメント比例係数kを乗じて目標ヨーモーメントMS が設定される。即ち、目標ヨーモーメントMS は、本実施形態の車線逸脱防止装置の制御出力であるから、ゲインを小さく変更することにより、片側のレーンマーカしか検出できないときの制御出力を、両側のレーンマーカ検出時のそれより小さく調整することになる。前述のように、走行車線の何れか片側のレーンマーカしか検出できなくなり、且つそのレーンマーカが逸脱側のレーンマーカである場合には、車線逸脱防止制御を継続して行うことが望ましいが、しかしながら走行車線を完全に正確に検出していないことには代わりがない。そこで、片側レーンマーカ検出時は、本実施形態のように制御出力を低減しながら車線逸脱防止制御を継続することにより、そうした状況下における適切な車線逸脱防止制御を行うことが可能となる。
【0043】
なお、本実施形態では前記目標ヨーモーメント比例係数kからなるゲインをステップ的に変化させたが、これを連続的に変化させるようにしてもよい。
また、制御出力の減少方法は、これ以外にも、制御の実行回数や制御継続時間を小さくすることによっても可能である。
以上より、図1の各センサ及びカメラコントローラ14及び図8の演算処理のステップS110及びステップS120が本発明の走行状態検出手段を構成し、以下同様に、図8の演算処理のステップS120が走行車線検出手段及びレーンマーカ検出手段を構成し、図8の演算処理のステップS190、ステップS200が逸脱判断手段を構成し、図8の演算処理のステップS130乃至ステップS230及び図1の制動流体圧制御回路7及び駆動トルクコントロールユニット12が車両挙動制御手段を構成し、図8の演算処理のステップS220が制駆動力制御量算出手段を構成し、図8の演算処理のステップS230及び図1の制動流体圧制御回路7及び駆動トルクコントロールユニット12が制駆動力制御手段を構成している。
【0044】
次に、本発明の車線逸脱防止装置の第4実施形態について説明する。この実施形態における車両概略構成は、前記第1実施形態の図1のものと同様である。
本実施形態では、前記制駆動力コントロールユニット8で行われる演算処理が、前記第1実施形態の図2のものから図9のものに変更されている。この図9の演算処理は、前記図2の演算処理に類似しており、同等のステップもある。そこで、同等のステップには同等の符号を附して詳細な説明を省略する。具体的な相違点を挙げると、前記ステップS130とステップS140との間にステップS133が介装され、前記ステップS160とステップS140との間にステップS165が介装されている。
【0045】
前記ステップS133では、前記逸脱傾向判定のための横変位限界値XC をそのまま横変位限界値XC としてから前記ステップS140に移行する。
また、前記ステップS165では、前記逸脱傾向判定のための横変位限界値XC を、当該横変位限界値XC より大きな所定値XC0としてから前記ステップS140に移行する。
【0046】
この演算処理によれば、前記第1実施形態の作用に加え、走行車線の何れか片側のレーンマーカしか検出できなくなり、且つそのレーンマーカが逸脱側のレーンマーカであったときには、本来の横変位限界値XC より大きな所定値XC0を新たな横変位限界値XC とし、この横変位限界値XC を用いて逸脱傾向の判定が行われる。この場合、前記逸脱推定値としての将来の推定横変位の絶対値|XS|が、前記横変位限界値XC 以上であるときに自車両が走行車線から逸脱傾向にあるとして逸脱判断フラグFLDをセットするので、当該横変位限界値XC が大きな値になれば逸脱傾向と判断されにくく、車線逸脱防止制御の介入タイミングが遅れる、つまり目標ヨーモーメントMS は“0”となる。また、前記3式で算出される目標ヨーモーメントMS も小さな値になり、前記第3実施形態と同様に制御出力が小さく調整されることになる。即ち、目標ヨーモーメントMS は、本実施形態の車線逸脱防止装置の制御出力であるから、閾値を大きく変更することにより、片側のレーンマーカしか検出できないときの制御出力を、両側のレーンマーカ検出時のそれより小さく調整することになる。前述のように、走行車線の何れか片側のレーンマーカしか検出できなくなり、且つそのレーンマーカが逸脱側のレーンマーカである場合には、車線逸脱防止制御を継続して行うことが望ましいが、しかしながら走行車線を完全に正確に検出していないことには代わりがない。そこで、片側レーンマーカ検出時は、本実施形態のように制御出力を低減しながら車線逸脱防止制御を継続することにより、そうした状況下における適切な車線逸脱防止制御を行うことが可能となる。
【0047】
なお、本実施形態では前記横変位限界値XC なる閾値をステップ的に変化させたが、これを連続的に変化させるようにしてもよい。
また、制御出力の減少方法は、これ以外にも、制御の実行回数や制御継続時間を小さくすることによっても可能である。
以上より、図1の各センサ及びカメラコントローラ14及び図9の演算処理のステップS110及びステップS120が本発明の走行状態検出手段を構成し、以下同様に、図9の演算処理のステップS120が走行車線検出手段及びレーンマーカ検出手段を構成し、図9の演算処理のステップS190、ステップS200が逸脱判断手段を構成し、図9の演算処理のステップS130乃至ステップS230及び図1の制動流体圧制御回路7及び駆動トルクコントロールユニット12が車両挙動制御手段を構成し、図9の演算処理のステップS220が制駆動力制御量算出手段を構成し、図9の演算処理のステップS230及び図1の制動流体圧制御回路7及び駆動トルクコントロールユニット12が制駆動力制御手段を構成している。
【0048】
なお、前記実施形態では、車線逸脱判断の閾値となる横変位限界値XC を車幅と走行車線幅とから算出したが、例えば日本国内の高速道路の走行車線幅は3.35mと決まっていることから、例えばこれを0.8mと固定してもよい。
【図面の簡単な説明】
【図1】本発明の車線逸脱防止装置を搭載した車両の一例を示す概略構成図である。
【図2】図1の制駆動力コントロールユニット内で実行される情報演算処理の第1実施形態を示すフローチャートである。
【図3】図2の演算処理に用いられる制御マップである。
【図4】図2の演算処理の作用の説明図である。
【図5】図2の演算処理の作用の説明図である。
【図6】図2の演算処理の作用の説明図である。
【図7】図1の制駆動力コントロールユニット内で実行される情報演算処理の第2実施形態を示すフローチャートである。
【図8】図1の制駆動力コントロールユニット内で実行される情報演算処理の第3実施形態を示すフローチャートである。
【図9】図1の制駆動力コントロールユニット内で実行される情報演算処理の第4実施形態を示すフローチャートである。
【符号の説明】
6FL〜6RRはホイールシリンダ
7は制動流体圧制御回路
8は制駆動力コントロールユニット
9はエンジン
12は駆動トルクコントロールユニット
13はCCDカメラ
14はカメラコントローラ
15は加速度センサ
16はヨーレートセンサ
17はマスタシリンダ圧センサ
18はアクセル開度センサ
19は操舵角センサ
20は方向指示スイッチ
22FL〜22RRは車輪速度センサ
Claims (7)
- 自車両の走行車線を検出する走行車線検出手段と、自車両の走行状態を検出する走行状態検出手段と、前記走行車線検出手段で検出された走行車線及び走行状態検出手段で検出された走行状態から自車両が走行車線から逸脱傾向にあることを検出する逸脱判断手段と、前記逸脱判断手段で自車両が走行車線から逸脱傾向にあることが検出されたときに、前記走行状態検出手段で検出された走行状態に応じて、自車両の走行車線からの逸脱を回避する方向にヨーモーメントが発生するように車両の挙動を制御する車両挙動制御手段とを備え、前記走行車線検出手段は、自車両の走行車線の両側のレーンマーカを検出するレーンマーカを検出するレーンマーカ検出手段と、前記レーンマーカ検出手段で検出されたレーンマーカが自車両の走行車線からの逸脱方向のレーンマーカであることを検出する逸脱方向レーンマーカ検出手段とを備え、前記車両挙動制御手段は、前記レーンマーカ検出手段で自車両の走行車線の片側のレーンマーカしか検出できず且つ前記逸脱方向レーンマーカ検出手段で、その検出されたレーンマーカが自車両の走行車線からの逸脱方向のレーンマーカであることが検出されたときには、前記車両の挙動制御を行うことを特徴とする車線逸脱防止装置。
- 前記レーンマーカ検出手段で検出された自車両の走行車線のレーンマーカの確からしさを検出するレーンマーカ確からしさ検出手段を備え、前記車両挙動制御手段は、前記レーンマーカ検出手段で自車両の走行車線の片側のレーンマーカしか検出できないときに、前記レーンマーカ確からしさ検出手段で検出されたレーンマーカの確からしさに基づいて前記車両の挙動制御を行うことを特徴とする請求項1に記載の車線逸脱防止装置。
- 前記レーンマーカ検出手段は、撮像画像中の異なる複数の領域でレーンマーカを検出し且つ各領域のレーンマーカの代表的な部位を特定し、前記レーンマーカ確からしさ検出手段は、前記レーンマーカ検出手段で検出された各領域のレーンマーカの代表的な部位の数に基づいて当該レーンマーカの確からしさを検出することを特徴とする請求項2に記載の車線逸脱防止装置。
- 前記車両挙動制御手段は、前記レーンマーカ検出手段で自車両の走行車線の片側のレーンマーカしか検出できないときには、両側のレーンマーカが検出されているときよりも制御出力を小さくすることを特徴とする請求項1乃至3の何れかに記載の車線逸脱防止装置。
- 前記車両挙動制御手段は、制御ゲインを変更することにより制御出力を小さくすることを特徴とする請求項4に記載の車線逸脱防止装置。
- 前記車両挙動制御手段は、制御閾値を変更することにより制御出力を小さくすることを特徴とする請求項4又は5に記載の車線逸脱防止装置。
- 前記車両挙動制御手段は、前記自車両の走行車線からの逸脱を回避する方向にヨーモーメントが発生するように各車輪の制駆動力制御量を算出する制駆動力制御量算出手段と、前記制駆動力制御量算出手段で算出された制駆動力制御量に応じて各車輪の制駆動力を制御する制駆動力制御手段とを備えたことを特徴とする請求項1乃至6の何れかに記載の車線逸脱防止装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002342055A JP3941677B2 (ja) | 2002-11-26 | 2002-11-26 | 車線逸脱防止装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002342055A JP3941677B2 (ja) | 2002-11-26 | 2002-11-26 | 車線逸脱防止装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004178160A JP2004178160A (ja) | 2004-06-24 |
JP3941677B2 true JP3941677B2 (ja) | 2007-07-04 |
Family
ID=32704220
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002342055A Expired - Lifetime JP3941677B2 (ja) | 2002-11-26 | 2002-11-26 | 車線逸脱防止装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3941677B2 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9815462B2 (en) * | 2015-08-27 | 2017-11-14 | Toyota Motor Engineering & Manufacturing North America, Inc. | Path determination for automated vehicles |
-
2002
- 2002-11-26 JP JP2002342055A patent/JP3941677B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JP2004178160A (ja) | 2004-06-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3606276B2 (ja) | 車線逸脱防止装置 | |
JP3760827B2 (ja) | 車線逸脱防止装置 | |
JP3661684B2 (ja) | 車線逸脱防止装置 | |
JP3736413B2 (ja) | 車線逸脱防止装置 | |
US7778759B2 (en) | Lane deviation avoidance system | |
EP2062796B1 (en) | Lane deviation prevention device and method | |
JP4534754B2 (ja) | 車線逸脱防止装置 | |
JP4124050B2 (ja) | 車線逸脱防止装置 | |
JP3918722B2 (ja) | 車線逸脱防止装置 | |
JP4911131B2 (ja) | 車線逸脱防止装置 | |
JP3941677B2 (ja) | 車線逸脱防止装置 | |
JP3891102B2 (ja) | 車線逸脱防止装置 | |
JP2004284485A (ja) | 車線逸脱防止装置 | |
JP4466365B2 (ja) | 車線逸脱防止装置 | |
JP2006175979A (ja) | 車線逸脱防止装置 | |
JP4079028B2 (ja) | 車線逸脱防止装置 | |
JP5131074B2 (ja) | 車線逸脱防止装置及び車線逸脱防止方法 | |
JP3979393B2 (ja) | 車線逸脱防止装置 | |
JP3912323B2 (ja) | 車線逸脱防止装置 | |
JP3988729B2 (ja) | 車線逸脱防止装置 | |
JP4600038B2 (ja) | 車線逸脱防止方法及びその装置 | |
JP3864893B2 (ja) | 車線逸脱防止装置 | |
JP4492321B2 (ja) | 車線逸脱防止装置 | |
JP3945489B2 (ja) | 車線逸脱防止装置 | |
JP2004178158A (ja) | 車線逸脱防止装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20041126 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20061101 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20061114 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070115 |
|
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: 20070313 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070326 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 3941677 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110413 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120413 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130413 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130413 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140413 Year of fee payment: 7 |
|
EXPY | Cancellation because of completion of term |