[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JP3744352B2 - Obstacle position measuring method and obstacle position measuring device - Google Patents

Obstacle position measuring method and obstacle position measuring device Download PDF

Info

Publication number
JP3744352B2
JP3744352B2 JP2000375787A JP2000375787A JP3744352B2 JP 3744352 B2 JP3744352 B2 JP 3744352B2 JP 2000375787 A JP2000375787 A JP 2000375787A JP 2000375787 A JP2000375787 A JP 2000375787A JP 3744352 B2 JP3744352 B2 JP 3744352B2
Authority
JP
Japan
Prior art keywords
vehicle
measured
behind
hidden
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.)
Expired - Fee Related
Application number
JP2000375787A
Other languages
Japanese (ja)
Other versions
JP2002181936A (en
Inventor
倫子 下村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2000375787A priority Critical patent/JP3744352B2/en
Publication of JP2002181936A publication Critical patent/JP2002181936A/en
Application granted granted Critical
Publication of JP3744352B2 publication Critical patent/JP3744352B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Traffic Control Systems (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Description

【0001】
【発明の属する技術分野】
本発明は、車両周囲に存在する物体までの距離を計測する距離計測装置に関し、特に、手前の物体の背後に物体が隠れているかどうかを判断することができる障害物位置計測方法および障害物位置計測装置に関する。
【0002】
【従来の技術】
従来の障害物位置計測方法としては、例えば特開平11−316275号公報に記載された方法が報告されている。
この方法は、車両にスキャニングレーザレーダを搭載しておき、追従中の前方物体の観測ベクトルを求め、複数の目標物体の軌跡を推定することで、その物体に追従しながら物体までの距離を計測するものである。
【0003】
【発明が解決しようとする課題】
しかしながら、このような方法では、複数の物体を検知しているにも関わらず、複数の物体が互いに隠れ合っている状態が考慮されていないため、物体の一部が他物体に隠れると、隠れた物体の大きさを求められないといった問題があった。
また、物体の一部が他の物体の背後に隠れることで計測対象物体の大きさが変化するため、物体への追従判断を誤るといった問題があった。さらに、物体の一部が隠れることでその物体の中心位置が変化するため、物体の軌跡ベクトルが正しく求められなくなるといった問題があった。
【0004】
本発明は、上記に鑑みてなされたもので、その目的としては、手前の物体の背後に物体が隠れているかどうかを判断することができる障害物位置計測方法および障害物位置計測装置を提供することにある。
【0005】
【課題を解決するための手段】
請求項1記載の発明は、上記課題を解決するため、車両の周囲に送信波を所定の検知角度で走査しながら前記送信波の反射波を受信して前方物体までの距離と方位を計測する障害物位置計測方法において、前記物体までの距離と方位とその物体の大きさを計測する計測手順と、計測した物体の一部が手前の物体の背後に隠れているかどうかを判断する隠れ判断手順と、計測中の物体が前回の時点で計測した物体と同一物体であるかどうか判断する同一物体判断手順と、同一距離に位置する物体の連続的な動きを表す動きベクトルを計測する動きベクトル計測手順と、計測中の物体が正面から横方向に移動した場合に、その物体の移動後に背後に別の物体を計測したときには、背後の物体の一部が隠れていることを示すフラグを前記計測結果に付加するフラグ付加手順と、手前の物体が背後の物体を隠さない位置まで移動した後も、現われてきた当該物体の大きさが隠れていた時点のままである場合は、幅の狭い物体が存在することと判断する狭物体判断手順と、を有することを要旨とする。
【0008】
請求項記載の発明は、上記課題を解決するため、車両周囲の所定の範囲内に送信波を送信する送信手段と、前記送信波の反射波を受信する受信手段と、前記所定の範囲内に存在する物体までの距離と方位とその物体の大きさを計測する計測手段と、計測した物体の一部が手前の物体の背後に隠れているかどうかを判断する隠れ判断手段と、計測中の物体が前回の時点で計測した物体と同一物体であるかどうか判断する同一物体判断手段と、同一距離に位置する物体の連続的な動きを表す動きベクトルを計測する動きベクトル計測手段と、計測中の物体が正面から横方向に移動した場合に、その物体の移動後に背後に別の物体を計測したときには、背後の物体の一部が隠れていることを示すフラグを前記計測結果に付加するフラグ付加手段と、手前の物体が背後の物体を隠さない位置まで移動した後も、現われてきた当該物体の大きさが隠れていた時点のままである場合は、幅の狭い物体が存在することと判断する狭物体判断手段と、を有することを要旨とする。
【0011】
【発明の効果】
請求項1記載の本発明によれば、検知領域内に存在する物体までの距離と方位とその物体の大きさを計測しておき、計測した物体の一部が手前の物体の背後に隠れているかどうかを判断し、計測中の物体が前回の時点で計測した物体と同一物体であるかどうか判断し、同一距離に位置する物体の連続的な動きを表す動きベクトルを計測し、計測中の物体が正面から横方向に移動した場合に、その物体の移動後に背後に別の物体を計測したときには、物体の一部が隠れていることを示すフラグを付加し、手前の物体が背後の物体を隠さない位置まで移動した後も、現われてきた当該物体の大きさが隠れていた時点のままである場合は、幅の狭い物体が存在することと判断することで、この物体が自車両の走行を妨げるような障害物ではないことを判断することができる。
【0014】
請求項記載の本発明によれば、車両周囲の所定の範囲内に送信波を送信し、送信波の反射波を受信し、次に、所定の範囲内に存在する物体までの距離と方位とその物体の大きさを計測しておき、計測した物体の一部が手前の物体の背後に隠れているかどうかを判断し、計測中の物体が前回の時点で計測した物体と同一物体であるかどうか判断し、同一距離に位置する物体の連続的な動きを表す動きベクトルを計測し、計測中の物体が正面から横方向に移動した場合に、その物体の移動後に背後に別の物体を計測したときには、物体の一部が隠れていることを示すフラグを付加し、手前の物体が背後の物体を隠さない位置まで移動した後も、現われてきた当該物体の大きさが隠れていた時点のままである場合は、幅の狭い物体が存在することと判断することで、この物体が自車両の走行を妨げるような障害物ではないことを判断することができる。
【0017】
【発明の実施の形態】
以下、本発明の実施の形態を図面を参照して説明する。
図1は、本発明の一実施の形態に係る障害物位置計測方法および障害物位置計測装置を適用可能な障害物位置計測装置11の構成を示す図である。
スキャニングレーザレーダ13は、車両前方の走行方向に対して垂直かつ路面に平行な1次元方向を所定の検知角度でスキャニングしながらレーザレーダ(送信波)をパルス信号として照射し、出射したレーザレーダが車両前方に存在する物体により反射された反射波を受信して受信信号を出力する。
【0018】
距離・位置・大きさ計測部15は、スキャニングレーザレーダ13が照射したパルス信号と受信した受信信号に基づいて、レーザレーダの出射から車両前方に存在する物体による反射波の入射までの伝搬遅延時間を検出して検知角度内に存在する全ての物体までの距離を計測し、さらに、方位を計測する。さらに、計測した距離と方位に基づいて、前方車両に対する自車両の角度を算出し、さらに、この角度に基づいて、当該前方車両までの距離、位置および物体の大きさを算出する。また、距離・位置・大きさ計測部15は、同じ物体と判断される部分にグルーピング処理を実行する。
【0019】
追従判断部17は、距離・位置・大きさ計測部15で実行されたグルーピング処理の結果位置が時間的に小さな距離しか移動しない場合、かつ、グルーピング処理時に動き計測部19で計測される動きベクトルが時間的に連続している場合に、物体への追従を行うことと判断する。
動き計測部19は、検出物体の左右端点の座標を求め、その左右端点の時間的動きを動きベクトルとして繋ぐことで時間的に連続して計測している物体の軌跡を求める。
物体位置関係判断部21は、スキャニングレーザレーダの位置と二つの別の物体の位置関係に基づいて、物体の背後に他の物体の一部が隠れているかを判断し、物体の一部が隠れているときに隠れフラグと、その物体の距離、位置、大きさ、動きベクトルを物体の計測結果として出力する。
【0020】
なお、上述した距離・位置・大きさ計測部15、追従判断部17、動き計測部19、物体位置関係判断部21を制御プログラムにより実行される機能モジュールとしてもよく、この場合、CPU23の内部ROMに記憶されている制御プログラムに従って実行される。
また、作用装置25は、物体位置関係判断部21から出力された物体の距離、位置、大きさ、動きベクトル、隠れフラグに基づいて、車両に設けられたブレーキやスロットルバルブなどに接続されているアクチュエータを制御して車両制御を行う。
【0021】
図2(a),(b)は、車両に搭載されたスキャニングレーザレーダ13の位置とそれぞれの基準座標系を示す図である。
図2(a),(b)に示すように、自車両29に搭載されたスキャニングレーザレーダ13のスキャニングの中心軸(Z)は、それぞれ自車両29の幅方向(X)の中心位置に直進方向(Z)に平行な方向に取り付けられており、それぞれの基準座標系の原点が路面に鉛直方向(Y)に同じ位置に取り付けられている。
【0022】
自車両29に対する検知物体の位置は、原点をスキャニングレーザレーダ13の中心点、そのZ軸(物体までの距離を表す)をスキャニングレーザレーダ13の中心軸方向、X軸(物体の横位置を表す)をスキャニング面に平行な方向、Y軸をスキャニング面に対して垂直な方向とした座標系を基準にしている。
以下、説明のためスキャニングレーザレーダ13の出射面の中心を原点とした基準座標系を用いて説明する。ただし、この発明は、中心軸が直進方向でない場合や、その取り付け位置が自車両29の中心軸からずれている場合でも、その角度、位置を幾何学計算時に考慮すれば、全て以下の説明で成り立つものである。
【0023】
次に、図3に示す自車両前方の状況を参照して、障害物位置計測装置11の基本的な動作を説明する。図3は、自車両29の前方正面に車両31が走行中であり、その背後の左斜前方に他の車両33が存在する状況において、それぞれの車両の配置と自車両29に搭載したスキャニングレーザレーダ13での計測結果の様子を示した図である。
スキャニングレーザレーダ13のビームは、それぞれの検知角度においてレーザレーダから一番近い位置に存在する反射面までの距離を計測し、かつ、その前方に反射面がある場合でも、その面とレーザレーダの間にビームの到達を防げる物体が存在する場合は、反射面までの距離は計測ができなくなる。
【0024】
図3に示す状況の場合、正面の車両31上に存在する左右の反射面と、左斜め前方に存在する車両33の左側の反射面までの距離は計測できるが、車両33の右側の反射面は、車両31の背後に隠れる位置にあるため、距離の計測ができない。この結果、スキャニングレーザレーダ13のみで計測が可能である部分は、図3に示す○印の位置だけである。
そこで、車両31の背後に計測された車両33が、車両幅A(m)の車両であると仮定した場合、その車両33の一部が手前の車両31により隠れる位置にあるかどうかを判断するには、自車両29に搭載したスキャニングレーザレーダ13の位置と二つの車両31,33の位置関係に基づいて、物体位置関係判断部21により幾何学的に計算できる。特に、図3に示すように、車両31の背後に物体の一部が隠れていると判断された場合は、物体位置関係判断部21は、物体(車両33)の一部が隠れている可能性があることを示す隠れフラグと、その物体の距離、位置、大きさ、動きベクトルを物体の計測結果とする。
【0025】
従って、物体位置関係判断部21からの出力結果に基づいて、車両31の背後にある物体(車両33)が大きな障害物であることも考慮にいれた車両制御を作用装置25に行わせることができるようになる。例えば、通常運転における運転手の判断では、前方障害物が小さい物体である場合は、速度は変えずにハンドル操作による微小な進路変更だけで走行し、前方に停止車両などの大きな障害物がある場合は停止するなどの車両制御を作用装置25に行わせる。また、前方に障害物が存在するがそれが何であるか判らない場合は、その物体により近づくまでは速度を緩めながら近づき、急ブレーキにも対応できるような前準備をすることが多い。このような場合でも、何であるかわからないが障害物となる可能性のある物体が存在するということを隠れフラグとして与えることができるため、物体の種類がわかるまでは、ブレーキにも対処できるように、予め速度を落としておくなどの運転者による車両操作と同等な車両制御を作用装置25に行わせることができる。
【0026】
次に、図4に示すフローチャートを参照して、障害物位置計測装置11の動作を説明する。
まず、ステップS10では、スキャニングレーザレーダ13で距離計測を行わせ、距離・位置・大きさ計測部15で同じ物体と判断される部分にグルーピング処理を実行することで、自車両29前方に存在する計測領域内の物体を発見し、その物体までの距離、位置、大きさを求める。このグルーピング処理は、図5,図6に示すように、同じ距離に位置し、時間的に連続して同じ方向に動くものを同じ物体と判断することで行える。
【0027】
ここで、図5(a)に示す離脱車両の軌跡を参照して、距離・位置・大きさ計測部15によるグルーピング処理について説明する。図5(a)は、先行車(離脱車両41)より先の正面から少し左寄り前方に停止した車両43が存在し、かつ、自車両29の正面に走行中の先行車(離脱車両41)が離脱する場合の自車両29に搭載されたスキャニングレーザレーダ13で計測した結果の軌跡を示している。先行車は右前方に離脱して離脱車両41となるため、その軌跡は、徐々に右斜め前に移動するように観測される。
【0028】
次に、ステップS20では、上述したグルーピング処理の結果位置が時間的に小さな距離しか移動しない場合、かつ、グルーピング処理時に動き計測部19で計測される動きベクトルが時間的に連続している場合に、追従判断部17は物体への追従を行うことと判断する。
次に、ステップS30では、検出された物体の中から、幅が狭い物体を選択し、その物体がその物体より手前の物体により一部が隠れている可能性があるかどうかを判断する。
【0029】
この判断処理は、例えば図7に示すように、自車両29に近い物体51までの距離がz1 、物体51よりも遠い物体53までの距離がz2 であり、物体51の左右端の座標が(x11,z11)、(xr1,zr1)とする。このとき、物体53の検出位置は、物体51の左奥であることから、物体53の検出点は、物体53の左端点であると判断し、その座標を(x12,z12)とする。
【0030】
さらに、隠れる可能性のある部分は、図6に示すように、物体53の右端点であることから、物体53の物体幅をAと仮定し、物体53の右端点を(x12+A,z12)とする。ただし、これらの座標はすべて、図2に示した基準座標系上の点とする。
【0031】
ここで、このようにして求めた点を用いて隠れ判断処理を実行する。
まず、隠れている物体53の右端点(x12+A,z12)とスキャニングレーザレーダ13の中心点を結ぶ直線の式を求める。スキャニングレーザレーダ13の中心点は基準座標系の原点としているため、物体53の右端点とレーザレーダの中心点を結ぶ直線の式は、(1)式となる。
【0032】
【数1】
x=((x12+A)/z12×z)×2 …(1)
物体53の右端点が他の物体により隠れる位置にあるかどうかを判断するには、それより手前に検知されている物体の間に存在することを調べればよい。すなわち、図6において、物体51の左右端の座標(x11,z11)、(xr1,zr1)を結ぶ線分と(1)式が交わることを調べることに相当するため、
【数2】
x11≦((x12+A)/z12)×z11
かつ
((x12+A)/z12)×z11≦xr1 …(2)
(2)式が成り立つ場合、物体53の右端が51により隠れていると判断することができるので、ステップS40に進む。一方、(2)式が成り立たない場合、ステップS10に戻り、上述した処理を繰り返す。
【0033】
ステップS40では、最後の結果の出力では、検知された物体のすべての距離、位置、大きさなどを出力する。この結果の出力の際、前述の判断により、幅が狭くかつ手前の物体により物体の一部が隠れている可能性があると判断された場合、物体の一部が隠れている可能性があることを示す隠れフラグを付加する。
【0034】
さらに、ステップS50では、物体位置関係判断部21は、検知物体の距離、横位置、動き、大きさ、隠れフラグを出力する。
【0035】
次に、前方の先行車が離脱するときにおけるその先の物体の隠れ可能性の判断処理について説明する。
前方の物体の位置検出は、図5を参照して説明したグルーピング処理により行える。また、時間的に連続して計測している物体の軌跡は、図7に示すように、検出物体の左右端点の座標を求め、その左右端点の時間的動きを図5,図6(a)に示すような方法を用い、動きベクトルで繋ぐことで求めることができる。
【0036】
このようにして、軌跡を求めた先行車が離脱するとわかった場合、その先行車の先に物体があるときには、その先の物体は、図5(a)に示すように、離脱開始時点では物体の端だけが観測され、先行車が離脱するにつれ、徐々に物体の全体が見えるようになる。
つまり、離脱開始時点では、その奥に検知される物体の一部が隠れるため幅が狭い物体として観測される。例えば、図5(a)に示すように、離脱開始時点では、離脱車両の背後に検知される物体の一部が幅の狭い物体(車両)として観測される。
【0037】
しかし、図5(a)に示すように、離脱車両41の背後に車両の一部が隠れているので、この車両の実際の大きさは、この時点ではわからない。このため、離脱車両41の背後に物体(車両43)を検知した場合は、その物体の検知開始時では、まず、物体の一部が隠れていることを示す隠れフラグを離脱した物体の距離・位置の結果に付加して出力する。この際、検出された幅の狭い物体(車両)の一部が手前の物体(離脱車両)により隠れていることは、上述した図6に示す方法を用いて判断することができる。
【0038】
次に、先行車が離脱後に前方に小さい物体が存在する場合について説明する。
【0039】
上述したように、図5(a)に示すように、離脱車両41が離脱を開始した時点では、離脱車両41の背後の物体(車両43)は一部しか検知できていないため、背後の物体は幅の狭い物体として検知される。しかし、離脱車両41が離脱後は、背後の物体(車両43)の全体が見える。このため、例えば、図6(b)に示すように、仮に設けた離脱車両の背後の物体の右端端が見える位置になった後も、右端が検知される位置から何も検知されなかった場合、離脱車両の背後の物体は細い物体47であると判断することができる。この判断処理は、(2)式が成立しない位置関係になることから判断することができる。
【0040】
次に、先行車によって背後に隠れている位置を判断する場合の基準値を車両幅とする例を説明する。
これは、上述したように仮に設けておいた物体幅A(m)を通常の平均的な車両幅にとればよい。また、走行中の道路によって、例えば、大型優先の車線走行中においては、物体幅A(m)を大型車両の車両幅にとるなどして、適用される値を可変にしてもよい。
【0041】
先行車が離脱する前に、図7、(1)式および(2)式により、離脱車両の背後に物体の一部が隠れていると判断された場合には、仮に設けておいた物体幅Aを加味した位置とし、例えば、図7に示すような場合は、予想される点(x12+A,z12)の動きを物体53の右端点の動きとすればよい。このようにして、物体51の背後に物体53が隠れていると判断されている間、時間的に連続して物体の予想される右端の点(x12+A,z12)を求めておく。
【0042】
このように、先行車の軌跡を求めておき、先行車が離脱途中で離脱車両となり、この離脱車両の背後の一部が隠れる位置に物体があると検知された場合は、さらに、離脱中の追従車両の軌道算出と同じ原理で、離脱車両の前方に検知された物体の軌道を求めることもできる。
【0043】
この物体は、離脱車両の背後にあるためその一部が隠れる位置にあるので、左右端の位置から軌跡を求めることはできないが、検知されている部分の軌跡を求めるだけでもその動きは求めることはできる。
例えば、図5に示すように、左斜め前の車両が停止車両である場合、連続して検知されているこの左端の部分により、自車両29の速度ベクトルと同じ長さで近づく軌跡ベクトルを得ることができるため、この車両が停止していることと判断することができる。この結果、先行車の離脱に先立って停止障害物があることを事前に検知することができ、停止障害物への衝突を回避するため、作用装置25による車両制御にも利用することができる。
さらに、この検知情報を、車両前方の死角部分や運転席から見難い外界環境を監視するための視覚補助用のディスプレーなどに表示するシステムにも応用可能である。
【0044】
以下、本実施の形態における効果を説明する。
検知領域内に存在する物体までの距離と方位とその物体の大きさを計測しておき、計測した物体の一部が手前の物体の背後に隠れているかどうかを判断し、計測した物体の一部が手前の物体の背後に隠れていると判断された場合に、当該物体の一部が隠れていることを示す隠れフラグを前記計測結果に付加することで、この隠れフラグの有無により手前の物体の背後に物体が隠れているかどうかを判断することができる。
【0045】
また、計測中の物体が前回の時点で計測した物体と同一物体であるかどうか判断し、同一距離に位置する物体の連続的な動きを表す動きベクトルを計測し、計測中の物体が正面から横方向に移動した場合に、その物体の移動後に背後に別の物体を計測したときには、物体の一部が隠れていることを示す隠れフラグを付加することで、この隠れフラグの有無により計測中の物体が正面から横方向に移動した直後でも、正面に新にた物体が現れたかどうかを判断することができる。
【0046】
さらに、手前の物体が背後の物体を隠さない位置まで移動した後も、現われてきた当該物体の大きさが隠れていた時点のままである場合は、幅の狭い物体が存在することと判断することで、この物体が自車両の走行を妨げるような障害物ではないことを判断することができる。
【0047】
以下、本実施の形態における効果を具体的に説明する。
図5(a)に示すように、左前方に位置する計測中の障害物(車両43)は、先行車が自車両29の正面に位置する場合は、幅の狭い物体のように観測されるが、離脱車両41が離脱後には、左斜め前の車両43の全体が自車両29から見える位置関係になるので、車両43の全体の位置が計測されるようになり、かつ、この車両43が停止している場合、この車両43までの距離は徐々に近づくように観測される。先行車(離脱車両41)の動きの軌跡は、距離計測中の物体で距離が同じ位置にある点をグルーピング処理し、その結果、全体が常に同じ方向に移動するものを計測するので、その移動の方向(図5に示す矢印)から、先行車(離脱車両41)の動きを計測することができる。
【0048】
この方法により、先行車の軌跡を求め、離脱しようとする車両の背後に幅の狭い物体が検知された場合は、上述したように、離脱しようとする先行車によって一部が隠れている可能性があることを示す隠れフラグを先行車の背後にある物体の位置、距離に付加した計測結果とする。
【0049】
また、図5(a)に示すように、自車両29の前方に検知している先行車の動きを求め、先行車が自車両29の進路上から離脱する場合に、図5(b)に示すように、先行車が離脱する過程で背後にある物体を検知したときには、自車両29の進行方向上に障害物となる可能性のある物体があることを知らせるため、障害物の一部が離脱車両によって隠れている可能性があることを示す隠れフラグを距離・位置・大きさなどに付加して出力するので、先行車との車間距離の変化に応じて車間距離に対応して自車両の制御を行う場合でも、先行車の離脱により前方の進路が空いたために自車両の前方に障害物があるにも拘わらず、自車両が速度を上昇するような危険な速度制御を回避することができるようになる。
【0050】
さらに、通常の運転者の判断による運転操作の場合、追従中の先行車が離脱した場合には、直ぐには速度を上昇させず、まず、その離脱車両の背後に障害物や速度の遅い車両の存在を疑い、自車両の走行の妨げになるものがないと判断したときには速度を上昇させる。一方、何かの障害物を発見した場合には、それが何であるかを判断した後に、自車両29の制御を求めるという操作を行う。
【0051】
本実施の形態によれば、離脱車両の背後に物体の存在を検知した際には、まず、物体の一部が離脱車両で隠れているため、物体の大きさ・種類がわからないが、何かが存在するという隠れフラグを付加して出力するため、通常の運転者に近い運転制御ができるようになる。
【0052】
また、離脱車両の背後に検知した物体の動きの軌跡をも計測することで、例えば、離脱車両の背後の物体が停止物体であれば、ブレーキ操作の準備を行うことができる。また、この物体の速度が遅い場合、ブレーキ操作による減速の準備を行うことができる。さらに、新たに検知された物体の自車両29との相対速度が0に近い場合には、自車両の速度を維持するなどの敏速な速度調整判断もできるようになる。
【0053】
また、図6(b)に示すように、先行車が離脱した後も、検知されている物体が幅の狭い物体47として検知されている場合には、その物体に付加していた隠れフラグを取り除くようにしたため、離脱車両の背後にある物体が小さく、走行の妨げにはならない物体であることを瞬時に判断できるようになるため、スムーズな速度制御が可能となる。例えば、幅の狭い停止物体であると判断された場合、ブレーキの準備に入るが、それが、標識など、自車両29の走行の妨げにはならない停止物体であるとわかった場合には、即時にブレーキ制御の準備を止め、通常走行に戻せるようになる。このように、安全走行への対応を取りながら無駄な加減速を少なくするスムーズな車両制御を作用装置25により行う。
【0054】
さらに、検知物体が他の物体に隠れている可能性があることを判断する際に、この幅の基準を通常の車両幅とするようにしたため、スキャニングレーザレーダが検知し路上に存在する物体の中で最も利用数の多い車両への判断ができるようになるため、利用可能な場面が多くなる。また、走行車線によって、例えば、大型専用車線やバス優先車線などでは、その車両幅を大型車両の車両幅に設定することで、実用に適した対応も可能となる。
【図面の簡単な説明】
【図1】本発明の一実施の形態に係る障害物位置計測方法および障害物位置計測装置を適用可能な障害物位置計測装置11の構成を示す図である。
【図2】車両に搭載されたスキャニングレーザレーダ13の位置とそれぞれの基準座標系を示す側面透視図(a),上面透視図(b)である。
【図3】正面の物体とその物体に一部が隠れる位置にもう1つの物体が存在するときのスキャニングレーザレーダの検知結果を示す図である。
【図4】障害物位置計測装置11の動作を説明するためのフローチャートである。
【図5】離脱開始時の先行車に対するグルーピング処理の様子を示す図(a)と、先行車が離脱後に現れる車両の様子を示す図(b)である。
【図6】離脱開始時の先行車に対するグルーピング処理の様子を示す図(a)と、先行車が離脱後に現れる物体の様子を示す図(b)である。
【図7】物体位置の算出方法について説明するための図である。
【符号の説明】
11 障害物位置計測装置
13 スキャニングレーザレーダ
15 距離・位置・大きさ計測部
17 追従判断部
19 動き計測部
21 物体位置関係判断部
23 CPU
25 作用装置
[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a distance measuring device that measures a distance to an object existing around a vehicle, and in particular, an obstacle position measuring method and an obstacle position capable of determining whether an object is hidden behind an object in front. It relates to a measuring device.
[0002]
[Prior art]
As a conventional obstacle position measuring method, for example, a method described in JP-A-11-316275 has been reported.
In this method, a scanning laser radar is mounted on the vehicle, the observation vector of the object being followed is obtained, the trajectories of multiple target objects are estimated, and the distance to the object is measured while following the object. To do.
[0003]
[Problems to be solved by the invention]
However, in such a method, although a plurality of objects are detected, a state in which the plurality of objects are hidden from each other is not considered. There was a problem that the size of the object could not be obtained.
In addition, since the size of the object to be measured changes when a part of the object is hidden behind another object, there is a problem in that it is wrong to follow the object. Furthermore, since the center position of the object changes when a part of the object is hidden, the locus vector of the object cannot be obtained correctly.
[0004]
The present invention has been made in view of the above, and an object thereof is to provide an obstacle position measuring method and an obstacle position measuring apparatus that can determine whether an object is hidden behind an object in front. There is.
[0005]
[Means for Solving the Problems]
  In order to solve the above-described problem, the invention according to claim 1 scans a transmission wave around the vehicle at a predetermined detection angle.Receiving the reflected wave of the transmitted waveIn the obstacle position measurement method that measures the distance and direction to the front object,ArticleA measurement procedure for measuring the distance and orientation to the body and the size of the object, a hiding judgment procedure for judging whether a part of the measured object is hidden behind the object in front,The same object determination procedure for determining whether or not the object being measured is the same as the object measured at the previous time, and a motion vector measurement procedure for measuring a motion vector representing a continuous motion of an object located at the same distance; When the object being measured moves laterally from the front, and another object is measured behind the object after moving, a flag indicating that a part of the object behind is hidden is displayed in the measurement result. After adding the flag addition procedure to the position where the object in front and the object in front do not hide the object behind, if the size of the object that has appeared is still hidden, there is a narrow object And a narrow object judging procedure for judging to do.
[0008]
  Claim2In order to solve the above-described problem, the described invention exists in a predetermined range around a vehicle, a transmission unit that transmits a transmission wave, a reception unit that receives a reflected wave of the transmission wave, and the predetermined range Measuring means for measuring the distance and direction to the object and the size of the object;Hidden determination means for determining whether a part of the measured object is hidden behind the object in front, and the same object determination means for determining whether the object being measured is the same object as the object measured at the previous time And a motion vector measuring means for measuring a motion vector representing a continuous motion of an object located at the same distance, and when the object being measured moves laterally from the front, another object is moved behind When an object is measured, it appears after flag addition means for adding a flag indicating that a part of the object behind is hidden to the measurement result and a position where the object in the front does not hide the object behind. The gist of the invention is that it has narrow object judging means for judging that a narrow object exists when the size of the object is hidden.
[0011]
【The invention's effect】
  According to the first aspect of the present invention, the distance to the object existing in the detection area, the direction and the size of the object are measured, and a part of the measured object is hidden behind the object in front. To determine whetherJudge whether the object being measured is the same as the object measured at the previous time, measure the motion vector representing the continuous movement of the object located at the same distance, and the object being measured is lateral from the front If another object is measured behind the object after moving the object, a flag indicating that a part of the object is hidden is added, and the object in the foreground moves to a position where the object behind it is not hidden. After that, if the size of the object that has appeared is still hidden, it is determined that there is a narrow object, and this object may prevent the vehicle from running. It can be determined that it is not a thing.
[0014]
  Claim2According to the described invention, the transmission wave is transmitted within a predetermined range around the vehicle, the reflected wave of the transmission wave is received, and then the distance and direction to the object existing within the predetermined range and the object Measure the size of the object, determine if part of the measured object is hidden behind the object in front,Judge whether the object being measured is the same as the object measured at the previous time, measure the motion vector representing the continuous movement of the object located at the same distance, and the object being measured is lateral from the front If another object is measured behind the object after moving the object, a flag indicating that a part of the object is hidden is added, and the object in the foreground moves to a position where the object behind it is not hidden. After that, if the size of the object that has appeared is still hidden, it is determined that there is a narrow object, and this object may prevent the vehicle from running. It can be determined that it is not a thing.
[0017]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 is a diagram showing a configuration of an obstacle position measuring apparatus 11 to which an obstacle position measuring method and an obstacle position measuring apparatus according to an embodiment of the present invention can be applied.
The scanning laser radar 13 emits a laser radar (transmitted wave) as a pulse signal while scanning a one-dimensional direction perpendicular to the traveling direction ahead of the vehicle and parallel to the road surface at a predetermined detection angle. A reflected wave reflected by an object existing in front of the vehicle is received and a received signal is output.
[0018]
The distance / position / size measuring unit 15 is based on the pulse signal emitted by the scanning laser radar 13 and the received signal, and the propagation delay time from the emission of the laser radar to the incidence of the reflected wave from the object existing in front of the vehicle Is detected, the distance to all objects existing within the detection angle is measured, and the direction is further measured. Furthermore, the angle of the host vehicle with respect to the preceding vehicle is calculated based on the measured distance and direction, and further, the distance to the preceding vehicle, the position, and the size of the object are calculated based on the angle. In addition, the distance / position / size measurement unit 15 performs a grouping process on portions that are determined to be the same object.
[0019]
The tracking determination unit 17 is a motion vector measured by the motion measurement unit 19 when the position of the grouping process executed by the distance / position / size measurement unit 15 moves only a small distance in time. Is determined to follow the object when the is continuous over time.
The motion measurement unit 19 obtains the coordinates of the left and right end points of the detected object, and obtains the trajectory of the object that is continuously measured in time by connecting the temporal motions of the left and right end points as motion vectors.
The object positional relationship determination unit 21 determines whether a part of another object is hidden behind the object based on the position of the scanning laser radar and the positional relationship between two other objects, and a part of the object is hidden. The hidden flag, the distance, position, size, and motion vector of the object are output as the measurement result of the object.
[0020]
Note that the above-described distance / position / size measuring unit 15, follow-up determining unit 17, motion measuring unit 19, and object position relationship determining unit 21 may be functional modules executed by a control program. Is executed in accordance with a control program stored in
The action device 25 is connected to a brake, a throttle valve, or the like provided in the vehicle based on the distance, position, size, motion vector, and hidden flag of the object output from the object position relationship determination unit 21. The vehicle is controlled by controlling the actuator.
[0021]
2A and 2B are views showing the position of the scanning laser radar 13 mounted on the vehicle and the respective reference coordinate systems.
As shown in FIGS. 2A and 2B, the scanning center axis (Z) of the scanning laser radar 13 mounted on the host vehicle 29 goes straight to the center position in the width direction (X) of the host vehicle 29, respectively. It is attached in a direction parallel to the direction (Z), and the origin of each reference coordinate system is attached to the road surface at the same position in the vertical direction (Y).
[0022]
The position of the detected object with respect to the host vehicle 29 is that the origin is the center point of the scanning laser radar 13, the Z axis (representing the distance to the object) is the central axis direction of the scanning laser radar 13, and the X axis (the lateral position of the object). ) Is a direction parallel to the scanning plane and the Y-axis is a direction perpendicular to the scanning plane.
Hereinafter, for the sake of explanation, description will be made using a reference coordinate system with the center of the exit surface of the scanning laser radar 13 as the origin. However, in the present invention, even when the central axis is not in the straight traveling direction or when the mounting position is deviated from the central axis of the host vehicle 29, the angle and the position are considered in the geometric calculation, and all are described below. It holds.
[0023]
Next, the basic operation of the obstacle position measuring device 11 will be described with reference to the situation in front of the host vehicle shown in FIG. FIG. 3 shows a situation in which the vehicle 31 is traveling in front of the host vehicle 29 and there is another vehicle 33 in front of the left side behind the vehicle. It is the figure which showed the mode of the measurement result in the radar.
The beam of the scanning laser radar 13 measures the distance to the reflection surface that is closest to the laser radar at each detection angle, and even if there is a reflection surface in front of it, the surface and the laser radar If there is an object that can prevent the beam from reaching, the distance to the reflecting surface cannot be measured.
[0024]
In the case of the situation shown in FIG. 3, the distance between the left and right reflecting surfaces present on the front vehicle 31 and the left reflecting surface of the vehicle 33 diagonally left front can be measured, but the right reflecting surface of the vehicle 33 is measured. Since it is in a position hidden behind the vehicle 31, the distance cannot be measured. As a result, the only part that can be measured only by the scanning laser radar 13 is the position indicated by a circle shown in FIG.
Therefore, when it is assumed that the vehicle 33 measured behind the vehicle 31 is a vehicle having a vehicle width A (m), it is determined whether or not a part of the vehicle 33 is in a position hidden by the vehicle 31 in front. Can be calculated geometrically by the object positional relationship determination unit 21 based on the position of the scanning laser radar 13 mounted on the host vehicle 29 and the positional relationship between the two vehicles 31 and 33. In particular, as shown in FIG. 3, when it is determined that a part of the object is hidden behind the vehicle 31, the object positional relationship determination unit 21 may hide a part of the object (vehicle 33). The hidden flag indicating the presence of the object and the distance, position, size, and motion vector of the object are used as the measurement result of the object.
[0025]
Therefore, based on the output result from the object positional relationship determination unit 21, it is possible to cause the action device 25 to perform vehicle control taking into account that the object behind the vehicle 31 (the vehicle 33) is a large obstacle. become able to. For example, in the judgment of the driver in normal driving, if the front obstacle is a small object, the vehicle travels only by a minute course change by the steering wheel operation without changing the speed, and there is a large obstacle such as a stopped vehicle ahead. In such a case, the operation device 25 performs vehicle control such as stopping. Also, if there is an obstacle ahead but you do not know what it is, you will often make preparations so that you can approach the object while slowing down until it gets closer to the object, and can handle sudden braking. Even in such a case, it can be given as a hidden flag that there is an object that can be an obstacle, although it does not know what it is, so that it can cope with braking until the type of object is known The action device 25 can perform vehicle control equivalent to vehicle operation by the driver, such as reducing the speed in advance.
[0026]
Next, the operation of the obstacle position measuring apparatus 11 will be described with reference to the flowchart shown in FIG.
First, in step S10, the scanning laser radar 13 performs distance measurement, and the distance / position / size measurement unit 15 performs grouping processing on a portion that is determined to be the same object, thereby existing ahead of the host vehicle 29. Find an object in the measurement area and determine the distance, position, and size to that object. As shown in FIGS. 5 and 6, this grouping process can be performed by determining that objects located at the same distance and moving in the same direction continuously in time are the same object.
[0027]
Here, the grouping process by the distance / position / size measuring unit 15 will be described with reference to the locus of the leaving vehicle shown in FIG. In FIG. 5A, there is a vehicle 43 that is stopped slightly to the left from the front ahead of the preceding vehicle (leaving vehicle 41), and there is a preceding vehicle (leaving vehicle 41) that is running in front of the host vehicle 29. The locus | trajectory of the result measured by the scanning laser radar 13 mounted in the own vehicle 29 in the case of leaving | separating is shown. Since the preceding vehicle leaves the right front and becomes the leaving vehicle 41, the trajectory is observed to gradually move diagonally forward to the right.
[0028]
Next, in step S20, when the result of the grouping process described above moves only a small distance in time, and when the motion vectors measured by the motion measuring unit 19 during the grouping process are continuous in time. The follow-up determination unit 17 determines to follow the object.
Next, in step S30, an object having a narrow width is selected from the detected objects, and it is determined whether or not the object may be partially hidden by an object in front of the object.
[0029]
For example, as shown in FIG. 7, this determination process is such that the distance to the object 51 near the host vehicle 29 is z1, the distance to the object 53 farther from the object 51 is z2, and the coordinates of the left and right ends of the object 51 are ( x11, z11) and (xr1, zr1). At this time, since the detection position of the object 53 is behind the object 51, it is determined that the detection point of the object 53 is the left end point of the object 53, and the coordinates thereof are (x12, z12).
[0030]
Further, as shown in FIG. 6, the portion that may be hidden is the right end point of the object 53. Therefore, the object width of the object 53 is assumed to be A, and the right end point of the object 53 is set to (x12 + A, z12). To do. However, these coordinates are all points on the reference coordinate system shown in FIG.
[0031]
Here, the hidden determination process is executed using the points thus obtained.
First, an equation of a straight line connecting the right end point (x12 + A, z12) of the hidden object 53 and the center point of the scanning laser radar 13 is obtained. Since the center point of the scanning laser radar 13 is the origin of the reference coordinate system, the equation of the straight line connecting the right end point of the object 53 and the center point of the laser radar is Equation (1).
[0032]
[Expression 1]
x = ((x12 + A) / z12 * z) * 2 (1)
In order to determine whether or not the right end point of the object 53 is in a position hidden by another object, it is only necessary to check that it exists between the objects detected in front of it. That is, in FIG. 6, this corresponds to checking that the line segment connecting the coordinates (x11, z11) and (xr1, zr1) of the left and right ends of the object 51 intersects with the equation (1).
[Expression 2]
x11 ≦ ((x12 + A) / z12) × z11
And
((X12 + A) / z12) × z11 ≦ xr1 (2)
If equation (2) holds, it can be determined that the right end of the object 53 is hidden by 51, and thus the process proceeds to step S40. On the other hand, if equation (2) does not hold, the process returns to step S10 and the above-described processing is repeated.
[0033]
In step S40, all the distances, positions, sizes, etc. of the detected objects are output as the final result output. When outputting this result, if it is determined by the above-mentioned determination that a part of the object may be hidden by the narrow object and the object in front, a part of the object may be hidden. A hidden flag indicating that is added.
[0034]
Furthermore, in step S50, the object position relationship determination unit 21 outputs the distance, lateral position, movement, size, and hidden flag of the detected object.
[0035]
Next, a description will be given of a process for determining the possibility of hiding an object ahead when a preceding vehicle in front is leaving.
The position of the front object can be detected by the grouping process described with reference to FIG. Further, as shown in FIG. 7, the trajectory of the object continuously measured in time is obtained by obtaining the coordinates of the left and right end points of the detected object, and the temporal movements of the left and right end points are shown in FIGS. It can obtain | require by connecting with a motion vector using the method as shown in these.
[0036]
In this way, when it is found that the preceding vehicle for which the trajectory has been obtained leaves, and there is an object ahead of the preceding vehicle, the object ahead is as shown in FIG. 5 (a). Only the edge of is observed, and as the preceding vehicle leaves, the entire object gradually becomes visible.
In other words, at the start of departure, a part of the detected object is hidden behind it, so that it is observed as a narrow object. For example, as shown in FIG. 5A, at the start of departure, a part of the object detected behind the departure vehicle is observed as a narrow object (vehicle).
[0037]
However, as shown in FIG. 5A, since a part of the vehicle is hidden behind the leaving vehicle 41, the actual size of the vehicle is not known at this time. For this reason, when an object (vehicle 43) is detected behind the leaving vehicle 41, at the start of detection of the object, first, the distance of the object that has left the hidden flag indicating that a part of the object is hidden. Append to position result and output. At this time, it can be determined by using the method shown in FIG. 6 described above that a part of the detected narrow object (vehicle) is hidden by the front object (leaving vehicle).
[0038]
Next, a case where a small object exists ahead after the preceding vehicle has left will be described.
[0039]
As described above, as shown in FIG. 5 (a), when the leaving vehicle 41 starts to leave, only a part of the object (vehicle 43) behind the leaving vehicle 41 can be detected. Is detected as a narrow object. However, after the leaving vehicle 41 leaves, the entire object behind (the vehicle 43) can be seen. For this reason, for example, as shown in FIG. 6B, even when the right end of the object behind the disengaged vehicle provided is visible, nothing is detected from the position where the right end is detected. It can be determined that the object behind the leaving vehicle is the thin object 47. This determination process can be determined from the positional relationship in which equation (2) is not satisfied.
[0040]
Next, an example in which the vehicle width is used as a reference value when determining a position hidden behind the preceding vehicle is described.
This can be done by setting the object width A (m) temporarily provided as described above to the normal average vehicle width. Also, depending on the road being traveled, for example, when traveling in a large-priority lane, the applied value may be made variable by taking the object width A (m) as the vehicle width of a large vehicle.
[0041]
If it is determined that a part of the object is hidden behind the leaving vehicle by the equations (1) and (2) before the preceding vehicle leaves, the provisioned object width is provided. For example, in the case shown in FIG. 7, the movement of the expected point (x12 + A, z12) may be the movement of the right end point of the object 53. In this way, while it is determined that the object 53 is hidden behind the object 51, the expected right end point (x12 + A, z12) of the object is obtained continuously in time.
[0042]
In this way, when the trajectory of the preceding vehicle is obtained, the preceding vehicle becomes a leaving vehicle in the middle of leaving, and if it is detected that there is an object behind the part of the leaving vehicle, The trajectory of the object detected in front of the leaving vehicle can be obtained by the same principle as the calculation of the trajectory of the following vehicle.
[0043]
Since this object is behind the leaving vehicle and part of it is in a hidden position, the trajectory cannot be obtained from the position of the left and right ends, but the movement can be obtained only by obtaining the locus of the detected part. I can.
For example, as shown in FIG. 5, when the vehicle diagonally left front is a stopped vehicle, a trajectory vector approaching with the same length as the speed vector of the host vehicle 29 is obtained from this left end portion continuously detected. Therefore, it can be determined that the vehicle is stopped. As a result, it is possible to detect in advance that there is a stop obstacle prior to the departure of the preceding vehicle, and in order to avoid a collision with the stop obstacle, it can also be used for vehicle control by the action device 25.
Furthermore, the present invention can be applied to a system that displays the detection information on a blind spot in front of the vehicle or a display for visual assistance for monitoring an external environment that is difficult to see from the driver's seat.
[0044]
Hereinafter, effects of the present embodiment will be described.
Measure the distance and direction to the object in the detection area, the size of the object, determine whether a part of the measured object is hidden behind the object in front, When it is determined that the part is hidden behind the object in front, a hidden flag indicating that a part of the object is hidden is added to the measurement result. It is possible to determine whether an object is hidden behind the object.
[0045]
In addition, it is determined whether the object being measured is the same object as the object measured at the previous time, and a motion vector representing the continuous movement of the object located at the same distance is measured. When moving in the horizontal direction, if another object is measured behind the object after moving, a hidden flag indicating that part of the object is hidden is added, and measurement is performed based on the presence or absence of this hidden flag. It is possible to determine whether or not a new object has appeared in the front even immediately after the object has moved laterally from the front.
[0046]
Furthermore, if the size of the object that has appeared is still hidden after the front object has moved to a position that does not hide the object behind it, it is determined that a narrow object exists. Thus, it can be determined that this object is not an obstacle that prevents the vehicle from traveling.
[0047]
Hereinafter, the effect in this Embodiment is demonstrated concretely.
As shown in FIG. 5A, the obstacle (vehicle 43) being measured located in the left front is observed as a narrow object when the preceding vehicle is located in front of the host vehicle 29. However, after the leaving vehicle 41 leaves, the entire vehicle 43 on the left front side is in a positional relationship where it can be seen from the host vehicle 29, so that the entire position of the vehicle 43 can be measured, and the vehicle 43 When the vehicle is stopped, the distance to the vehicle 43 is observed so as to approach gradually. The movement trajectory of the preceding vehicle (leaving vehicle 41) is a grouping process of points at the same position in the object whose distance is being measured, and as a result, an object that moves constantly in the same direction is measured. The direction of the vehicle (the arrow shown in FIG. 5) can be used to measure the movement of the preceding vehicle (leaving vehicle 41).
[0048]
If a narrow object is detected behind the vehicle to be separated by this method, the trajectory of the preceding vehicle is obtained, and as described above, there is a possibility that a part is hidden by the preceding vehicle to be separated. It is assumed that the hidden flag indicating that there is a measurement result is added to the position and distance of the object behind the preceding vehicle.
[0049]
Further, as shown in FIG. 5A, when the movement of the preceding vehicle detected in front of the host vehicle 29 is obtained and the preceding vehicle leaves the course of the host vehicle 29, FIG. As shown, when an object behind is detected in the process of leaving the preceding vehicle, a part of the obstacle is displayed to notify that there is an object that may be an obstacle in the traveling direction of the host vehicle 29. Since a hidden flag indicating that there is a possibility of being hidden by the leaving vehicle is added to the distance, position, size, etc., it is output so that the host vehicle responds to the inter-vehicle distance according to the change in the inter-vehicle distance from the preceding vehicle. Even when controlling the vehicle, avoiding dangerous speed control that increases the speed of the host vehicle even though there is an obstacle ahead of the host vehicle because the path ahead is free due to the departure of the preceding vehicle Will be able to.
[0050]
Furthermore, in the case of a driving operation based on the judgment of a normal driver, when the preceding vehicle being followed leaves, the speed is not increased immediately. First, there is an obstacle or a slow vehicle behind the leaving vehicle. When the existence is suspected and it is determined that there is nothing to prevent the vehicle from traveling, the speed is increased. On the other hand, if any obstacle is found, after determining what the obstacle is, an operation of requesting control of the host vehicle 29 is performed.
[0051]
According to the present embodiment, when the presence of an object is detected behind the leaving vehicle, first of all, since the part of the object is hidden by the leaving vehicle, the size and type of the object are not known. Since a hidden flag indicating that the vehicle is present is output, it becomes possible to perform driving control close to that of a normal driver.
[0052]
Further, by measuring the movement trajectory of the detected object behind the leaving vehicle, for example, if the object behind the leaving vehicle is a stop object, preparation for a brake operation can be performed. When the speed of the object is low, preparation for deceleration by a brake operation can be made. Furthermore, when the relative speed of the newly detected object with the host vehicle 29 is close to 0, it is possible to make a quick speed adjustment determination such as maintaining the speed of the host vehicle.
[0053]
In addition, as shown in FIG. 6B, when the detected object is detected as the narrow object 47 even after the preceding vehicle has left, the hidden flag added to the object is displayed. Since it has been removed, it is possible to instantly determine that the object behind the leaving vehicle is small and does not interfere with travel, and therefore smooth speed control is possible. For example, when it is determined that the object is a narrow stop object, the brake preparation is started. However, when it is determined that the stop object does not interfere with the traveling of the host vehicle 29 such as a sign, In the meantime, preparation for brake control can be stopped and normal driving can be resumed. In this way, the action device 25 performs smooth vehicle control that reduces unnecessary acceleration and deceleration while taking measures for safe driving.
[0054]
In addition, when determining that there is a possibility that the detected object is hidden behind other objects, the standard of this width is set to the normal vehicle width. Since it becomes possible to determine the most frequently used vehicle among them, the number of scenes that can be used increases. Further, depending on the travel lane, for example, in a large dedicated lane or a bus priority lane, the vehicle width of the large vehicle can be set to be suitable for practical use.
[Brief description of the drawings]
FIG. 1 is a diagram showing a configuration of an obstacle position measuring apparatus 11 to which an obstacle position measuring method and an obstacle position measuring apparatus according to an embodiment of the present invention can be applied.
FIG. 2 is a side perspective view (a) and a top perspective view (b) showing a position of a scanning laser radar 13 mounted on a vehicle and respective reference coordinate systems.
FIG. 3 is a diagram illustrating a scanning laser radar detection result when another object is present at a position where a front object and a part of the object are hidden.
FIG. 4 is a flowchart for explaining the operation of the obstacle position measuring apparatus 11;
FIG. 5A is a diagram showing a grouping process for a preceding vehicle at the start of departure, and FIG. 5B is a diagram showing a vehicle appearing after the preceding vehicle has left.
FIG. 6A is a diagram showing a grouping process for a preceding vehicle at the start of departure, and FIG. 6B is a diagram showing an object appearing after the preceding vehicle leaves.
FIG. 7 is a diagram for explaining a method for calculating an object position.
[Explanation of symbols]
11 Obstacle position measuring device
13 Scanning laser radar
15 Distance / position / size measurement unit
17 Tracking determination unit
19 Motion measurement unit
21 Object position relation determination unit
23 CPU
25 Action device

Claims (2)

車両の周囲に送信波を所定の検知角度で走査しながら前記送信波の反射波を受信して前方物体までの距離と方位を計測する障害物位置計測方法において、
前記物体までの距離と方位とその物体の大きさを計測する計測手順と、
計測した物体の一部が手前の物体の背後に隠れているかどうかを判断する隠れ判断手順と、
計測中の物体が前回の時点で計測した物体と同一物体であるかどうか判断する同一物体判断手順と、
同一距離に位置する物体の連続的な動きを表す動きベクトルを計測する動きベクトル計測手順と、
計測中の物体が正面から横方向に移動した場合に、その物体の移動後に背後に別の物体を計測したときには、背後の物体の一部が隠れていることを示すフラグを前記計測結果に付加するフラグ付加手順と、
手前の物体が背後の物体を隠さない位置まで移動した後も、現われてきた当該物体の大きさが隠れていた時点のままである場合は、幅の狭い物体が存在することと判断する狭物体判断手順と、
を有することを特徴とする障害物位置計測方法。
In the obstacle position measuring method of measuring the distance and direction to the front object by receiving the reflected wave of the transmission wave while scanning the transmission wave around the vehicle at a predetermined detection angle,
A measurement procedure for measuring the distance and direction to the object and the size of the object;
A hiding judgment procedure for judging whether a part of the measured object is hiding behind the object in front,
The same object determination procedure for determining whether or not the object being measured is the same as the object measured at the previous time;
A motion vector measurement procedure for measuring a motion vector representing a continuous motion of an object located at the same distance;
When the object being measured moves laterally from the front, if another object is measured behind the object after it is moved, a flag indicating that a part of the object behind is hidden is added to the measurement result. Flagging procedure to
After moving to a position where the near object does not hide the object behind, if the size of the object that has appeared remains at the time of hiding, it is determined that a narrow object exists. Judgment procedure,
An obstacle position measuring method characterized by comprising:
車両周囲の所定の範囲内に送信波を送信する送信手段と、Transmitting means for transmitting a transmission wave within a predetermined range around the vehicle;
前記送信波の反射波を受信する受信手段と、  Receiving means for receiving a reflected wave of the transmission wave;
前記所定の範囲内に存在する物体までの距離と方位とその物体の大きさを計測する計測手段と、  Measuring means for measuring the distance and direction to the object existing in the predetermined range and the size of the object;
計測した物体の一部が手前の物体の背後に隠れているかどうかを判断する隠れ判断手段と、  A hiding judgment means for judging whether a part of the measured object is hiding behind the front object,
計測中の物体が前回の時点で計測した物体と同一物体であるかどうか判断する同一物体判断手段と、  The same object judging means for judging whether or not the object being measured is the same as the object measured at the previous time;
同一距離に位置する物体の連続的な動きを表す動きベクトルを計測する動きベクトル計測手段と、  A motion vector measuring means for measuring a motion vector representing a continuous motion of an object located at the same distance;
計測中の物体が正面から横方向に移動した場合に、その物体の移動後に背後に別の物体を計測したときには、背後の物体の一部が隠れていることを示すフラグを前記計測結果に付加するフラグ付加手段と、  When the object being measured moves sideways from the front, if another object is measured behind the object after it is moved, a flag indicating that a part of the object behind is hidden is added to the measurement result. Flag adding means for
手前の物体が背後の物体を隠さない位置まで移動した後も、現われてきた当該物体の大きさが隠れていた時点のままである場合は、幅の狭い物体が存在することと判断する狭物体判断手段と、  After moving to a position where the near object does not hide the object behind, if the size of the object that has appeared remains at the time of hiding, it is determined that a narrow object exists. Judgment means,
を有することを特徴とする障害物位置計測装置。  An obstacle position measuring apparatus comprising:
JP2000375787A 2000-12-11 2000-12-11 Obstacle position measuring method and obstacle position measuring device Expired - Fee Related JP3744352B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2000375787A JP3744352B2 (en) 2000-12-11 2000-12-11 Obstacle position measuring method and obstacle position measuring device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2000375787A JP3744352B2 (en) 2000-12-11 2000-12-11 Obstacle position measuring method and obstacle position measuring device

Publications (2)

Publication Number Publication Date
JP2002181936A JP2002181936A (en) 2002-06-26
JP3744352B2 true JP3744352B2 (en) 2006-02-08

Family

ID=18844747

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2000375787A Expired - Fee Related JP3744352B2 (en) 2000-12-11 2000-12-11 Obstacle position measuring method and obstacle position measuring device

Country Status (1)

Country Link
JP (1) JP3744352B2 (en)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3664127B2 (en) * 2001-06-07 2005-06-22 日産自動車株式会社 Object detection device
JP2003151095A (en) * 2001-11-19 2003-05-23 Nissan Motor Co Ltd Device for recognizing obstruction for vehicle
JP2004069328A (en) * 2002-08-01 2004-03-04 Nissan Motor Co Ltd Forward environment recognizing device and forward environment recognizing method
JP4059033B2 (en) * 2002-08-12 2008-03-12 日産自動車株式会社 Travel route generator
JP4313712B2 (en) * 2004-03-30 2009-08-12 本田技研工業株式会社 Travel safety device
JP3941795B2 (en) * 2004-04-28 2007-07-04 株式会社デンソー Leading vehicle recognition device
JP4510554B2 (en) * 2004-08-31 2010-07-28 富士重工業株式会社 Three-dimensional object monitoring device
JP4793094B2 (en) * 2006-05-17 2011-10-12 株式会社デンソー Driving environment recognition device
JP4811614B2 (en) * 2008-10-01 2011-11-09 株式会社Ihi Obstacle detection method and apparatus
US8717225B2 (en) 2009-07-31 2014-05-06 Honda Motor Co., Ltd. Object detection device for vehicle and object detection method for vehicle
JP5698597B2 (en) * 2011-05-10 2015-04-08 本田技研工業株式会社 Vehicle object detection device
JP5605395B2 (en) * 2012-06-08 2014-10-15 株式会社デンソー Vehicle determination device and program
JP6064674B2 (en) * 2013-02-28 2017-01-25 株式会社デンソー Object recognition device
WO2016103464A1 (en) * 2014-12-26 2016-06-30 三菱電機株式会社 Obstacle detection device and obstacle detection method
JP6315070B1 (en) * 2016-11-24 2018-04-25 マツダ株式会社 Obstacle detection device for vehicles
JP7296261B2 (en) * 2019-06-21 2023-06-22 パナソニックホールディングス株式会社 Monitoring device and monitoring method

Also Published As

Publication number Publication date
JP2002181936A (en) 2002-06-26

Similar Documents

Publication Publication Date Title
JP3744352B2 (en) Obstacle position measuring method and obstacle position measuring device
US11768286B2 (en) Method of determining the yaw rate of a target vehicle
US11787401B2 (en) Collision avoidance support device
JP6237694B2 (en) Travel control device
WO2018074287A1 (en) Vehicle control device
US11938924B2 (en) Driving assistance control apparatus for vehicle, driving assistance control system for vehicle, and driving assistance control method for vehicle
JP2009059082A (en) Object detection device for vehicle
JP2017074823A (en) Lane change support apparatus
JP6504078B2 (en) Collision prediction device
JP7028982B2 (en) Radar processing device
JP2008195293A (en) Collision-predicting device
EP3453582B1 (en) Driving support apparatus
WO2012039012A1 (en) Object detector and object detecting program
JP6432538B2 (en) Collision prediction device
JP2008149860A (en) Travel control device
CN110024011A (en) Collision determination device and collision determination method
JP5055169B2 (en) Vehicle safety device
JPH1139598A (en) Collision preventing device for vehicle
JP5396142B2 (en) Vehicle travel safety device
US20230052064A1 (en) Vehicle and obstacle detection device
EP3413082B1 (en) A vehicle system for detection of oncoming vehicles
JP2023127686A (en) Drive support device
US10843692B2 (en) Vehicle control system
JP6906638B2 (en) Vehicle system for detecting oncoming vehicles
WO2023033077A1 (en) Vehicle radar device

Legal Events

Date Code Title Description
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20041001

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20041102

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20041228

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050607

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20050803

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20050823

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20050908

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: 20051101

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20051114

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees