JP3931760B2 - 車両用障害物検知装置 - Google Patents
車両用障害物検知装置 Download PDFInfo
- Publication number
- JP3931760B2 JP3931760B2 JP2002227240A JP2002227240A JP3931760B2 JP 3931760 B2 JP3931760 B2 JP 3931760B2 JP 2002227240 A JP2002227240 A JP 2002227240A JP 2002227240 A JP2002227240 A JP 2002227240A JP 3931760 B2 JP3931760 B2 JP 3931760B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- correction
- obstacle detection
- steering angle
- host vehicle
- 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 - Fee Related
Links
Images
Description
【発明の属する技術分野】
この発明は、先行車両等の障害物を検出し、自車両が、この障害物と接触する可能性を判断するようにした車両用障害物検知装置に関する。
【0002】
【従来の技術】
従来、自車両が自車前方物体と接触することを防ぐ目的でドライバへの警報、或いは減速制御などを行うため、自車両前方の障害物を検出する方法として数々提案されている。
例えば、特開平7−104062号公報には、レーザレーダ、或いは電波式レーダなどによって自車両前方の先行車両を検知するとともに、自車両のヨーレート、車速などの運動情報に基づいて自車両の将来の走路を予測し、これに基づく自車両の予測軌跡と先行車両の予測軌跡とを比較し、これらの重なり状態及び現在時点からの到達時間に応じて接触可能性を算出するようにした方法が提案されている。
【0003】
そして、算出された接触可能性に基づいて警報、或いは速度制御を行うことで、自車両が自車両前方の物体と接触する可能性を精度良く判定し、これを防止するようにしている。また、予測軌跡の重なり状況から自車両と前方車両とが接触する可能性がある場所を予測し、これを防ぐように、速度制御をするようにしている。
【0004】
【発明が解決しようとする課題】
しかしながら、前述の特開平7−104062号公報に記載の方法にあっては、現在の運動状態がそのまま継続するという仮定のもとに、接触可能性を算出している。このため、ドライバが操舵操作を加えた場合には、自車両の将来の走路の予測結果と、実際の走路とが異なってしまうため、接触可能性の判断が適切でないものとなってしまう可能性がある。
【0005】
つまり、通常、ドライバは、前方のカーブに進入するにあたって、徐々に操舵角を増加させるように操舵を行っている。このカーブ進入時に操舵角を増加させている状態で前方車両を検出すると、この時点では、自車両の操舵角がまだ大きくない。したがって、自車両の操舵角に基づいて自車両の走路を予測すると、実際よりも緩いカーブを走行すると判断してしまう。このため、実際のカーブと予測した進路とが異なってしまい、本来、自車両進路前方の物体として判断されるべき物体が、進路外の物体であると誤判断される可能性がある。
【0006】
また、自車両が実際のカーブに見合った操舵角で操舵を行った場合、例えばカーブ路の前方に直線路が続いている場合であっても、操舵角に基づいてカーブが継続すると判断してしまうため、直線路部分に先行車両が存在する場合に、この先行車両を、自車両の進路外の物体であると誤判断してしまう場合がある。
そこで、この発明は、上記従来の未解決の課題に着目してなされたものであり、自車両前方の物体との接触の可能性判断をより的確に行うことの可能な、車両用障害物検知装置を提供することを目的としている。
【0007】
【課題を解決するための手段】
上記目的を達成するために、本発明に係る車両用障害物検知装置では、自車両の旋回状態を表す旋回情報に基づいて自車両の進路を予測し、この予測進路を、旋回情報が変化する方向に曲がり度合が大きく変化するように補正し、このとき、車速が低いときほど補正の度合を強くして旋回情報の変化に対する補正量を大きくする。そして、補正後の予測進路に基づいて障害物との接触の可能性を判断する。
【0008】
したがって、例えば、旋回状態を表す旋回情報として操舵角を想定した場合、急なカーブ路を走行する場合であっても、カーブ入口では、操舵角はまだ小さいため緩やかなカーブを走行すると予測してしまう場合がある。
しかしながら、旋回情報に基づいて予測した進路を、旋回情報が変化する方向に曲がり度合が大きく変化するように補正し、車速が低いときほど補正の度合を強くして旋回情報の変化に対する補正量を大きくすることによって、車速が低く急なカーブの通過に伴う減速と予測されるときほど、旋回情報の変化に対する補正量が大きくなることから、より的確な予測進路を得ることが可能となる。
【0009】
【発明の効果】
本発明による車両用障害物検知装置によれば、旋回状態を表す旋回情報に基づいて自車両の進路を予測し、この予測進路を、旋回情報が変化する方向に曲がり度合が大きく変化するように補正し、このとき、車速が低いときほど補正の度合を強くして旋回情報の変化に対する補正量を大きくするようにしたから、より的確に自車両の予測進路を推測することができ、これに基づいて自車両前方の障害物との接触判断を行うことによって、障害物との接触の可能性判断をより的確に行うことができる。
【0010】
【発明の実施の形態】
以下、本発明の実施の形態を図面に基づいて説明する。
まず、本発明の第1の実施の形態を説明する。
図1は、本発明を適用した車両用障害物検知装置の一例を示すブロック図である。
【0011】
図中1は、自車両前方の障害物を検出するためのレーダ装置であって、例えば、車幅中央の、車両前方の障害物を検出することの可能な位置に設けられている。また、図中、2は、従動輪である後輪の回転速度から自車両の走行速度Vhを検出する車速センサである。また、3は、ステアリングホイール4の操舵角δを検出する舵角センサである。
【0012】
そして、これら各センサで検出された検出信号は、障害物検知装置5及びコントローラ6に必要に応じて入力され、障害物検知装置5では、前記レーダ装置1の検出結果に基づいて自車両前方の障害物の有無を検出し、その検出結果を前記コントローラ6に通知する。前記コントローラ6は、障害物検知装置5での障害物の検出結果、舵角センサ3で検出した操舵角δ、車速センサ2で検出した車速Vhに基づいて、自車両の、障害物との衝突の可能性の判断を行い、その結果に応じて乗員に注意を促すための警報を発するかどうかを判断し、警報を発生する必要があると判断されるときには、警報装置8を作動させるようになっている。
【0013】
前記レーダ装置1は、例えば、赤外レーザを使った光式のレーダ装置であって、図2に示すように、赤外レーザ光を発する発光部1aと、反射光を受光して所定の電圧を出力する受光部1bとを備え、計測部1cにおいて、発光から受光までの時間差に基づき、前方物体までの距離を計測するようになっている。また、発光部1aには、スキャニング機構が組み合わされており、所定角度範囲内で、順次角度を変化させながら発光するようになっている。
【0014】
そして、前記計測部1cでは、各スキャニング位置について、反射光を受光したか否かの判定を行い、反射光を受光した場合には、発光から受光までの時間差に基づき前方物体までの距離を算出する。また、物体が検出されたときのスキャニング角と前記物体までの距離とに基づき、自車両に対する前方物体の左右方向の位置を検出し、前方物体の自車に対する相対的な位置を確定するようになっている。そして、この処理を各スキャニング位置において行うことで、例えば図3に示すように、車両前方における平面的な物体の存在状態図を生成するようになっている。
【0015】
また、前記障害物検知装置5は、レーダ装置1で得られた物体の存在状態図に基づき、これをスキャニング周期毎に比較することで、検出された各物体の動きを判別すると共に、検出された物体間の近接状態、動きの類似性等に基づいてこれらが同一物体であるか異なる物体であるかを判別する。そして、障害物情報として、自車両から各検知物体までの前後方向距離(車間距離方向)X〔m〕、左右方向距離(横方向)Y〔m〕、物体幅W〔m〕、相対速度Vr〔m/s〕、を所定の時間周期で出力する。
【0016】
なお、ここでは、前記レーダ装置1として、赤外レーザを使った光式のものを適用した場合について説明するが、これに限るものではなく、例えば、マイクロ波、ミリ波などを使った電波式のものであっても良いし、また、レーダ装置に限らず、ビデオ画像を処理することによって前方の障害物を検出するものであっても良い。また、前記警報装置8としては、警報音を発するようになっているものを用いているが、警報音を発するものに限らず、ドライバの前方位置に警報表示するものや、ペダル、ステアリング、シート類に振動を発生させることで注意を喚起するものなどであっても適用することができる。
【0017】
そして、前記コントローラ6は、後述の障害物検知処理を実行し、車速センサ2で検出された車速Vh及び舵角センサ3で検出された操舵角δに基づいて、自車両の今後の進路を予測し、予測した自車予測進路と、障害物検知装置5からの障害物情報とに基づいて、自車両が障害物と接触する可能性があるかどうかを判断し、必要に応じて警報装置8を作動して警報を発生させる。
【0018】
図4は、コントローラ6で実行される、障害物検知処理の処理手順の一例を示すフローチャートである。この障害物検知処理は、予め設定された所定周期で割り込みによって実行されるようになっている。
この障害物検知処理では、まず、ステップS1で、前記車速センサ2及び舵角センサ3から車速及び舵角データの読み込みを行う。前記車速センサ2、舵角センサ3は、それぞれ回転に応じた所定間隔のパルスを出力するエンコーダで構成され、パルス数をカウントし、これを積算することで車速Vh(m/s)、操舵角δ(rad)が計算され、この結果がメモリに格納されるようになっている。
【0019】
次いで、ステップS2に移行し、障害物検知装置5における検知結果、すなわち、自車両から各検知物体までの前後方向距離(車間距離方向)X〔m〕、左右方向距離(横方向)Y〔m〕、物体幅W〔m〕、相対速度Vr〔m/s〕の読み込みを行う。ここで、障害物検知装置5と、コントローラ6との間の情報交換は、シリアル通信のような、一般的な通信処理に従って行うことが可能である。これらの情報も同様に、メモリに格納される。
【0020】
次いで、ステップS3に移行し、ステップS1で読み込んだ操舵角δのフィルタリング処理を行う。このフィルタリング処理は、例えば、図5(a)及び(b)に示す伝達特性を有するフィルタを用いて行う。つまり、所定の周波数範囲において操舵角δに進み特性を与える。また、進み特性は、車速に応じて変化させるようになっており、低速では進み特性が強く、高速では弱くなるようになっている。
【0021】
なお、車速に応じた進み特性の変化は、上限及び下限を有し、所定の速度以下の極低速、及び所定の速度以上の高速である場合には、上限及び下限を超えて変化しないようになっている。これは、例えば路地での右左折や駐車時の切り返し等といった、極低速の走行時には、非常に大きな角度の操舵が行われることが多く、また、操舵速度も極端に大きくなるため、フィルタリング処理によって進み特性を加えるようにした処理によっては、操舵角を的確に予測することができない。このように、過度の補正を行うことで、却って精度が低下するのを防ぐため、極低速では、進み特性を変化させず、また、ある程度以上の高速では操舵角自体が小さく、フィルタリングによる補正の必要がないため、進み特性を変化させないようにしている。
【0022】
ここで、前記フィルタは、その伝達関数を、次式(1)で表すように定義している。なお。式(1)中の、Sはラプラス演算子、a、b、c、dは係数である。
そして、例えば図6に示すように、車速に応じて係数a〜dを定めたテーブルを予め作成しておき、ここからステップS1で読み込んだ車速Vhに応じた係数a〜dを検索し、検索した係数a〜dに応じた伝達関数に基づいて、フィルタリングを行うようになっている。なお、前記係数a〜dは、例えば、所定の固有振動数ω及び減衰定数ζを持つ、次式(2)で表される二次フィルタの特性にしたがって、a=ζω、b=d=ω2とし、進み成分の比率をcの値を調整することで設定できる。
【0023】
ここで、前記(2)式において、ωを10〜60[rad/s]程度の値、ζを0.5〜1.0程度の値とし、車速が下がるに従ってcの値を大きく、またωの値を大きくすることで、車速に応じた進み特性の変化を得ることが一例として考えられる。
【0024】
なお、ここでは、前記(1)式に示す伝達関数を用いた場合について説明したが、これに限るものではなく、入力値に対して進み特性を持った出力を行うものであれば、適用することができる。
このようにして前記特性関数を用いてフィルタリング処理を行ったならばステップS4に移行し、車速Vh及び、ステップS3でフィルタリング処理を行った操舵角δFに基づいて自車進路予測を行う。
【0025】
ここで、車速Vh及び操舵角δFに応じて車両の旋回曲率ρ(1/m)を与える式は一般に良く知られており、次式(3)から算出することができる。
なお、式(3)中の、Lは、自車両のホイールベースであり、Aは、車両に応じて定められた、スタビリティー・ファクタと呼ばれる正の定数である。また、Nはステアリングギア比である。
【0026】
この(3)式から、旋回半径Rは、次式(4)として定めることができる。
R=1/ρ ……(4)
したがって、自車両の予測進路は、図7に示すように、自車両位置から、自車両の進行方向と鉛直方向に距離Rだけ離れた位置にある点Q(図7の場合には、右方向にRだけ離れた位置にある点)を中心とした、半径Rの円弧として予測される。
【0027】
なお、前記操舵角δ、δFは、右方向に操舵された場合に正値、左方向に操舵された場合に負値をとるものとし、旋回曲率ρ、旋回半径Rについても、これらが正値をとる場合には右旋回、負値をとる場合には左旋回を意味するものとする。
ここで、このようにして求められた、図7に示すような軌跡は、あくまで自車両の進行方向を予測したものであり、自車両が走行するであろう領域、すなわち、予測走路は、図8に示すように、この軌跡に、自車両の車幅もしくは車線幅を考慮したものとなる。図8は、図7に示す予測進路に、自車両の車幅Twを加えたものであり、この場合、予測走路は、上記予測進路と同一点Qを中心とし、半径がR−(Tw/2)の円弧と、半径がR+(Tw/2)の円弧に囲まれる領域となる。
【0028】
なお、ここでは、自車両の予測進路として旋回半径Rを、車速Vhと操舵角δとを用いて算出する場合について説明したがこれに限るものではない。例えば、車両に発生するヨーレートを検出するヨーレート検出手段を設け、前記車速Vhと操舵角δとから予測進路を算出する代わりに、前記ヨーレート検出手段で検出したヨーレートrと自車速Vhとから、次式(5)にしたがって、旋回半径を算出するようにしてもよい。
【0029】
R=Vh/r ……(5)
また、例えば、車両に発生する横加速度を検出する横加速度検出手段を設け、この横加速度検出手段で検出した横加速度Ygと自車速Vhとから、次式(6)に基づいて旋回半径Rを算出するようにしてもよい。
R=V2/Yg ……(6)
なお、ヨーレートrや、横加速度Ygを用いて予測進路を算出する場合には、前記ヨーレートrや横加速度Ygに対して、前記操舵角δと同様にフィルタリング処理を行い、予測進路を算出するようにすればよい。
【0030】
次いで、ステップS5に移行し、検知物体の領域内外判定処理を行う。この領域内外判定処理では、障害物検知装置5により検出された各検知物体の位置と、ステップS4で推定した自車両の予測走路とを比較し、検知物体が、予測走路内に存在するか否かを判断する。
例えば、図9は、検知物体q1〜q4が検知されている状態を示しているが、この場合、検知物体q1及びq2は、円弧で表される予測走路外に存在するから、予測走路外の物体であると判定し、検知物体q3及びq4は予測走路内の物体であると判断する。
【0031】
そして、ステップS5の処理での判断の結果、障害物検知装置5から通知された検知物体のうち、何れかが、予測走路内に存在すると判断された場合には、ステップS5からステップS6に移行し、予測走路内に存在すると判断された検知物体について、自車両との車間距離(すなわち、検知物体の前後方向位置X)と、相対速度Vrに基づいて衝突時間(=X/Vr)を算出する。そして、算出した衝突時間が、予め設定したしきい値を下回るかどうかを判断し(ステップS7)、衝突時間がしきい値を下回る検知物体がある場合には、ステップS8に移行し、警報装置8に対し、警報を発生させる旨の指令を出力する。そして、障害物検知処理を終了する。
【0032】
なお、前記衝突時間の判断に用いるしきい値は、検知物体と衝突する可能性が高く緊急に衝突回避操作を行う必要があるとみなすことの可能な値に設定される。
一方、ステップS7の処理で、予測走路内に存在する検知物体について全ての検知物体の衝突時間がしきい値を下回らないとき、また、前記ステップS5の処理で、障害物検知装置5から通知された検知物体すべてが、予測走路外であると判断された場合、また、障害物検知装置5において物体が検知されないときには、そのままステップS9に移行する。そして、このとき、警報装置8に対して警報を発生させる旨の指令を出力している場合には、警報を停止させる旨の指令を出力し、また、警報を発生させる旨の指令を出力していない場合には、引き続きこの指令を出力せず、警報の発生は行わない。そして、障害物検知処理を終了する。
【0033】
次に、上記第1の実施の形態の動作を説明する。
コントローラ6では、前記障害物検知処理を所定周期で実行し、操舵角δ、車速Vhを読み込み(ステップS1)、このときの車速Vhに基づき、予め設定している図6に示すようなテーブルに基づき、対応する係数a〜dを特定する。そして、この係数をもとに前記(1)式で表される伝達特性を特定し、この伝達特性に基づいてフィルタリング処理を行う(ステップS3)。
【0034】
そして、フィルタリング処理毎の操舵角δFと車速Vhとに基づいて自車両の進路を推定しこれに基づき予測走路を推定する(ステップS4)。
ここで、車両前方に障害物が存在しない場合には、障害物検知装置5において、物体が検知されないから、ステップS5からステップS9に移行し、警報装置8は作動されない。
【0035】
この状態から、自車両が例えば、図10に示すような略直角に曲がるカーブに進入すると、通常、このような急なカーブでは、ドライバは比較的小さな車速で走行するから、操舵角δに対するフィルタリング処理における伝達特性は、進み特性が強くなるように設定される。
ここで、カーブ進入時等には、図11に細線で示すように、通常徐々に操舵角が大きくなるように操舵が行われることから、カーブ入口近傍に位置する状態では、その操舵角はまだ小さい。したがって、検出された操舵角δに基づいて予測進路を算出した場合、図10に破線で示すように、実際の道路形状に比較して緩やかなカーブとなる。
【0036】
しかしながら、操舵角δに対し、車速が低くなるほど、より強く進み特性を加えるような伝達特性でフィルタリング処理を行うことによって、図11に一点鎖線で示すように、操舵角δに進み補正を加えることができる。このとき、カーブが急であるほど、ドライバは減速しその車速は低くなるため、進み特性はより強くなる。
【0037】
よって、このように進み補正が行われた操舵角δFに基づいて自車両の進路を予測した場合、真の操舵角δに基づき算出される予測進路よりも急なカーブとなり、この予測進路に基づき予測走路を算出することによって、図10に一点鎖線で示すように、より真の道路形状に近い走路を予測することができる。
一方、図12に示すように、比較的緩やかなカーブに進入する場合、それほど減速を行わなくても通過することができるから、操舵角の変化は比較的緩やかであり、また、操舵される舵角の範囲も狭い。したがって、この場合、フィルタリング処理によって、弱い進み特性が加えられるように補正が行われるから、図13に示すように、太線で示す補正後の操舵角δFは、細線で示す補正前の操舵角δに対し、あまり進み特性が加えられないことになる。
【0038】
したがって、このように補正された操舵角δFに基づいて予測進路を算出すると、比較的緩やかなカーブとなり、真の道路形状に近い走路を予測することができる。
したがって、図10に示すように屈曲部の先に先行車両が存在する場合であっても、的確にこの先行車両との接触の可能性を判断することができる。
【0039】
ちなみに、従来のように操舵角δに基づいて自車両の進路を予測した場合、通常カーブ路を走行する場合には、操舵角は図14に示すように徐々に大きくなる。したがって、図15に示すように、自車両がカーブ入口近傍に存在する場合には、操舵角が小さいことから、その予測進路は緩やかなカーブとなり、前方車両は自車両の進路上にないと判断される場合がある。
【0040】
また、例えば、図16に示すように、自車両がカーブの曲率に見合った操舵を行った場合には、カーブ前方には直線路が続いているにも関わらず、カーブであると判断されるため、直線路部分に前方車両が存在したとしても、前方車両は自車両の進路上にはないと判断される場合がある。
しかしながら、補正後の操舵角δFに基づいて進路を予測することによって、より高精度に進路を予測することができ前方車両は自車両の進路上に存在すると判断されるから、この前方車両との接触の可能性を的確に判断することができる。
【0041】
したがって、このようにして推定された予測走路に基づいて、障害物との接触判断を行うことにより、カーブ路等に存在する自車両前方の障害物であっても、これが自車両前方に存在するかどうかをより早い段階で的確に判断することができ、接触の可能性をより早い段階で、ドライバに通知することができる。
また、カーブ路道路脇に存在する障害物等、実際には、自車両の進路前方には存在しない障害物に対して、自車両と接触する可能性があると誤判断することを回避することができ、より的確に接触判断を行い、警報を発生することができる。
【0042】
ここで、レーダ装置1が物体検知手段に対応し、車速センサ2が走行環境検出手段に対応し、舵角センサ3が旋回情報検出手段に対応し、図4において、ステップS3の処理が変化状況予測手段に対応し、ステップS3の処理において、伝達関数の特性を前記車速に応じて変化させる処理が補正度合可変手段に対応し、ステップS4の処理が補正手段及び進路予測手段に対応し、ステップS5〜ステップS7の処理が判定手段に対応している。
【0043】
次に、本発明の第2の実施の形態を説明する。
この第2の実施の形態は、図17に示すように、障害物検知処理の処理手順の一部が異なること以外は、上記第1の実施の形態と同様であるので、同一部には同一符号を付与しその詳細な説明は省略する。
図17は、第2の実施の形態における障害物検知処理の処理手順の一例である。
【0044】
この第2の実施の形態における障害物検知処理では、上記第1の実施の形態と同様に、まず、ステップS1で、操舵角δ及び車速データVhを読み込み、また、ステップS2で障害物検出装置5から障害物データを読み込む。
次いで、ステップS11に移行し、ステップS1で読み込んだ操舵角δを疑似微分し、次いでステップS12に移行し、疑似微分した操舵角dδに基づき次式(7)にしたがって、自車両の進路予測に用いる操舵角δ′を算出する。
【0045】
δ′=δ+G×dδ ……(7)
なお、式(7)中のGはゲインであって、車速Vhに応じて設定される。例えば図18に示すように、車速がしきい値VL よりも低いときには、最大値Gmax となり、車速がしきい値VL から増加するほど、ゲインGは、その最大値Gmax から減少するようになっている。なお、車速がしきい値VL よりも低いときには、ゲインをGmax に維持するようにしている。これは、上述のように、極低速の場合、つまり路地での右左折や、駐車時の切り返し等、非常に大きな角度の操舵を行うことが多く、また、操舵速度も極端に大きくなるため、操舵角の予測が難しい。このため、過度の補正を行うことにより、却って精度が低下することを防止するためである。
【0046】
つまり、図17のステップS11及びS12の処理では、図19のブロック線図で表される処理を行う。
このようにして、進路予測に用いる操舵角δ′を算出したならば、ステップS13に移行し、以後、操舵角δ′を、操舵角δFに置き換え、上記第1の実施の形態と同様に処理を行う。つまり、操舵角δ′に基づき、自車両の予測進路を予測し、これに基づき予測走路を検出し(ステップS13)、障害物と予測走路との位置関係から、接触可能性の判断を行い(ステップS5)、必要に応じて警報を発生させる(ステップS6〜ステップS9)。
【0047】
ここで、操舵角δの微分値dδに乗算されるゲインGは、図18に示すように、車速がしきい値VLよりも低いときに最大値Gmaxとなり、車速がしきい値VLよりも増加するほど、ゲインGは減少するようになっている。したがって、操舵角δの補正量は、操舵角の微分値dδに基づき、車速が低いほど大きく車速が高いほど小さいから、操舵角δは、車速が低いほど進み特性が強くなり、車速が高いほど、進み特性が低くなるように補正されることになる。したがって、上記第1の実施の形態と同等の補正が行われた操舵角δ′に基づいて自車両の進路が予測されることになり、この場合も上記第1の実施の形態と同等の作用効果を得ることができる。
【0048】
また、フィルタリング処理を行う代わりに、微分処理を行うことによって、より簡易な構成で上記第1の実施の形態と同等の作用効果を得ることができる。
ここで、レーダ装置1が物体検知手段に対応し、車速センサ2が走行環境検出手段に対応し、舵角センサ3が旋回情報検出手段に対応し、図17において、ステップS11の処理が変化状況予測手段に対応し、ステップS12において、補正量を算出する際のゲインGを車速に応じて変化させる処理が補正度合可変手段に対応し、ステップS12及びステップS13の処理が補正手段及び進路予測手段に対応し、ステップS5〜ステップS7の処理が判定手段に対応している。
【0049】
次に、本発明の第3の実施の形態を説明する。
この第3の実施の形態は、図20に示すように、第1の実施の形態における障害物検知処理において、ステップS3のフィルタリング処理の後に、ステップS3aの補正量制限処理を追加したものである。なお、上記第1の実施の形態と同一部には同一符号を付与しその詳細な説明は省略する。
【0050】
この補正量制限処理(ステップS3a)では、図21に示すように、ステップS3で算出したフィルタリング処理後の操舵角δFから、フィルタリング処理前の操舵角δを減算してフィルタ処理前後の操舵角偏差Δδを算出する。この操舵角偏差Δδに対し、リミッタ回路31でリミッタ処理を行った後、リミッタ処理後の操舵角偏差ΔδLIMに、フィルタリング処理前の操舵角δを加算し、これを自車両進路予測用の操舵角δ′として設定する。
【0051】
前記リミッタ回路31では、例えば操舵角δの操舵速度に基づいて、操舵角偏差Δδにリミッタをかけるようになっている。前記操舵速度Vδは、例えばフィルタリング前の操舵角δを微分することにより算出される。そして、図21に示すように、操舵速度Vδがあるしきい値以上であるときには、前記操舵角偏差Δδを予め設定した最大値に制限し、操舵速度Vδがしきい値よりも低下するほど制限値の値も減少し、操舵速度Vδが零のときには、零に制限するようになっている。つまり、一般に、車速が高まるにつれて操舵速度が小さくなるため、操舵角δが変化する範囲は、リミット処理をかけることにより、低速では大きく、高速では小さくなるように設定される。
【0052】
なお、図21において、正値は右操舵が行われたことを表し、負値は左操舵が行われたことを表す。
したがって、このようにフィルタリング処理前後における、操舵角の変化に制限を設けることによって、ドライバ自身の操作が遅れた場合等に急操舵を行った際に、過度に補正が行われ、実際に旋回するカーブよりもさらに急なカーブを通過すると誤判断することを防止することができる。
【0053】
なお、この第3の実施の形態においては、上記第1の実施の形態に適用した場合について説明したが、上記第2の実施の形態に適用することも可能である。
この場合には、図22に示すように、操舵角δを微分処理しこれにゲインGを乗算して、補正量G×dδを算出する。そして、この補正量G×dδに対して、上記第3の実施の形態と同様に、操舵速度Vδに応じてリミッタをかけ、このリミッタ処理後の補正量ΔδLIMと操舵角δとを加算して、自車両進路予測用の、操舵角δ′を算出するようにすればよい。
【0054】
次に、本発明の第4の実施の形態を説明する。
この第4の実施の形態における車両用障害物検知装置では、図23に示すように、さらに、ナビゲーション装置10が追加されている。
このナビゲーション装置10は、GPSによる測位結果をもとに、ナビゲーション装置10内で予め記憶している地図情報との照合を行い、自車両の地図上における位置を特定すると共に、走行中の道路に関する情報を属性情報として出力する。この属性情報としては、高速道路、一級国道等の道路区分、制限速度情報、走行中の道路がつづら折り路であるか否かを表す屈曲状況等がある。
【0055】
そして、図4に示す上記第1の実施の形態における障害物検知処理と同様に処理を行うが、このとき、ステップS3でのフィルタリング処理を行う際の伝達特性を図24に示すように、屈曲路であるか直線路であるかに応じて、進み特性を強めたり弱めたりするようになっている。つまり、ナビゲーション装置10からの情報をもとに、自車両が走行している道路が、屈曲路であると判断されるときには、進み特性を強め、直線路であると判断されるときには、進み特性を弱めるようになっている。
【0056】
したがって、このように走行路の状況に応じて進み特性が変更された伝達特性に基づいて操舵角δをフィルタ処理することによって、直線路では、操舵角の変化に対して補正量が少なく、屈曲路であるときには操舵角の変化に対して補正量が大きくなることになり、自車の進路をより的確に予測することができ、接触判断をより的確に行うことができる。
【0057】
なお、上記第4の実施の形態においては、上記第1の実施の形態に適用した場合について説明したが、上記第2及び第3の実施の形態に適用することも可能であり、前記第2の実施の形態において適用する場合には、ゲインGを屈曲路であるかどうかに基づいて変更するようにすればよい。また、上記第1から第3の実施の形態と組み合わせて、車速に応じて補正量を変更すると共に、道路状況に応じて補正量を変更するようにしてもよい。
【0058】
また、上記第4の実施の形態においては、ナビゲーション装置10を設けた場合について説明したが、これに限らず、インフラ設備からのインフラ情報を受信可能な受信設備を設け、このインフラ情報に基づいて自車両の走行路の状況を検出し、これに基づいて、補正量を調整するようにしてもよい。
ここで、レーダ装置1が物体検知手段に対応し、車速センサ2が車速検出手段に対応し、舵角センサ3が旋回状態検出手段に対応し、ナビゲーション装置10が道路状況検出手段に対応している。
【図面の簡単な説明】
【図1】第1の実施の形態を適用した車両用障害物検知装置の一例を示す概略構成図である。
【図2】本発明に適用したレーダ装置の動作説明に供する説明図である。
【図3】レーダ装置による検知物体の存在状態図の一例である。
【図4】第1の実施の形態における障害物検知処理の処理手順の一例を示すフローチャートである。
【図5】フィルタリング処理における伝達特性の一例である。
【図6】フィルタ係数テーブルの一例である。
【図7】自車両の予測進路の定義を説明するための説明図である。
【図8】自車両の予測走路の定義を説明するための説明図である。
【図9】検知物体の領域内外判定方法を説明するための説明図である。
【図10】第1の実施の形態の動作説明に供する説明図である。
【図11】第1の実施の形態の動作説明に供する説明図である。
【図12】第1の実施の形態の動作説明に供する説明図である。
【図13】第1の実施の形態の動作説明に供する説明図である。
【図14】従来の動作説明に供する説明図である。
【図15】従来の動作説明に供する説明図である。
【図16】従来の動作説明に供する説明図である。
【図17】第2の実施の形態における障害物検知処理の処理手順の一例を示すフローチャートである。
【図18】ゲインGの特性を示す特性図である。
【図19】第2の実施の形態における操舵角δ′算出時の処理手順の一例を示す機能ブロック図である。
【図20】第3の実施の形態における障害物検知処理の処理手順の一例を示すフローチャートである。
【図21】第3の実施の形態における操舵角δ′の算出時の処理手順の一例を示す機能ブロック図である。
【図22】第3の実施の形態のその他の例である。
【図23】第4の実施の形態を適用した車両用障害物検知装置の一例を示す概略構成図である。
【図24】第4の実施の形態における、フィルタリング処理の伝達特性の一例である。
【符号の説明】
1 レーダ装置
2 車速センサ
3 舵角センサ
4 ステアリングホイール
5 障害物検知装置
6 コントローラ
8 警報装置
10 ナビゲーション装置
Claims (7)
- 自車両前方の物体を検知し、この検知物体と自車両との相対関係を検出する物体検知手段と、
自車両の旋回状態を表す旋回情報を検出する旋回情報検出手段と、
前記旋回情報検出手段で検出した旋回情報に基づいて自車両の進路を予測する進路予測手段と、
前記進路予測手段で予測した予測進路と前記検知物体との位置関係を用いて、自車両が前記検知物体と接触する可能性を判断する判定手段と、を備えた車両用障害物検知装置において、
自車両の車速を検出する車速検出手段と、
前記旋回情報が変化する方向に曲がり度合が大きく変化するように前記進路予測手段による予測進路を補正すると共に、前記車速検出手段によって検出される車速が低いときほど前記補正の度合を強くして前記旋回情報の変化に対する補正量を大きくする補正手段と、を有することを特徴とする車両用障害物検知装置。 - 前記旋回情報は、操舵角であることを特徴とする請求項1記載の車両用障害物検知装置。
- 前記補正手段は、前記旋回情報に対して進み特性を与えるフィルタリング手段であって、
前記進路予測手段は、前記補正手段で補正された旋回情報を用いて前記進路予測を行うことを特徴とする請求項1又は請求項2記載の車両用障害物検知装置。 - 前記補正手段は、前記旋回情報に対して微分処理を行う微分手段を備え、当該微分手段での微分処理結果と前記旋回情報とから前記旋回情報の予測値を算出し、
前記進路予測手段は、前記補正手段で算出された旋回情報の予測値を用いて前記進路予測を行うことを特徴とする請求項1又は請求項2記載の車両用障害物検知装置。 - 前記補正手段は、前記車速が予め設定した速度の範囲外の値をとるときには、前記補正の度合を一定に保つことを特徴とする請求項1から請求項4の何れか1項に記載の車両用障害物検知装置。
- 前記補正手段は、前記補正の度合を、前記車速に応じて制限することを特徴とする請求項1から請求項5の何れか1項に記載の車両用障害物検知装置。
- 車両前方の道路の屈曲状況を検出する道路状況検出手段を備え、
前記補正手段は、前記道路状況検出手段で検出される屈曲度合に応じて前記補正の度合を変化させることを特徴とする請求項1から請求項6の何れか1項に記載の車両用障害物検知装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002227240A JP3931760B2 (ja) | 2002-08-05 | 2002-08-05 | 車両用障害物検知装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002227240A JP3931760B2 (ja) | 2002-08-05 | 2002-08-05 | 車両用障害物検知装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004066912A JP2004066912A (ja) | 2004-03-04 |
JP3931760B2 true JP3931760B2 (ja) | 2007-06-20 |
Family
ID=32014335
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002227240A Expired - Fee Related JP3931760B2 (ja) | 2002-08-05 | 2002-08-05 | 車両用障害物検知装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3931760B2 (ja) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004101481A (ja) * | 2002-09-12 | 2004-04-02 | Matsushita Electric Works Ltd | レーダ装置 |
JP4817854B2 (ja) * | 2006-01-27 | 2011-11-16 | アルパイン株式会社 | 周辺物体追尾装置及び周辺物体位置予測方法 |
JP5598119B2 (ja) * | 2010-06-30 | 2014-10-01 | 株式会社豊田中央研究所 | 動力車 |
JP5821288B2 (ja) * | 2011-05-31 | 2015-11-24 | 日産自動車株式会社 | 道路形状予測装置 |
JP6256795B2 (ja) * | 2013-09-19 | 2018-01-10 | いすゞ自動車株式会社 | 障害物検知装置 |
JP2016103226A (ja) * | 2014-11-28 | 2016-06-02 | 株式会社デンソー | 予測進路推定装置 |
JP6356584B2 (ja) * | 2014-11-28 | 2018-07-11 | 株式会社デンソー | 予測進路推定装置 |
US9784592B2 (en) * | 2015-07-17 | 2017-10-10 | Honda Motor Co., Ltd. | Turn predictions |
KR102228386B1 (ko) * | 2015-08-12 | 2021-03-16 | 현대자동차주식회사 | 선회 궤적 예측 기반의 충돌 회피 제동 제어 방법 및 장치 |
JP6072212B1 (ja) * | 2015-12-15 | 2017-02-01 | 三菱電機株式会社 | 衝突判定装置 |
JP6544348B2 (ja) * | 2016-12-22 | 2019-07-17 | トヨタ自動車株式会社 | 車両運転支援装置 |
JP6515912B2 (ja) | 2016-12-22 | 2019-05-22 | トヨタ自動車株式会社 | 車両運転支援装置 |
JP6988717B2 (ja) * | 2018-07-02 | 2022-01-05 | 株式会社デンソー | 衝突判定装置 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3290526B2 (ja) * | 1993-07-06 | 2002-06-10 | マツダ株式会社 | 車両の制御装置 |
JP2799375B2 (ja) * | 1993-09-30 | 1998-09-17 | 本田技研工業株式会社 | 衝突防止装置 |
JP3372190B2 (ja) * | 1997-07-17 | 2003-01-27 | 富士重工業株式会社 | 車両の衝突防止装置 |
JP3183284B2 (ja) * | 1999-01-19 | 2001-07-09 | 株式会社豊田自動織機製作所 | 車両の後退時の操舵支援装置 |
JP2000235699A (ja) * | 1999-02-15 | 2000-08-29 | Denso Corp | 車間距離制御装置 |
JP3637849B2 (ja) * | 2000-07-06 | 2005-04-13 | 日産自動車株式会社 | 車線追従走行制御装置 |
JP4664478B2 (ja) * | 2000-10-24 | 2011-04-06 | 本田技研工業株式会社 | 車両用進行軌跡予測装置 |
-
2002
- 2002-08-05 JP JP2002227240A patent/JP3931760B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2004066912A (ja) | 2004-03-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3611069B1 (en) | Vehicle control device | |
CN110356394B (zh) | 一种车辆主动避让障碍物的方法、装置及汽车 | |
EP3048022B1 (en) | Collision avoidance control system and control method | |
US10407061B2 (en) | Vehicle control system | |
JP6376059B2 (ja) | 自動運転車両の制御装置 | |
JP4005597B2 (ja) | 車両における横ガイド支援方法及びその装置 | |
JP3918656B2 (ja) | 車両用障害物検出装置 | |
EP3418151B1 (en) | Vehicle control device | |
WO2019131903A1 (ja) | 車両制御装置 | |
CN111712414A (zh) | 车辆控制装置 | |
JP3931760B2 (ja) | 車両用障害物検知装置 | |
US11072334B2 (en) | Vehicle control system | |
JP6647681B2 (ja) | 車両制御装置 | |
KR20190045308A (ko) | 차량 판정 방법, 주행 경로 보정 방법, 차량 판정 장치, 및 주행 경로 보정 장치 | |
EP3418152B1 (en) | Vehicle control device | |
EP3854634B1 (en) | Vehicle control method and vehicle control device | |
JP6525415B1 (ja) | 車両制御装置 | |
CN114148328A (zh) | 用于控制车辆驾驶的装置和方法 | |
JP2023536349A (ja) | 車両のための回避軌道を決定するための方法 | |
JP6525416B1 (ja) | 車両制御装置 | |
JP6525414B1 (ja) | 車両制御装置 | |
JP2003141698A (ja) | 障害物存在可能性検出装置及び障害物検出装置 | |
US20240017742A1 (en) | Electronic control device and vehicle control system | |
JP2023010320A (ja) | 自動運転方法、自動運転システム、及び自動運転プログラム | |
CN115867473A (zh) | 路径确认装置、路径确认方法以及车辆控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050624 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20060901 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20060912 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20061113 |
|
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: 20070220 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070305 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100323 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110323 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110323 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120323 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130323 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130323 Year of fee payment: 6 |
|
LAPS | Cancellation because of no payment of annual fees |