JP2007008415A - 車両用運転支援装置 - Google Patents
車両用運転支援装置 Download PDFInfo
- Publication number
- JP2007008415A JP2007008415A JP2005194925A JP2005194925A JP2007008415A JP 2007008415 A JP2007008415 A JP 2007008415A JP 2005194925 A JP2005194925 A JP 2005194925A JP 2005194925 A JP2005194925 A JP 2005194925A JP 2007008415 A JP2007008415 A JP 2007008415A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- road surface
- wheel
- alarm
- distance
- 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.)
- Pending
Links
Images
Landscapes
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
【課題】走行路面上に段差が存在する場合でも段差への進入時の衝撃が比較的小さくて済む場合には不必要に運転支援することなく運転者に煩わしさを与えない適切な運転支援を行うことができる運転支援装置を提供する。
【解決手段】車両が走行する路面と車両との距離を測定する測距センサ部と、前記測距センサ部によって測定された距離値に基づいて、路面の段差及び段差の形状を検出する段差検出手段と、運転者に対して警報を発する警報部と、前記段差検出部において検出された段差の形状に基づいて、検出した段差に前記車両の車輪が進入した際に生じる衝撃の程度を推定すると共に、前記推定された衝撃の程度に基づいて前記警報部から警報を出力するか否かを判断する警報出力判断部と、を備えることを特徴とする車両用運転支援装置。
【選択図】図3
【解決手段】車両が走行する路面と車両との距離を測定する測距センサ部と、前記測距センサ部によって測定された距離値に基づいて、路面の段差及び段差の形状を検出する段差検出手段と、運転者に対して警報を発する警報部と、前記段差検出部において検出された段差の形状に基づいて、検出した段差に前記車両の車輪が進入した際に生じる衝撃の程度を推定すると共に、前記推定された衝撃の程度に基づいて前記警報部から警報を出力するか否かを判断する警報出力判断部と、を備えることを特徴とする車両用運転支援装置。
【選択図】図3
Description
本発明は、車両用運転支援装置に係り、特に測距センサ部を用いて、走行路面に存在する段差を検出して運転者の運転を支援する車両用運転支援装置に関する。
近年、車両の周囲に存在する障害物や路面状況等を認識し、認識結果に基づいて警報の出力制御や自動ブレーキ制御を行う運転支援装置が開発されている。中でも、車両の走行路面における段差を検出し、段差の存在を運転者に報知することで、段差への車輪の乗り上げ又は段差への車輪の脱輪によって車両に衝撃が与えられる状況を運転者に回避させる装置が提案されている。
このような装置として、例えば、超音波センサを用いて路面との距離を測り、この距離値が基準値を下回る場合には路面が高くなる段差があることを判断し、基準値を超える場合には路面が低くなる段差があることを判断する。そして、段差までの距離に応じて警報を出力するものが提案されている(例えば、特許文献1参照)。
特開平7−92263号公報
しかし、車両が走行する路面に段差が存在する場合であっても、段差への乗り上げ時又は段差への脱輪時の衝撃が比較的小さくて済むような場合には、走行上の支障が少ないことから、運転者は、この段差に対して回避操作を行う必要はなく、また、段差の存在を知る必要もない。
脱輪する場合を例にとると、路面が低くなる段差への車輪の脱輪にあっては、脱輪時に車両に与えられる衝撃の程度は段差の深さに加えて段差の形状によっても変化するもので、例え段差の深さが同じでも段差の形状が異なれば脱輪時の衝撃の程度は異なるものとなる。図10(a)と図10(b)に示す路面が低くなる2種類の段差は、互いに段差の深さは同じであるが段差の底面の角度が異なっており、互いに車輪の脱輪状態が異なることを示している。図10(b)に示す車輪の脱輪状態では、図10(a)と比較して、車輪の落ち込み量が少なくなっており、落ち込み量が少ない分、脱輪時の衝撃が小さいことが分かる。そのため、このような場合にまで段差に関する警報が発せられると運転者には却って煩わしさを感じさせることとなる。
本発明の課題は、走行路面上に段差が存在する場合でも段差への進入時の衝撃が比較的小さくて済む場合には不必要に運転支援することなく運転者に煩わしさを与えない適切な運転支援を行うことができる運転支援装置を提供することを目的とするものである。
上記課題を解決するため、本発明の車両用運転支援装置は、車両が走行する路面と車両との距離を測定する測距センサ部と、前記測距センサ部によって測定された距離値に基づいて、路面の段差及び段差の形状を検出する段差検出手段と、運転者に対して警報を発する警報部と、前記段差検出部において検出された段差の形状に基づいて、検出した段差に前記車両の車輪が進入した際に生じる衝撃の程度を推定すると共に、前記推定された衝撃の程度に基づいて前記警報部から警報を出力するか否かを判断する警報出力判断部と、を備えることを特徴とする。
本発明によれば、車両の進行方向に存在する段差を検出して、その段差に車両の車輪が進入した際の衝撃を判断することができる。
ここで本発明の車両用運転支援装置において、前記警報出力判断部は、前記衝撃の程度を評価する評価値を演算し、該評価値によって前記車両の車輪が段差に進入した際に前記車両に生じる衝撃の程度を推定することが好ましい。
本発明によれば、段差検出部が検出した結果に基づいて車両の車輪が前記段差に進入した際に車両に生じる衝撃の程度を推定することができる。
また、前記段差検出部は、路面が低くなる段差の検出を行うとともに、前記警報出力判断部は、前記路面が低くなる段差に前記車両の車輪が脱輪する際の車輪の落ち込み量を前記評価値として演算することが好ましい。
本発明によれば、路面が低くなる段差の検出をできると共に段差検出部において導き出され値に基づいて車両が脱輪した際の車輪の落ち込み量を算出することができる。
更に、前記警報出力判断部は、前記車輪の落ち込み量を、段差の開始点と段差の底面との距離、及び段差の底面の角度に基づいて演算することが好ましい。
本発明によれば、車輪の落ち込み量を、段差の開始点と段差の底面との距離、及び段差の底面の角度に基づいて導き出すことができる。
また、前記段差検出部は、路面が高くなる段差の検出を行い、前記警報出力判断部は、前記路面が高くなる段差に前記車両の車輪が接触する際の段差と車輪が接触する部位の高さ位置を前記評価値として演算することが好ましい。
本発明は、路面の高くなる段差を検出することができると共に、その検出した段差に車両の車輪が接触した際の衝撃を推定することができる。
本発明によれば、脱輪時の衝撃が比較的大きくなる形状をした段差が存在する場合には、これを運転者に報知することが可能であり、これによって運転者に路面の段差に対する回避操作を促すことができる。また、段差に車輪が進入した時の衝撃が比較的小さくなる形状をした段差が存在する場合には警報部は作動されないため、不必要な警報を低減することができ運転者に煩わしさを与えない適切な運転支援を可能にしている。
また、衝撃の程度を評価する評価値を演算し、評価値によって衝撃の程度を推定する場合には、衝撃の値そのものを演算するのに比べて精度を低下させることなく演算量を少なくできるので迅速に警報を出すか否かの判断をすることができる。
更に、路面が低くなる段差を検出して、路面が低くなる段差に車輪が脱輪する際の車輪の落ち込み量を、衝撃の程度を評価する評価値として演算した場合には、脱輪時の衝撃の程度を推定することができ、不必要な警報を低減することができる。
また、検出した段差の開始点と段差の底面との設定によって段差の形状を認識し、段差の開始点と段差の底面との距離、及び段差の底面の角度に基づいて車輪の落ち込み量を演算する場合には、不必要な警報を低減することができる。
更に、路面が高くなる段差の検出を行い、路面が高くなる段差に前記車両の車輪が接触する際の段差と車輪が接触する部位の高さ位置を前記評価値として演算した場合には、不必要な警報を低減することができると共に運転者に煩わしさを与えない適切な運転支援を可能にしている。
以下、図面を参照しながら本発明の実施の形態について説明する。ただし、発明の範囲は図示例に限定されない。
図1は車両用運転支援装置2の概略構成図、図2は測距センサ部の取り付け位置を示す上面透視図、図3は車両用運転支援装置のブロック、図4は路面の段差及び段差形状のを検出するための説明図、図5は車輪の脱輪状態を表す模式図、図6及び図7は本発明に係る車両用運転支援装置を搭載した車両の後輪が路面より高くなっている段差に接触している状態を示す模式図、図8は警報出力の判断ルーチンのフローチャート、図9は路面の段差と段差形状の検出を行うサブルーチンのフローチャートを示す説明図である。
図1に示すように、車両1には、車両の後方路面における段差を検出して運転者の運転を支援する車両用運転支援装置2が搭載されている。
この車両用運転支援装置2は、例えば、車両1の後部に備えられた車両1と路面との距離値Dを検出する測距センサ部3、車両1の速度を検出する車速センサ4、車両の変速機のシフトポジション位置を検出するシフトポジションセンサ5、警報部6、これらの各部を制御すると共に警報出力判定のプログラムを実行する制御部10及び操作部9を備えて構成されている。
測距センサ部3は、例えば、車両1の後部の下面のオーバハング部に設けられた左側超音波センサ3aと右側超音波センサ3bとから構成されている。ここで用いられる超音波センサは、路面との間隔を測定するセンサとして周知の超音波センサが用いられる。この超音波センサは、所定の方向に超音波を放射する送信器と放射された超音波による路面からの反射波を受信する受信器を有して構成され、放射してから反射波を受信検知するまでの時間に応じて距離値Dを測定するようになっている。また、超音波センサは、車両1の前輪14の車両進行方向側の下面にも取り付けてもよい。
図2に示すように、左側超音波センサ3aは、超音波の放射方向が車両1の上面視にて車両1の直進時における左側後輪11aの幅方向における中心線L1上に位置するように配置されている。
また、左側超音波センサ3aは送信器による超音波の送信方向が垂線Mに対して車両1の後方に向かって所定の角度α(例えば20度)を有するように取り付けられている。
また、右側超音波センサ3bも同様に、その放射方向が車両1の上面視にて車両1の直進時における右側後輪11bの幅方向における中心線L2上に位置すると共に右側超音波センサ3bによる超音波の送信方向が垂線Mに対して車両1の後方に向かって所定の角度α(例えば20度)を有するように取り付けられている。
左側超音波センサ3aは、左側後輪11aの後方の車両下面のオーバハング部と路面の距離値Dlを測定するものであり、右側超音波センサ3bは、右側後輪11bの後方路面の距離値Drを測定するものである。
このようにして取り付けられた2つの超音波センサ3a,3bは、車両1が後進走行する際に後輪11a,11bが通過する路面について、その距離値Dl,Drを、後輪11a,11bが通過する前の段階にて測定するようになっている。そして、これら2つの左側超音波センサ3a及び右側超音波センサ3bは共に制御部10に接続されており、検出した距離値Dl、Drを所定の時間間隔(例えば0.2ms)毎に制御部10に入力するように構成されている。
車速センサ4は、車両の車速信号を検出するためのセンサであり、車速センサ4で検出された車速信号Vは制御部10に入力するようになっている。
シフトポジションセンサ5は、シフトレバー又は変速機のギアの位置を検出するものであり、シフトポジションセンサ5は、検出したシフトレバー又は変速機のギアの位置をシフトポジション信号SPとして制御部10に入力するようになっている。
警報部6は、例えばダッシュボード上に備えられたメッセージを表示する表示装置6aと音声を出力するスピーカ6bとによって構成され、後述する警報出力判断部13から出力される作動信号によって作動するようになっている。
図3に示す操作部9は、車両1の運転席付近に設けられた、例えば、LCD(Liquid Crystal Display)等により構成され、制御部10から入力される表示信号の指示に従って、運転者が車両用運転支援装置2における各種設定を行うための設定画面等の各種画面の表示を行う表示手段と、LCDの各種画面上に構成された透明電極を格子状に配置した感圧式(抵抗膜圧式)のタッチパネルにより、画面上を手指で押下された力点のXY座標を電圧値で検出すると共に検出された位置信号を操作信号として制御部10に出力する操作手段とにより構成されている。表示手段に表示される各種画面には操作指示を入力するための操作ボタンが表示され、操作手段は、運転者により押下された座標情報を検出し、その位置信号を操作信号として制御部10に出力する。
車両1の運転者等は、操作部9を操作して例えば、車両1に装着されるタイヤの半径を入力し、後述する警報出力判断部13に記憶させるようになっている。
制御部10は例えばCPU(Central Processing Unit)、ROM(Read Only Memory)及びRAM(Random Access Memory)等から構成され、ROMに格納されている所定のプログラムを読み出してRAMの作業領域に展開し、当該プログラムに沿って各種処理を実行するようになっている。
また、制御部10は、後輪11a,11bの後方路面において路面が低くなる溝状や階段状の段差を検出すると共に段差の形状を認識する段差検出部12、及び段差を検出するために必要な情報が格納されているとともに、検出した段差に後輪が脱輪した際に車両1に与えられる衝撃の程度を推定して車両の警報部6を作動させるか否かを判断する警報出力判断部13とを有して構成されている。
制御部10は、図3に示すように、左側超音波センサ3a、右側超音波センサ3b、車速センサ4、シフトポジションセンサ5及び警報部6と接続されており、制御部10には、これらで検出された、左側後輪11a後方における路面との距離値Dl、右側後輪11b後方における路面との距離値Dr、車速信号V、及び、運転者によって選択されているシフトポジション信号SPが入力されるようになっている。
段差検出部12は、左側超音波センサ3aによって検出された距離値Dlに基づいて左側後輪11a後方における路面の段差を検出する左側段差検出部12aと、右側超音波センサ3bとによって検出された距離値Drに基づいて右側後輪11b後方における路面の段差を検出する右側段差検出部12bとを備えて構成されており、左側段差検出部12aと右側段差検出部12bとがそれぞれ独立して左側後輪11a後方と右側後輪11b後方に存在する段差の検出を行うようになっている。
段差検出部12においては、具体的には以下のように段差の検出を行うようになっている。上述のように段差検出部12は、左側段差検出部12aと右側段差検出部12bを有しているが、これらは、段差の検出を行う路面の位置が異なるほかは実行する処理内容が同じであるため、説明の簡略化を図り、ここでは、左側段差検出部12aにおける実行処理についてのみ説明する。
左側段差検出部12aは、シフトポジションセンサ5から、シフトポジションがRレンジに位置する旨のシフトポジション信号SPが入力されると、左側超音波センサ3aにより測定された車両1の後部の下面のオーバハング部と路面との距離値Dlの読み込みを開始する。
そして、左側段差検出部12aにおいては、左側超音波センサ3aから入力されてくる距離値Dlを時系列に車両1の走行距離に応じて図4(a)に示すような2次元の座標系にプロットする。
図4(a)に示す二次元の座標系のX軸はシフトポジションセンサ5によってRレンジのシフトポジションが検出された時点からの車両1の進行方向における距離を示し、Y軸は左側超音波センサ3aによって検出される距離値Dlを示している。
この座標系のX軸方向における各距離値Dlのプロット間隔は、左側段差検出部12aに距離値Dlが入力されてから次の距離値Dlが入力されるまでの車両1の走行距離に相当する。このプロット間隔は、距離値Dlが入力された時の自車速Vと予め設定された距離値Dlの入力間隔との乗算によって求められるようになっている。
左側段差検出部12aは、測定された距離値Dlを2次元の座標系にプロットすると共に、左側段差検出部12aに備えられているカウンタCl(図示せず)によりカウントし、予め設定された距離の閾値Th1を超える距離値がn回(例えば6回)連続して入力された際に、路面が低くなる段差が存在することを判定するようになっている。そして、図4(a)に示すように、閾値Th1を連続して超える距離値Dl+1〜Dl+6に近似する近似直線L3を段差の底面として求める。尚、この直線近似を行う演算には例えば最小二乗法が用いられる。
左側段差検出部12aは、近似直線L3を段差の底面として設定すると共に、閾値Th1を連続して超える直前に入力された距離値Dl6のプロット点を段差の開始点として設定する。そして、距離値Dl6のプロット点を通過するとともに近似曲線L3と直交する直線L4における距離値Dl6から近似曲線L3と直線L4の交わる点を点P1とする。
そして、図4(b)に示す段差の開始点P2を通過するとともに段差の底面と直交する直線をL5とし、直線L5と段差の底面が交わる点をP3とする。
この場合において、距離値Dl6のプロット点から点P1までの距離が段差の開始点P2から点P3までの距離に該当する。そして、近似曲線L3の傾きが段差の底面の傾斜角度θに該当する。即ち、距離値Dl6のプロット点から点P1までの距離と近似曲線L3の傾きを求めることで路面に形成されている段差の形状を認識する。
このように、左側段差検出部12aは、車両1の走行路面に存在する段差を検出する機能に加えて路面の段差形状を認識する機能を有している。また、右側段差検出部12bも、左側段差検出部12aと同様にして、路面の段差を検出すると共に段差の形状認識を行う。
警報出力判断部13は、段差を検出するのに必要な図4(a)に示すような二次元の座標系、及び操作部9より入力された車両1に装着されているタイヤの半径が記憶されている。また、警報出力判断部13には、警報を出力するか否かを判断するために予め設定されている所定の閾値が記憶されている。
警報出力判断部13は、ここに記憶されている車両1の後輪11の半径を用いて、左側段差検出部12aまたは右側段差検出部12bによって検出された路面の段差に後輪11が脱輪した時の左側後輪11の落ち込み量hを、脱輪時の衝撃の程度を評価する評価値として演算するようになっている。
ここで、左側後輪11aが段差に脱輪した際に車両1に与えられる衝撃は、図5に示すような、左側後輪11aが段差の底面と段差の開始点とに接する状態のときに発生する。このため、警報出力判断部13では、後輪11aが段差の開始点と段差の底面とに接する状態を脱輪状態として左側後輪11aの落ち込み量hを演算する。脱輪時の左側後輪11aの落ち込み量hとは、脱輪し始める直前の左側後輪11aの任意の一点の位置と脱輪状態の左側後輪11aの任意の一点の位置の高低差を意味する。そして、左側後輪11aの脱輪し始める直前の状態とは、図5に示すように左側後輪11aの中心位置が段差開始点P2の垂直方向上方を通過する時の状態をいう。
また、脱輪時の左側後輪11aの落ち込み量hは、路面が低くなる段差に左側後輪11aが脱輪した時の衝撃の程度と比例関係にあることから、脱輪した時の衝撃の程度を示す評価値になるものとして演算される。
この左側後輪11aの落ち込み量hは、左側段差検出部12a或いは右側段差検出部12bによって求められた近似直線L3の傾きθすなわち段差の底面の傾斜角度、段差開始点P2から段差の底面の点P3までの距離と擬制されるプロット位置Dl6から点P1までのの距離L、及び読み出した左側後輪11aの半径rを、以下の(1)式に代入して演算される。
左側後輪11aの落ち込み量hを導き出す方法は、上述の(1)式を用いる方法に限定されるものではない。例えば、図4に示す2次元の座標系に設定した段差開始点P2と段差の底面としての近似直線L3に対して、予め記憶されたタイヤモデルを脱輪状態になるように配置すると共に、左側後輪11aが脱輪し始める直前のタイヤ状態として段差開始点P2の垂直方向上方にタイヤモデルを段差開始点に接しさせて配置し、これら2つのタイヤモデルの中心位置の高低差を左側後輪11aの落ち込み量hとして演算するようにしてもよい。
警報出力判断部13は、このようにして導き出した左側後輪11aの落ち込み量hと警報を出力するか否かを判断するために予め設定されている所定の閾値Th2を比較して、警報を出力するか否かの判断を行うようになっている。
具体的には、左側後輪11aの落ち込み量hが閾値Th2より大きければ、左側後輪11aが段差に進入する前に警報部6に対して作動信号を発するが、閾値Th2より小さい場合には、警報部6に対して作動信号を発しない。
尚、警報出力の判定閾値Th2は、脱輪時に車両1に与えられる衝撃が所定の衝撃値を超えるような場合に作動信号が出力されるように、後輪11aの落ち込み量hが脱輪による衝撃の程度に比例する関係に従って、実験或いは計算等によって予め設定された値になっている。
このように、警報出力判断部13は、演算して求められた左側後輪11aの落ち込み量hが判定閾値Th2を超えるか否かを判定することで、左側後輪11aが段差に脱輪した際の衝撃の程度が所定の衝撃値に達するか否かを評価するものである。
また、警報部6の作動を判断する方法は、判定閾値を用いる方法に限定されることは無く、例えば、左側後輪11aの落ち込み量hと脱輪時の衝撃度との関係を予めマップ化しておき、このマップを用いて、演算した左側後輪11aの落ち込み量hを基にして衝撃度を読み出し、読み出した衝撃度に基づいて警報部6の作動を判断するようにしてもよい。
上記においては、路面が低くなる段差に脱輪する時の衝撃の程度を評価する構成について説明したが、本発明はこれに限らず、路面が高くなる段差の検出と形状認識を行い、段差に乗り上げる際の衝撃の程度を評価する評価値として演算して警報を行うか否かを判断することも可能である。
この場合においては、警報出力判断部13において、例えば、左側後輪11aが走行路面よりも高い段差に接触する際の左側後輪11aと段差の接触部位の高さ位置を、段差に乗り上げる際の衝撃の程度を評価する評価値として演算するように構成する。この左側後輪11aと段差の接触部位の高さは、左側後輪11が段差に乗り上げる際の衝撃の程度と比例関係にあることから、衝撃の程度を示す推定値になるものとして演算される。
即ち、図6(a)に示すように、路面が高くなる段差と左側後輪11aとの接触位置高さshは、段差の高部と車両1の走行路面を繋ぐ段差の側壁部の傾斜角度β、左側後輪11aの半径r、及び段差の高さに基づいて求められる。
なお、以下においても左側段差検出部12aと右側段差検出部12bは、段差の検出を行う路面の位置が異なるほかは実行する処理内容が同じであるため、説明の簡略化を図り、左側段差検出部12aにおける実行処理についてのみ説明する。
具体的には、図6(a)に示すように、側壁部と段差の高部との頂点に左側後輪11aが接触する場合すなわち段差の高さがr−r・cosβ以下の関係にあるときは、接触位置高さshは、段差の側壁部と段差の高部との頂点と同じ高さになる。一方、図6(b)に示すように、左側後輪11aが段差の側壁部に接触する場合すなわち段差の高さがr−r・cosβを超える関係にあるときには、接触位置高さshは、r−r・cosβによって演算される値になる。
尚、この場合においては、左側段差検出部12a、上述の場合と同様に、図7に示すように左側超音波センサ3aによって検出された距離値Dl1〜Dl6を2次元の座標系に順次プロットすると共に、左側段差検出部12aに備えられている図示しないカウンタClによりカウントし、左側超音波センサ3aにより検出された距離値Dlが予め設定された距離の閾値Th3を下回る距離値がn回(例えば6回)連続して入力された際に、車両1の走行路面に路面が高くなる段差があることを判定するようになっている。
また、左側段差検出部12aは、閾値Th3を下回る直前に検出された距離値Dl6とそれ以前に検出された、複数個の距離値Dlに基づいて、左側後輪11aが走行する路面を設定する。具体的には、図7に示すように、距離値Dl6を含めてそれ以前に検出されたn個(例えば6個)の距離値Dl6〜Dl1を抽出してこれらの距離値を近似する近似直線L6を演算し、この近似直線L6を左側後輪11aが段差に接する際の左側後輪11aの走行路面として設定する。
また、左側段差検出部12aは、閾値Th3を下回った距離値Dlのうち、最初に検出された距離値Dl-1を抽出し、この抽出した距離値Dl−1による座標系のプロット位置について近似直線L6に対する直線距離を段差の高さとして求める。更に、閾値Th3を連続して下回った距離値Dlの内、最初に検出された距離値Dl−1による座標系のプロット位置、閾値Th3を下回る直前に検出された距離値Dl6による座標系のプロット位置と、左側後輪11aが段差に接する際の走行路面として設定した近似直線L6に基づいて、段差の側壁部を設定すると共に段差の側壁部の傾斜角度βを演算する。具体的には、距離値Dl−1による座標系のプロット位置と距離値Dl6による座標系のプロット位置とを結ぶ直線L7を段差の側壁部として設定し、走行路面として設定した近似直線L7の傾きを段差の側壁部の傾斜角度βとして演算する。
また、左側段差検出部12aは、閾値Th3を下回った距離値Dlのうち、最初に検出された距離値Dl-1を抽出し、この抽出した距離値Dl−1による座標系のプロット位置について近似直線L6に対する直線距離を段差の高さとして求める。更に、閾値Th3を連続して下回った距離値Dlの内、最初に検出された距離値Dl−1による座標系のプロット位置、閾値Th3を下回る直前に検出された距離値Dl6による座標系のプロット位置と、左側後輪11aが段差に接する際の走行路面として設定した近似直線L6に基づいて、段差の側壁部を設定すると共に段差の側壁部の傾斜角度βを演算する。具体的には、距離値Dl−1による座標系のプロット位置と距離値Dl6による座標系のプロット位置とを結ぶ直線L7を段差の側壁部として設定し、走行路面として設定した近似直線L7の傾きを段差の側壁部の傾斜角度βとして演算する。
警報出力判断部13においては、段差の側壁部の傾斜角度β、左側後輪11a、右側後輪11bの半径r、及び段差の高さに基づいて、接触位置高さshを衝撃の程度を評価する評価値として演算するように構成される。
そして、警報出力判断部13は、演算により導き出された接触位置高さshが、予め定められ記憶されている警報出力の判定閾値Th4を超える場合には、後輪11が段差に乗り上げる際の衝撃が比較的大きくなるとして、警報部6を作動させる作動信号を出力するように構成される。尚、警報出力の判定閾値Th4は、段差への乗り上げ時に車両1に与えられる衝撃が所定の衝撃値を超えるような場合に作動信号が出力されるように、接触高さshが乗り上げによる衝撃の程度に比例する関係に従って、実験或いは計算等によって予め設定された値になっている。
尚、この場合においても、接触位置高さshと衝撃度の関係を予めマップ化しておき、このマップを用いて、演算した左側後輪11aの接触位置高さshを基にして衝撃度を読み出し、読み出した衝撃度に基づいて警報部6の作動を判断するようにしても良い。
また、上述の実施の形態では、車両の左側後輪11aと右側後輪11bの後方における路面の段差を検出する例について説明したが、本発明はこれに限定されるものではなく、例えば、車両1の前輪14の前方路面における段差を検出して警報出力を判定するように構成しても良い。この場合には、シフトポジションセンサからの出力に基づいて車両1が前進状態にあるか後進状態にあるか判定し、前進状態にある場合に前輪前方における路面の段差を検出し、後進状態にある場合は後輪11後方における路面の段差を検出するように切り換えることが好ましい。
更に、上述の実施の形態では、運転者に対する運転支援として、警報部6を作動させる例について説明したが、本発明はこれに限定されるものではなく、例えば、車両1が段差に侵入することを回避するべく、車両のブレーキシステムに作動信号を出力して自動的にブレーキをかけるようにしても良い。
また、上述の実施の形態では、測距センサ部3として左側超音波センサ3a及び右側超音波センサ3bを用いる一例について説明したが、本発明はこれに限定されるものではなく、例えば、路面を撮像するカメラを設け、周知の画像処理によって路面の形状を認識するように構成しても良い。また、この他、周知のレーザレーダ等の測距センサ部3により路面との距離を測定するようにしても良い。
次に本実施の形態に係る発明の作用について、図8及び図9に示すフローチャートに従って説明する。
このルーチンは、シフトポジションセンサ5からの入力信号SPによってRレンジポジションすなわち車両1の後進走行が検出されると図8に示すように、車両用運転支援装置2は左側後輪11a後方における段差の有無の検出及び段差形状の認識を行う(S101)ため、図9に示すサブルーチンに移行する。
図9に示すように、先ず、カウンタClをリセット(Cl=0)した後(S201)、左側超音波センサ3aから車両1と路面との距離値Dlを、車速センサ4から自車速Vを読込む(S202)。
そして、読み込んだ距離値を2次元の座標系にプロットし(S203)、読み込んだ距離値Dlが閾値Th1と閾値Th3の中間の値か否かの判断を行う(S204)。この判断の結果、読み込んだ距離値Dlが閾値Th1と閾値Th3の中間の値であると判断された場合には(YES)、ルーチンを抜ける。一方、読み込んだ距離値Dlが閾値Th1と閾値Th3の中間の値では無いと判断された場合には(NO)、距離値Dlが閾値Th1より大きいか否かの判断を行う(S205)。
閾値Th1を越えている場合には(YES)カウンタClをカウントアップ(Cl←Cl+1)する(S206)。そして、カウンタClが予め設定された数n(例えば6個)に達しているかの判断を行う(S207)、カウンタClが予め設定された数nに達していないと判断された場合は、再度距離値Dlと自車速Vの読み込みを行う(NO)(S202)。
すなわち、これらS201〜S206の処理は、左側後輪11aの後方路面における路面の段差を検出するための処理であり、左側段差検出部12aは、閾値Th1を超える距離値Dlがn回連続して検出した際に走行路面に路面が低くなる段差があることを判定するものである。
カウンタClが予め設定された値Clnに達していると判断した場合には(YES)、閾値Th1を超えるn個の距離値Dlを用いて直線近似を行い、この近似直線を段差の底面として設定すると共に、閾値Th1を連続して超える前の時刻で入力された距離値Dlのプロット点を段差の開始点として設定する(S208)。そして、近似直線の傾きθ、及び点P1と段差のDl6との距離、さらに落ち込み量hを求め(S209)、これによって段差の形状認識を行った後に、段差底面の設定があるか否かの判断を行う(S102)。
S205において、距離値Dlが閾値Th1より大きくないと判断した場合には(NO)、距離値Dlは閾値Th3よりも小さいこととなり、この場合においてもカウンタClをカウントアップ(Cl←Cl+1)する(S210)。そして、カウンタClが予め設定された数n(例えば6個)に達しているかの判断を行う(S211)、カウンタClが予め設定された数nに達していないと判断された場合は、再度距離値Dlと自車速Vの読み込みを行う(NO)(S202)。
カウンタClが予め設定された値Clnに達していると判断した場合には(YES)、
閾値Th3を下回る前に検出されたn個の距離値Dlを用いて直線近似を行い、左側後輪11aが段差に接する際の左側後輪11aの走行路面を近似直線L6として求める。また、閾値Th3を連続して下回った距離値Dlの内、最初に検出された距離値Dl+1を抽出し、この抽出した距離値Dl+1による座標系のプロット位置について近似直線L6に対する直線距離を求め、走行路面からの段差の高さとして設定する(S212)。そして、S213において、閾値Th3を連続して下回った距離値Dlの内、最初に検出された距離値Dl−1による座標系のプロット位置と、閾値Th3を下回る直前に検出された距離値Dl6による座標系のプロット位置とを結ぶ直線L7を段差の側壁部と設定し、走行路面として設定した近似直線L6に対する直線L7の傾きを側壁部の傾斜角度βとして演算する。また、後輪11aと段差の接触位置高さshを演算により求める。すなわち、S213では、段差の形状認識を行うステップである。次に、S102に進み、段差底面の設定があるか否かの判断を行う。
閾値Th3を下回る前に検出されたn個の距離値Dlを用いて直線近似を行い、左側後輪11aが段差に接する際の左側後輪11aの走行路面を近似直線L6として求める。また、閾値Th3を連続して下回った距離値Dlの内、最初に検出された距離値Dl+1を抽出し、この抽出した距離値Dl+1による座標系のプロット位置について近似直線L6に対する直線距離を求め、走行路面からの段差の高さとして設定する(S212)。そして、S213において、閾値Th3を連続して下回った距離値Dlの内、最初に検出された距離値Dl−1による座標系のプロット位置と、閾値Th3を下回る直前に検出された距離値Dl6による座標系のプロット位置とを結ぶ直線L7を段差の側壁部と設定し、走行路面として設定した近似直線L6に対する直線L7の傾きを側壁部の傾斜角度βとして演算する。また、後輪11aと段差の接触位置高さshを演算により求める。すなわち、S213では、段差の形状認識を行うステップである。次に、S102に進み、段差底面の設定があるか否かの判断を行う。
そして、左側段差検出部12aによって段差の底面が設定されているかの判断を行う(S102)。段差の底面が設定されていると判断された場合、すなわち、左側後輪11aの後方路面に閾値Th1を超える深さの段差が検出された場合には(YES)、警報出力判断部13で導き出した落ち込み量hを読込み(S103)、この落ち込み量hが予め設定された閾値Th2を超えているか否かの判断を行う(S104)。
そして、脱輪時の左側後輪11aの落ち込み量hが閾値Th2を超えていると判断した場合には(YES)、作動信号を出力して警報部6aと警報部6bを作動させる(S105)。一方、左側後輪11aの落ち込み量hが警報出力の判定閾値Th2を超えていないと判断された場合にはルーチンを抜ける(NO)。
一方、S102において、段差の底面が設定されていないと判断された場合には(NO)、段差の高さの設定があるか否かの判断を行う(S106)。段差の高さの設定があると判断された場合、すなわち、左側後輪11aの後方路面に閾値Th3を下回る高さの段差が検出された場合には(YES)、S213において警報出力判断部13で導き出された段差の接触位置高さshを読み込み(S107)、この段差の接触位置高さshが予め設定されている閾値Th4を超えているか否かの判断を行う(S108)。
そして、段差の接触位置高さshが閾値Th4を超えていると判断した場合には(YES)、作動信号を出力して警報部6aと警報部6bを作動させる(S109)。一方、段差の接触位置高さshが警報出力の判定閾値Th4を超えていないと判断された場合にはルーチンを抜ける(NO)。
またS106において、段差の高さの設定が無いと判断された場合には(NO)、右側後輪11bの後方における段差の有無の検出及び段差形状の認識を行う(S110)ため、サブルーチンに移行する。しかし、このサブルーチンの内容は左側後輪11a後方における段差の有無の検出及び段差形状の認識を行う場合と同様の処理を行うので、説明を省略する。
そして、右側後輪11bの後方における段差の有無の検出及び段差形状の認識を行った後には段差の高さの設定があるか否かの判断を行う(S111)。段差の高さの設定が無いと判断した場合には(NO)、段差底面の設定があるか否かの判断を行う(S112)。段差底面の設定が無いと判断した場合には(NO)、ルーチンを抜ける。
一方、S111において、段差の高さの設定があると判断した場合、すなわち、右側後輪11aの後方路面に閾値Th1を超える高さの段差が検出された場合には(YES)、左側段差検出部12aにおいて段差の高さ設定があると判断された場合と同様の処理が行われる。また、S112において、段差底面の設定があると判断された場合、すなわち、右側後輪11aの後方路面に閾値Th3を下回る高さの段差が検出された場合には(YES)、左側段差検出部12aにおいて段差の底面の設定があると判断された場合と同様の処理が行われる。
以上、本実施の形態に係る発明によれば、測距センサ部3によって検出された路面との距離値D及び自車速Vに基づいて段差の検出と段差の形状認識を行い、検出した段差に車輪が進入した際に生じる衝撃の程度を推定し、推定された衝撃の程度に基づいて、警報部6の作動を判断する構成であるため、脱輪時の衝撃が比較的大きくなる形状をした段差が存在する場合には、これを運転者に報知することが可能であり、これによって運転者に路面の段差に対する回避操作を促すことができる。また、段差に車輪が進入した時の衝撃が比較的小さくなる形状をした段差が存在する場合には警報部6は作動されないため、不必要な警報を低減することができ運転者に煩わしさを与えない適切な運転支援を可能にしている。
また、衝撃の程度を評価する評価値を演算し、評価値によって衝撃の程度を推定しているため、衝撃の値そのものを演算するのに比べて精度を低下させることなく演算量を少なくできる。
更に、路面が低くなる段差を検出して、路面が低くなる段差に車輪が脱輪する際の車輪の落ち込み量hを、衝撃の程度を評価する評価値として演算しているため、脱輪時の衝撃の程度を推定することができ、不必要な警報を一層低減することができる。
また、検出した段差の開始点と段差の底面との設定によって段差の形状を認識し、段差の開始点と段差の底面との距離、及び段差の底面の角度に基づいて車輪の落ち込み量hを演算しているため不必要な警報を一層低減することができる。
このように、路面が高くなる段差の検出及び形状認識を行い、車輪が段差に乗り上げる際の車輪と段差の接触部位高さshを演算し、この接触部位高さshを、車輪が段差に乗り上げる際に生じる衝撃の程度を評価する評価値として演算し、この評価値に基づいて警報部6を作動させるか否かを判断するため、段差に乗り上げ際の衝撃が比較的大きくなる形状をした段差が存在する場合には、これを運転者に報知することが可能であり、これによって運転者に路面の段差に対する回避操作を促すことができる。また、段差に乗り上げ時の衝撃が比較的小さくて済む形状をした段差が存在する場合には警報部6は作動されないため、不必要な警報を低減することができ運転者に煩わしさを与えない適切な運転支援をすることができる。
1 車両
2 車両用運転支援装置
3 測距センサ部
4 車速センサ
6 警報部
9 操作部
10 制御部
12 段差検出部
13 警報出力判断部
2 車両用運転支援装置
3 測距センサ部
4 車速センサ
6 警報部
9 操作部
10 制御部
12 段差検出部
13 警報出力判断部
Claims (5)
- 車両が走行する路面と車両との距離を測定する測距センサ部と、
前記測距センサ部によって測定された距離値に基づいて、路面の段差及び段差の形状を検出する段差検出手段と、
運転者に対して警報を発する警報部と、
前記段差検出部において検出された段差の形状に基づいて、検出した段差に前記車両の車輪が進入した際に生じる衝撃の程度を推定すると共に、前記推定された衝撃の程度に基づいて前記警報部から警報を出力するか否かを判断する警報出力判断部と、
を備えることを特徴とする車両用運転支援装置。 - 前記警報出力判断部は、前記衝撃の程度を評価する評価値を演算し、該評価値によって前記車両の車輪が段差に進入した際に前記車両に生じる衝撃の程度を推定することを特徴とする請求項1に記載の車両用運転支援装置。
- 前記段差検出部は、路面が低くなる段差の検出を行うとともに、
前記警報出力判断部は、前記路面が低くなる段差に前記車両の車輪が脱輪する際の車輪の落ち込み量を前記評価値として演算することを特徴とする請求項1又は請求項2に記載の車両用運転支援装置。 - 前記警報出力判断部は、前記車輪の落ち込み量を、段差の開始点と段差の底面との距離、及び段差の底面の角度に基づいて演算することを特徴とする請求項1から請求項3のいずれか一項に記載の車両用運転支援装置。
- 前記段差検出部は、路面が高くなる段差の検出を行い、
前記警報出力判断部は、前記路面が高くなる段差に前記車両の車輪が接触する際の段差と車輪が接触する部位の高さ位置を前記評価値として演算することを特徴とする請求項1又は請求項2に記載の車両用運転支援装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005194925A JP2007008415A (ja) | 2005-07-04 | 2005-07-04 | 車両用運転支援装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005194925A JP2007008415A (ja) | 2005-07-04 | 2005-07-04 | 車両用運転支援装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2007008415A true JP2007008415A (ja) | 2007-01-18 |
Family
ID=37747445
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005194925A Pending JP2007008415A (ja) | 2005-07-04 | 2005-07-04 | 車両用運転支援装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2007008415A (ja) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008102735A1 (ja) * | 2007-02-20 | 2008-08-28 | Toyota Jidosha Kabushiki Kaisha | 車両走行支援装置及び方法 |
CN101870295A (zh) * | 2010-06-24 | 2010-10-27 | 武汉理工大学 | 一种大型养路作业车脱轨检测装置 |
KR101628581B1 (ko) * | 2014-12-31 | 2016-06-08 | 현대자동차주식회사 | 도로의 과속방지턱 감지장치 및 방법 |
CN106740562A (zh) * | 2016-12-28 | 2017-05-31 | 北京维博信通科技有限公司 | 电子倒车辅助控制系统 |
JP2019093761A (ja) * | 2017-11-17 | 2019-06-20 | 株式会社アドヴィックス | 車両の走行支援装置 |
CN111204330A (zh) * | 2018-11-20 | 2020-05-29 | 株式会社斯巴鲁 | 车辆控制装置 |
CN113044136A (zh) * | 2021-03-08 | 2021-06-29 | 京东鲲鹏(江苏)科技有限公司 | 无人车越障的控制方法、装置、介质 |
-
2005
- 2005-07-04 JP JP2005194925A patent/JP2007008415A/ja active Pending
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2008102735A1 (ja) * | 2007-02-20 | 2008-08-28 | Toyota Jidosha Kabushiki Kaisha | 車両走行支援装置及び方法 |
US8126625B2 (en) | 2007-02-20 | 2012-02-28 | Toyota Jidosha Kabushiki Kaisha | Vehicle drive assist apparatus and method |
CN101870295A (zh) * | 2010-06-24 | 2010-10-27 | 武汉理工大学 | 一种大型养路作业车脱轨检测装置 |
KR101628581B1 (ko) * | 2014-12-31 | 2016-06-08 | 현대자동차주식회사 | 도로의 과속방지턱 감지장치 및 방법 |
CN106740562A (zh) * | 2016-12-28 | 2017-05-31 | 北京维博信通科技有限公司 | 电子倒车辅助控制系统 |
JP2019093761A (ja) * | 2017-11-17 | 2019-06-20 | 株式会社アドヴィックス | 車両の走行支援装置 |
US11440547B2 (en) | 2017-11-17 | 2022-09-13 | Advics Co., Ltd. | Vehicle travel assistance device |
CN111204330A (zh) * | 2018-11-20 | 2020-05-29 | 株式会社斯巴鲁 | 车辆控制装置 |
JP2020082883A (ja) * | 2018-11-20 | 2020-06-04 | 株式会社Subaru | 車両制御装置 |
CN113044136A (zh) * | 2021-03-08 | 2021-06-29 | 京东鲲鹏(江苏)科技有限公司 | 无人车越障的控制方法、装置、介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6313278B2 (ja) | 渡渉検知用ディスプレイの制御システム | |
US8630793B2 (en) | Vehicle controller | |
EP2189811B1 (en) | Determination and signalling to a driver of a motor vehicle of a potential collision of the motor vehicle with an obstacle | |
JP5971341B2 (ja) | 物体検出装置及び運転支援装置 | |
JP4735346B2 (ja) | 運転支援装置及び運転支援システム | |
CN109204136B (zh) | 周边图像显示控制装置 | |
CN106573589B (zh) | 碰撞预测时间计算装置以及碰撞预测时间计算方法 | |
KR101581188B1 (ko) | 차선변경 경보 장치 | |
JP2007008415A (ja) | 車両用運転支援装置 | |
KR20150051735A (ko) | 주차 보조 시스템 및 그 방법 | |
JP2005145301A (ja) | 車両の運転支援装置 | |
US20180055438A1 (en) | Driver's physical condition detection device and method | |
KR20150059489A (ko) | 협로 검출 방법과 협로 검출 장치 및 협로 검출 시스템 | |
JP2007003287A (ja) | Gpsロストの予測方法、gpsロストの予測装置及び車両用走行制御装置 | |
JP6577767B2 (ja) | 物体検知装置及び物体検知方法 | |
JP2014106897A (ja) | 通行可否判定装置 | |
JP2009075638A (ja) | 車種判別装置 | |
JP4320873B2 (ja) | 車両用駐車スペース検出装置 | |
KR20160071875A (ko) | 차량의 자율 주행을 위한 전자 장치 및 방법 | |
JP2004354326A (ja) | 車両周囲表示装置 | |
CN110843786A (zh) | 用于确定和显示涉水状况的方法和系统及具有该系统的车辆 | |
KR20180006635A (ko) | 교차로 충돌 회피 시스템 및 그 제어 방법 | |
JP2012234373A (ja) | 運転支援装置 | |
JPH10117341A (ja) | 車両周辺監視装置、この装置に用いられる障害物検出方法、及びこの装置に用いられる障害物検出プログラムを記憶した媒体 | |
KR20190055898A (ko) | 차선 변경 보조 시스템 |