JP3738719B2 - Obstacle map creation device for vehicles - Google Patents

Obstacle map creation device for vehicles Download PDF

Info

Publication number
JP3738719B2
JP3738719B2 JP2001293638A JP2001293638A JP3738719B2 JP 3738719 B2 JP3738719 B2 JP 3738719B2 JP 2001293638 A JP2001293638 A JP 2001293638A JP 2001293638 A JP2001293638 A JP 2001293638A JP 3738719 B2 JP3738719 B2 JP 3738719B2
Authority
JP
Japan
Prior art keywords
vehicle
obstacle
position information
information
obstacle map
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
JP2001293638A
Other languages
Japanese (ja)
Other versions
JP2003098256A (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 JP2001293638A priority Critical patent/JP3738719B2/en
Publication of JP2003098256A publication Critical patent/JP2003098256A/en
Application granted granted Critical
Publication of JP3738719B2 publication Critical patent/JP3738719B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Description

【0001】
【発明の属する技術分野】
本発明は、車両周囲に存在する障害物を検出して、障害物地図を作成する装置に関する。
【0002】
【従来の技術】
特開平10−112000号公報に記載の障害物認識装置では、距離測定センサによって測定された障害物までの距離情報に基づいて、距離測定センサの計測範囲の各地点が「障害物あり」、「障害物無し」、「不明」のいずれの領域であるかを判定する。この判定結果と実際の障害物の有無との関係を判定正答率として予め記憶しておき、判定正答率に基づいて「障害物あり」と「障害物無し」の判定結果の確からしさを算出して障害物の地図を作成している。
【0003】
【発明が解決しようとする課題】
しかしながら、上述した従来の障害物認識装置では、距離測定センサによる障害物の有無の判定正答率を予め算出しておく必要がある。また、この方法では、障害物認識装置を車両に搭載した場合に、車両の速度や方向の変化に対応して障害物を正確に認識することが難しいという問題があった。
【0004】
本発明の目的は、距離測定装置の特性や車両挙動に基づいて、正確に障害物の構造や配置を把握することができる車両用障害物地図作成装置を提供することにある。
【0005】
【課題を解決するための手段】
(1)請求項1の発明は、対象物までの距離を計測する距離計測装置と、車両挙動を検出する車両情報検出装置と、車両情報検出装置により検出した車両挙動に基づいて、距離計測装置により計測した対象物までの距離情報を対象物の位置情報に変換して記憶する位置情報変換記憶装置と、前記位置情報変換記憶装置に記憶された複数の前記対象物の位置情報を対象物ごとに分類する分類装置と前記分類装置によって分類された位置情報に基づいて、ノイズ情報を除去するノイズ除去装置と、前記ノイズ除去装置によってノイズ情報が除去された位置情報に基づいて障害物の地図を生成する障害物地図生成装置とを備えることにより、上記目的を達成する。
(2)請求項2の発明は、請求項1の車両用障害物地図作成装置において、距離計測装置の計測特性を記憶する距離計測特性記憶装置をさらに備え、ノイズ除去装置は、車両情報検出装置により検出した車両挙動と、距離計測特性記憶装置に記憶された計測特性とに基づいて、ノイズ情報を除去することを特徴とする。
(3)請求項3の発明は、請求項2の車両用障害物地図作成装置において、距離計測特性記憶装置が記憶する計測特性は、距離計測装置の最大検知距離、検知幅、検知角、距離分解能、計測周期のうちのいずれか、もしくはそれらの組み合わせであることを特徴とする。
(4)請求項4の発明は、請求項1〜3のいずれかの車両用障害物地図作成装置において、車両情報検出装置が検出する車両挙動は、車両の位置と向きと速度であることを特徴とする。
(5)請求項5の発明は、請求項1〜4のいずれかに記載の車両用障害物地図作成装置において、分類装置は、対象物の位置情報を対象物ごとに分類するために、距離計測装置の位置と最大検知距離の位置とに基づいて定められる探索領域に含まれる対象物の位置情報を検出することを特徴とする。
(6)請求項6の発明は、請求項5の車両用障害物地図作成装置において、位置情報の探索領域の車両進行方向の幅を、車両の速度と距離計測装置の計測周期とに基づいて変化させることを特徴とする。
(7)請求項7の発明は、請求項1〜6のいずれかの車両用障害物地図作成装置において、分類装置は、対象物ごとに分類した複数の対象物の位置情報の中から、直線構造を有する対象物の位置情報を検出することにより、さらに対象物の位置情報を分類することを特徴とする。
(8)請求項8の発明は、請求項1〜7のいずれかの車両用障害物地図作成装置において、障害物地図生成装置は、分類された位置情報に基づいて対象物の存在する可能性に応じた複数の領域を設定し、設定した領域ごとに制御・警報レベル情報を含んだ障害物地図を生成することを特徴とする。
【0006】
【発明の効果】
以上詳細に説明したように本発明によれば、次のような効果を奏する。
(1)請求項1〜7の発明によれば、対象物までの距離データを車両挙動に基づいて対象物の位置情報に変換した後に、対象物の位置情報を対象物ごとに分類し、分類した位置情報に基づいてノイズ情報を除去してから、障害物地図を作成するので、ノイズとなる距離データを排除することができ、障害物の構造や配置を正確に把握することができる。
(2)請求項2の発明によれば、距離計測装置の計測特性を記憶する距離計測特性記憶装置をさらに備え、分類装置は、車両情報検出装置により検出した車両挙動と、距離計測特性記憶装置に記憶された計測特性とに基づいて、ノイズ情報を除去するので、さらに正確に障害物の構造や配置を把握することができる。
(3)請求項3の発明によれば、計測特性は、距離計測装置の最大検知距離、検知幅、検知角、距離分解能、計測周期のうちのいずれか、もしくはそれらの組み合わせであるので、これらの計測特性に基づいて正確にノイズ情報を除去して対象物の位置情報を分類することができる。
(4)請求項4の発明によれば、車両挙動の情報は車両の位置、向き、速度であるので、正確に車両と対象物との位置関係を把握することができるとともに、正確に対象物の位置を分類することができる。
(5)請求項5の発明によれば、対象物の位置情報を分類するための領域を距離計測装置の位置と最大検知距離の位置とに基づいて定められる探索領域としているので、距離計測装置で検知不可能な領域に存在する情報を処理する必要が無く、処理時間を短縮することができる。
(6)請求項6の発明によれば、位置情報の探索領域の車両進行方向の幅を車両の速度と距離計測装置の計測周期とに基づいて変化させるので、位置情報を分類する際に車速や計測周期の変化の影響を受けることがない。
(7)請求項7の発明によれば、直線構造を有する対象物の位置情報を検出してさらに位置情報を分類することにより、さらに正確に障害物の位置・構造を把握することができる。
(8)請求項8の発明によれば、障害物地図には対象物の存在する可能性の領域に応じた制御・警報レベルが含まれているので、簡単かつ正確に車両と障害物との接触可能性を検出することができる。
【0007】
【発明の実施の形態】
図1は、本発明による車両用障害物地図作成装置の一実施の形態の構成を示す図である。車両用障害物地図作成装置は、距離計測装置101と、車両情報検出装置201と、位置情報変換記憶装置301と、距離計測特性記憶装置401と、ノイズ除去装置501と、障害物地図生成装置601とを備える。距離計測装置101は、車両周囲に存在する障害物(対象物)までの距離を測定する装置であり、超音波センサやマイクロ波レーダ、レーザレーダ等を用いることができる。距離計測装置101は、車両の進行方向に対して横向きに、左右対象な位置に1つずつ車載される。本実施の形態では、図2に示すように、車両1の後輪の後方部に外側を向いて左右に1つずつ搭載されている。距離計測装置101による計測可能範囲は、図2に示す楕円102の範囲内である。
【0008】
車両情報検出装置201は、図3に示すように、車速センサ201aと操舵角センサ201bとを有し、車両1の位置や方向、速度などの車両挙動に関する情報を検出する。検出した車両挙動情報は、位置情報変換記憶装置301に送られる。位置情報変換記憶装置301は、車両情報検出装置201から送られる車両挙動情報に基づいて、距離計測装置101によって計測された障害物までの距離データを障害物の位置情報に変換して記憶する。
【0009】
障害物の位置情報は、位置情報変換記憶装置301の記憶領域における座標上で表現される。図4(a)は、実空間の座標系における車両1と障害物206との位置関係を示す図であり、図4(b)は、位置情報変換記憶装置301の記憶領域における座標系にて、車両1に対する相対的な障害物206の位置を示す図である。実空間の座標系における障害物206の位置は、車両1との相対的な位置を示す位置情報変換記憶装置301の記憶領域における座標上の点311で示される。また、図4(a)で符号204で示される距離計測装置101の位置は点310で示される。
【0010】
実空間の座標系における障害物の位置を記憶領域の座標系での点に変換する方法について図4(a),(b)を用いて説明する。予め、実空間座標系に基準となるX軸、Y軸を定めておき、車両1の位置202と、X軸と車両の進行方向との成す角203とを検出する。車両の位置202と進行方向を示す角203は、車両情報検出装置301により検出する。具体的には、車両1の左右後輪を結ぶ軸とこの軸に直交して車両中心を通る軸を車両1の固定座標系と定め、ある時刻t0における車両1の固定座標系を実空間座標系XYに定める。時間変化Δtごとの車両1の位置202と進行方向を示す角203とを車速センサ201a、操舵角センサ201bを用いて検出する。検出した車両の位置202と進行方向を示す角203とに基づいて、距離計測装置101の位置204と、2つの距離計測装置101を結ぶ軸(以下、計測軸と呼ぶ)205の方向とを算出する。図4(b)に示す記憶領域の座標系では、算出した計測軸205上に、距離計測装置101により検出した距離データに相当する位置に、障害物206の位置情報である点311を定める。
【0011】
従って、障害物206が検出されるまでは、位置情報変換記憶装置301の記憶領域におけるデータは0であり、障害物206を検出すると記憶領域における座標上に対応するデータが追加される。以後、車両の移動に伴い検出される障害物206の相対的な位置が、記憶領域の座標上のデータとして追加されていく。図4(b)に示す記憶領域上の座標上の白丸312,313,314,315は311よりも以前に検出された障害物の位置を示すデータである。
【0012】
ノイズ除去装置501は、距離計測特性記憶装置401に記憶されている距離計測装置101の検知範囲特性と、車両情報検出装置201によって検出される車速などの車両情報とに基づいて、位置情報変換記憶装置301に記憶された障害物位置情報を分類して、第1の障害物地図を作成する。障害物位置情報の分類方法について、図5を用いて説明する。
【0013】
位置情報変換記憶装置301の記憶領域における座標系にて、障害物の位置情報を分類してノイズ情報を除去するための探索領域を定める。この探索領域は、距離計測装置101の位置310と計測軸上の最大検知距離位置316の2点を焦点とする楕円領域317とする。この探索領域317を距離計測特性と車速とに応じて変化させることにより、車速に依存することなく、障害物位置情報を分類することができる。
【0014】
車両1の進行方向をx軸に取り、探索領域317の楕円の焦点位置の座標XをそれぞれX0,X1、車速をVc、距離計測装置101の計測サンプリング周期をTsとすると、探索領域317内に含まれる点の座標Xは、次式(1)を満たさなければならない。
|X−X0|+|X−X1|<Vc・Ts+α …(1)
ただし、αは補正項であり、楕円焦点座標X0,X1はそれぞれ、距離計測装置101,計測軸上の最大検知距離位置207の座標Xに相当する。図6(a)は、車速Vcが小さい場合の探索領域317を示す図であり、図6(b)は、車速Vcが大きい場合の探索領域317を示す図である。図6(a)、(b)から分かるように、車速Vcが小さい時は探索領域のx軸方向の幅は小さくなり、車速が高いときは探索領域317のx軸方向の幅は大きくなる。
【0015】
ノイズ除去装置501は、図5を参照すると、探索領域317内に含まれる障害物位置311,312,313を検出し、検出した複数の障害物位置311,312,313により構成される直線318を、最小二乗法等を用いて算出する。式(1)で示すように、車速Vcとサンプリング周期Tsとに基づいて探索領域317の大きさを変えることにより、障害物の配置や構造を特定するために十分なサンプル数を確保することができる。これにより、近似直線318の精度を向上することができるので、後述する障害物位置情報を分類する精度を向上することができる。
【0016】
続いて、探索領域317内に含まれる各障害物位置情報311,312,313から直線318までの距離(偏差)ついての分散値を求める。分散値は、距離計測装置101の分解能等に依存する。従って、分散値のしきい値は、距離計測装置101の分解能、測定誤差及び位置情報変換記憶装置301の分解能により決定する。求めた分散値が所定値のしきい値以下であるときは、各障害物位置311,312,313は同一のクラスタ(グループ)に属すると判定する。一方、求めた分散値が所定のしきい値より大きいときは、同一クラスタの終点を検出したと判定する。すなわち、分散値が所定のしきい値以下の値を示す点は同一クラスタに属し、所定のしきい値を越えた点は、ノイズ情報であるか別のクラスタに属する位置情報であると判定する。
【0017】
また、探索領域317に包含される障害物位置情報の数が所定の数よりも少ないときも、クラスタの終点を検出したと判定する。このことを図7を用いて説明する。順次、クラスタの分類を行っていった場合に、探索領域317に包含される障害物位置情報の数が所定の数よりも少ない場合、図7に示すように、障害物位置情報330〜333は同一のクラスタに属する情報であるが、障害物位置情報334は他のクラスタに属するものである。すなわち、障害物位置情報330と障害物位置情報334との間に連続性が無いために、両者は別のクラスタに属するものと判定する。
【0018】
図8を用いて、障害物位置情報を分類した結果に基づいて、ノイズ情報を除去して第1の障害物地図を得る方法について説明する。車両周囲に存在する障害物には、例えば駐車場における駐車車両や柱、壁、ガードレール等がある。車両が移動しながら、駐車車両やガードレールなどの障害物を距離計測装置101を用いて検出し、記憶領域の座標上に障害物位置を記憶していくと、比較的直線性の良い点列を構成することが分かる。しかし、上述した障害物位置の分類結果には、障害物の位置情報のバラツキや、距離計測装置101自身による計測誤差なども含まれている。従って、直線構造を有する障害物を正確に検出するために、測定結果の直線性の精度を向上させるための処理を施す必要がある。
【0019】
上述した障害物位置情報を分類した各クラスタにおいて、直線構造を有する障害物を検出するための再探索領域320,321を定める。再探索領域320,321は、クラスタを構成する障害物位置情報を包含する最小の領域に基づいて規定する。再探索領域320,321を規定する際には、図8に示すy軸方向、すなわち計測軸方向の領域は、距離計測装置101の距離分解能、位置情報変換記憶装置301の記憶領域の距離分解能、障害物位置情報の測定結果のバラツキを考慮して拡大する。また、図8に示すx軸方向、すなわち車両1の進行方向の領域は、障害物位置情報の測定結果のバラツキ等を考慮したy軸方向の拡大分に加えて、車速Vcと距離計測装置101のサンプリング周期Tsとを考慮して拡大する。
【0020】
このように、再探索領域320,321を拡大することにより、障害物位置情報を記憶する際、すなわちアナログデータをデジタルデータに変換して記憶する際の量子化誤差の影響を低減することができる。また、ノイズ情報として分類することができなかった障害物位置情報を障害物構造を規定するために用いることができるので、障害物地図としての正確性が向上する。
【0021】
再探索領域320,321を定めると、再探索領域320,321に含まれる障害物位置情報の中から、後述する再探索条件を満たす障害物位置情報の点群を抽出する。すなわち、再探索領域320に含まれる障害物位置情報の任意の2点を焦点とする楕円領域内に含まれる障害物位置情報の点の数が最大となる楕円領域322を求め(図8参照)、この楕円領域内に含まれる障害物位置情報を抽出する。
【0022】
具体的には、障害物位置情報の点の数が最大となる楕円領域322内に含まれる点の座標Yは、次式(2)を満たす必要がある。
|Y−Y0|+|Y−Y1|<β …(2)
ただし、Y0,Y1は、再探索領域320に含まれる障害物位置情報の任意の2点の座標Yであり、楕円の焦点座標に相当する。βは所定の定数である。βが大きくなると、楕円322のy軸方向の領域が大きくなるので、楕円322内の点群の直線性は低くなる。逆にβが小さいと、楕円322のy軸方向の領域が小さくなるので、楕円322内の点群のx軸方向の直線性は高くなる。すなわち、楕円322内に含まれる点群により構成される直線と各障害物位置情報を示す点との偏差は小さくなる。
【0023】
図8に示す再探索領域320では、障害物位置情報323は楕円322内に含まれない。従って、障害物位置情報323は、駐車車両の側面などの直線構造を有する障害物とは別の障害物情報であると判定される。上記式(2)の条件を満たす障害物位置情報を、第1の障害物地図として用いる。
【0024】
障害物地図生成装置601は、第1の障害物地図に基づいて連続的な障害物地図を生成する。駐車支援のための車両制御システムや警報システムには、自車両の位置や予測軌道と障害物位置との情報に基づいてブレーキやハンドルを制御したり、障害物との接触可能性を判断して警報を発するものがある。車両と障害物との接触可能性を判断するためには、車両周囲に存在する障害物の地図を用いることができるが、障害物との接触可能性を随時計算するためには、多大なデータを扱うことができる高速演算処理装置を用いなければならない。このため、本実施の形態の車両用障害物地図作成装置では、障害物の地図自体に、制御目標値または警報レベルに相当するデータを含める。
【0025】
図9は、図8に示す第1の障害物地図の各クラスタを構成する点群に基づいて、3段階の制御・警報レベルを割り当てた障害物地図である。すなわち、障害物位置情報に基づいて、信頼係数が95%、90%、85%等の信頼区間を定めることにより、制御・警報レベルを割り当てる。信頼係数とは、その区間に障害物位置情報を示す点が含まれている確率であり、楕円322内に含まれる点群を含む中心領域の信頼係数が最も低く、中心領域から外側の領域になるほど信頼係数は大きくなる。
【0026】
図9では、点群を含む中心の領域が制御・警報レベル3であり、制御・警報レベル3を取り囲む真ん中の領域の制御・警報レベルを2、最も外側の領域の制御・警報レベルを1としている。この場合、制御・警報レベルが3の領域は、障害物が存在する可能性が最も高いため、車両がこの領域に進入したときの車両と障害物との接触可能性は最も高い。レベル3に比べてレベル2,レベル2に比べてレベル1の領域については、車両と障害物との接触可能性は低くなる。障害物地図に障害物の位置情報とともに制御・警報レベルを含めることにより、車両と障害物との接触可能性を簡単に調べることができる。すなわち、障害物が存在する領域に車両が進入した時に、車両が進入した領域の制御・警報レベルを調べることにより、現在の車両の制御レベルまたは警報レベルを把握することができる。これにより、車両が進入した領域の制御・警報レベルに応じて、不図示のスピーカを用いて警報を発したり、ブレーキ(不図示)を用いて車両制御を行うことができる。
【0027】
上述した障害物地図の作成手順について、図10のフローチャートを用いて簡単に説明しておく。なお、各ステップの処理内容において、上述した説明の中で詳しく述べた部分については、その説明を省略する。ステップS1では、距離計測装置101により障害物206までの距離を計測する。距離を計測するとステップS2に進む。ステップS2では、車両情報検出装置201により車両の挙動を検出する。車両の挙動には、上述したように、車両の位置、進行方向、速度などが含まれる。車両の挙動を検出するとステップS3に進む。ステップS3では、ステップS1で検出した障害物までの距離情報を、ステップS2で検出した車両の挙動に基づいて障害物の位置情報に変換する。位置情報への変換は、位置情報変換記憶装置301により行われるが、変換方法は上述したのでここではその説明を省略する。ステップS4では、ステップS3で変換した位置情報を位置情報変換記憶装置301に記憶する。
【0028】
以下、ステップS5〜S8で行われる処理は、ノイズ除去装置501により行われる。ステップS5では、ステップS4で記憶した障害物の位置情報をクラスタごとに分類するための探索領域を設定する。探索領域の設定方法も上述したので説明を省略する。次のステップS6では、ステップS5で設定した探索領域内に含まれる障害物の位置情報をクラスタごとに分類する。すなわち、上述したように、探索領域内に含まれる複数の障害物の位置情報が構成する直線を算出し、算出した直線と各障害物位置情報との距離についての分散値を求める。分散値が所定のしきい値以下であるときは同一のクラスタに属すると判定する。分散値がしきい値より大きいときはクラスタの終点を検出したと判定して、しきい値より大きい分散値の障害物位置情報は別のクラスタに属するかノイズ情報であると判定する。
【0029】
ステップS7では、ステップS6で分類したクラスタ内に含まれる複数の障害物の位置情報の中から、直線構造を有する障害物を検出するための再探索領域を設定する。再探索領域の設定方法についても詳しい説明は省略する。ステップS8では、ステップS7で設定した再探索領域内の障害物の位置情報のうち、再探索条件を満たす点群を検出する。再探索条件を満たす点群とは、上述したように式(2)の条件を満たす障害物位置情報の集合であり、直線構造を有する障害物を示す。再探索条件を満たす点群を検出すると、ステップS9に進む。ステップS9では、ステップS8で検出した点群、すなわち障害物位置情報に基づいて、障害物地図生成装置により障害物地図を生成する。障害物地図は、上述したように障害物の配置や構造とともに、制御・警報レベルを含んだものである。障害物地図の作成方法も上述したので説明を省略する。
【0030】
以上、本発明による車両用障害物地図作成装置によれば、障害物までの距離データを車両挙動に基づいて障害物の位置情報に変換するので、正確に車両と障害物との位置関係を把握することができる。また、障害物の位置情報を車両挙動と距離計測装置の計測特性とに基づいて分類し、さらに直線構造を有する障害物を検出して障害物地図を作成することにより、ノイズとなる距離データを排除することができ、障害物の構造や配置を正確に把握することができる。また、障害物地図に制御・警報レベルの情報を含めることにより、障害物が存在する領域に車両が進入した時に、車両が進入した領域の制御・警報レベルを調べることにより、現在の車両の制御レベルまたは警報レベルを把握することができる。
【0031】
本発明は上述した実施の形態に限定されることはない。例えば、車両情報検出装置201は、車速センサ201aと操舵角センサ201bとに基づいて、車両の位置と方向を検出したが、ジャイロ等を用いて検出してもよい。また、制御・警報レベルは3段階に限られず、好みの段階に分けることができる。上述した一実施の形態の説明では、制御・警報レベルの領域を信頼係数が95%、90%、85%の信頼区間としたが、信頼係数もこれらの値に限定されることはない。
【図面の簡単な説明】
【図1】本発明による車両用障害物地図作成装置の一実施の形態の構成を示す図
【図2】距離計測装置の車載位置と計測範囲を示す図
【図3】車両情報検出装置の構成を示す図
【図4】(a)は、実空間座標系において車両と障害物との位置関係を示す図、(b)は、記憶領域の座標系において車両と障害物との位置関係を示す図
【図5】障害物位置情報を分類するための探索領域を示す図
【図6】(a)は、車両が低速で走行しているときの探索領域を示す図、(b)は、車両が高速で走行しているときの探索領域を示す図
【図7】障害物位置情報の分類方法について説明するための図
【図8】再探索領域と再探索条件を満たす障害物位置情報群を示す図
【図9】制御・警報レベル情報を含む障害物地図を示す図
【図10】障害物地図の一実施の形態の作成手順を示すフローチャート
【符号の説明】
1…車両、101…距離計測装置、102…計測範囲、201…車両情報検出装置、201a…車速センサ、201b…操舵角センサ、202…車両の位置、203…Y軸と車両の進行方向との成す角、204…距離計測装置の位置、205…計測軸、206…障害物、301…位置情報変換記憶装置、310…距離計測装置の位置、311,312,313,314,315,323,330,331,332,333,334…障害物の位置情報、316…最大検知距離の位置、317…探索領域、318…近似直線、320,321…再探索領域、322…再探索条件を満たす領域、401…距離計測特性記憶装置、501…ノイズ除去装置、601…障害物地図生成装置
[0001]
BACKGROUND OF THE INVENTION
The present invention relates to an apparatus for detecting an obstacle existing around a vehicle and creating an obstacle map.
[0002]
[Prior art]
In the obstacle recognition apparatus described in Japanese Patent Laid-Open No. 10-112000, each point in the measurement range of the distance measurement sensor is “obstacle”, based on the distance information to the obstacle measured by the distance measurement sensor. It is determined whether the area is “no obstacle” or “unknown”. The relationship between this determination result and the presence or absence of an actual obstacle is stored in advance as a determination correct answer rate, and the probability of the determination result of “with obstacle” and “without obstacle” is calculated based on the determination correct answer rate. To create a map of obstacles.
[0003]
[Problems to be solved by the invention]
However, in the above-described conventional obstacle recognition apparatus, it is necessary to calculate in advance the correct answer rate for the presence or absence of an obstacle by the distance measurement sensor. Further, in this method, when the obstacle recognition device is mounted on the vehicle, there is a problem that it is difficult to accurately recognize the obstacle corresponding to changes in the speed and direction of the vehicle.
[0004]
An object of the present invention is to provide a vehicle obstacle map creation device that can accurately grasp the structure and arrangement of an obstacle based on the characteristics of a distance measuring device and vehicle behavior.
[0005]
[Means for Solving the Problems]
(1) The invention according to claim 1 is based on a distance measuring device that measures a distance to an object, a vehicle information detecting device that detects a vehicle behavior, and a vehicle behavior detected by the vehicle information detecting device. A position information conversion storage device for converting the distance information to the object measured by the method into the position information of the object and storing it; A classification device for classifying the position information of the plurality of objects stored in the position information conversion storage device for each object; , A noise removing device for removing noise information based on the position information classified by the classification device; Said Noise information has been removed by the noise removal device The object is achieved by including an obstacle map generation device that generates an obstacle map based on the position information.
(2) The invention according to claim 2 is the vehicle obstacle map creation device according to claim 1, further comprising a distance measurement characteristic storage device for storing the measurement characteristic of the distance measurement device, wherein the noise removal device is a vehicle information detection device. The noise information is removed based on the vehicle behavior detected by the above and the measurement characteristics stored in the distance measurement characteristic storage device.
(3) The invention according to claim 3 is the obstacle map creation device for vehicle according to claim 2, wherein the measurement characteristics stored in the distance measurement characteristic storage device are the maximum detection distance, detection width, detection angle, and distance of the distance measurement device. It is one of resolution, measurement cycle, or a combination thereof.
(4) According to a fourth aspect of the present invention, in the vehicle obstacle map creating device according to any one of the first to third aspects, the vehicle behavior detected by the vehicle information detecting device is a position, a direction, and a speed of the vehicle. Features.
(5) The invention of claim 5 is the vehicle obstacle map creation device according to any one of claims 1 to 4, Classification The device In order to classify the position information of the objects by object, The position information of the object included in the search area determined based on the position of the distance measuring device and the position of the maximum detection distance is detected. put out It is characterized by that.
(6) The invention according to claim 6 is the obstacle map creation device for vehicle according to claim 5, wherein the width of the position information search region in the vehicle traveling direction is determined based on the vehicle speed and the measurement period of the distance measuring device. It is characterized by changing.
(7) The invention of claim 7 is claimed Any one of 1-6 In the vehicle obstacle mapping system of Classification device Is Classified by object The position information of the object is further classified by detecting the position information of the object having a linear structure from the position information of the plurality of objects.
(8) The invention according to claim 8 is the obstacle map creation device for a vehicle according to any one of claims 1 to 7, wherein the obstacle map generation device may have an object based on the classified location information. A plurality of areas are set according to, and an obstacle map including control / alarm level information is generated for each set area.
[0006]
【The invention's effect】
As described above in detail, the present invention has the following effects.
(1) According to the inventions of claims 1 to 7, after the distance data to the object is converted into the position information of the object based on the vehicle behavior, the position information of the object Categorized by object, remove noise information based on the classified location information, Since the obstacle map is created, the distance data that becomes noise can be eliminated, and the structure and arrangement of the obstacle can be accurately grasped.
(2) According to the invention of claim 2, further comprising a distance measurement characteristic storage device for storing the measurement characteristic of the distance measurement device, Classification The device removes noise information based on the vehicle behavior detected by the vehicle information detection device and the measurement characteristics stored in the distance measurement characteristic storage device, so that the structure and arrangement of obstacles can be grasped more accurately. Can do.
(3) According to the invention of claim 3, the measurement characteristic is any one of the maximum detection distance, detection width, detection angle, distance resolution, measurement cycle of the distance measurement device, or a combination thereof. It is possible to classify the position information of the object by accurately removing noise information based on the measurement characteristics.
(4) According to the invention of claim 4, since the vehicle behavior information is the position, orientation, and speed of the vehicle, it is possible to accurately grasp the positional relationship between the vehicle and the object, and to accurately identify the object. Can be classified.
(5) According to the invention of claim 5, since the area for classifying the position information of the object is a search area determined based on the position of the distance measuring device and the position of the maximum detection distance, the distance measuring device Thus, it is not necessary to process information existing in an undetectable area, and the processing time can be shortened.
(6) According to the invention of claim 6, the width of the position information search region in the vehicle traveling direction is changed based on the speed of the vehicle and the measurement period of the distance measuring device. And is not affected by changes in the measurement cycle.
(7) According to the invention of claim 7, the position / structure of the obstacle can be grasped more accurately by detecting the position information of the object having the linear structure and further classifying the position information.
(8) According to the invention of claim 8, since the obstacle map includes the control / alarm level corresponding to the area where the object may exist, the vehicle and the obstacle can be easily and accurately identified. The possibility of contact can be detected.
[0007]
DETAILED DESCRIPTION OF THE INVENTION
FIG. 1 is a diagram showing a configuration of an embodiment of a vehicle obstacle map creating apparatus according to the present invention. The obstacle map creation device for a vehicle includes a distance measurement device 101, a vehicle information detection device 201, a position information conversion storage device 301, a distance measurement characteristic storage device 401, a noise removal device 501, and an obstacle map generation device 601. With. The distance measuring device 101 is a device that measures the distance to an obstacle (object) existing around the vehicle, and an ultrasonic sensor, a microwave radar, a laser radar, or the like can be used. The distance measuring devices 101 are mounted on the left and right positions one by one in a direction transverse to the traveling direction of the vehicle. In the present embodiment, as shown in FIG. 2, the vehicle 1 is mounted on the right and left sides of the rear wheel of the vehicle 1 facing outward. The measurable range by the distance measuring apparatus 101 is within the range of the ellipse 102 shown in FIG.
[0008]
As shown in FIG. 3, the vehicle information detection device 201 includes a vehicle speed sensor 201a and a steering angle sensor 201b, and detects information related to vehicle behavior such as the position, direction, and speed of the vehicle 1. The detected vehicle behavior information is sent to the position information conversion storage device 301. The position information conversion storage device 301 converts the distance data to the obstacle measured by the distance measurement device 101 based on the vehicle behavior information sent from the vehicle information detection device 201 into the position information of the obstacle and stores it.
[0009]
The position information of the obstacle is expressed on coordinates in the storage area of the position information conversion storage device 301. 4A is a diagram showing a positional relationship between the vehicle 1 and the obstacle 206 in the coordinate system of the real space, and FIG. 4B is a coordinate system in the storage area of the position information conversion storage device 301. FIG. 4 is a diagram showing the position of an obstacle 206 relative to the vehicle 1. The position of the obstacle 206 in the coordinate system of the real space is indicated by a point 311 on the coordinates in the storage area of the position information conversion storage device 301 that indicates the position relative to the vehicle 1. Further, the position of the distance measuring device 101 indicated by reference numeral 204 in FIG.
[0010]
A method for converting the position of the obstacle in the coordinate system of the real space into a point in the coordinate system of the storage area will be described with reference to FIGS. A reference X axis and Y axis are defined in advance in the real space coordinate system, and a position 202 of the vehicle 1 and an angle 203 formed by the X axis and the traveling direction of the vehicle are detected. The vehicle information 202 is detected by the vehicle information detection device 301. Specifically, an axis connecting the left and right rear wheels of the vehicle 1 and an axis passing through the center of the vehicle orthogonal to this axis are defined as the fixed coordinate system of the vehicle 1, and the fixed coordinate system of the vehicle 1 at a certain time t0 is defined as real space coordinates. Set to system XY. The position 202 of the vehicle 1 and the angle 203 indicating the traveling direction for each time change Δt are detected using the vehicle speed sensor 201a and the steering angle sensor 201b. Based on the detected position 202 of the vehicle and the angle 203 indicating the traveling direction, a position 204 of the distance measuring device 101 and a direction of an axis 205 (hereinafter referred to as a measuring axis) 205 connecting the two distance measuring devices 101 are calculated. To do. In the coordinate system of the storage area shown in FIG. 4B, a point 311 that is position information of the obstacle 206 is determined on the calculated measurement axis 205 at a position corresponding to the distance data detected by the distance measuring device 101.
[0011]
Therefore, until the obstacle 206 is detected, the data in the storage area of the position information conversion storage device 301 is 0. When the obstacle 206 is detected, corresponding data is added on the coordinates in the storage area. Thereafter, the relative position of the obstacle 206 detected as the vehicle moves is added as data on the coordinates of the storage area. White circles 312, 313, 314, and 315 on the coordinates in the storage area shown in FIG. 4B are data indicating the positions of obstacles detected before 311.
[0012]
The noise removing device 501 stores the position information conversion memory based on the detection range characteristics of the distance measuring device 101 stored in the distance measuring property storage device 401 and the vehicle information such as the vehicle speed detected by the vehicle information detecting device 201. The obstacle position information stored in the device 301 is classified to create a first obstacle map. The obstacle location information classification method will be described with reference to FIG.
[0013]
In the coordinate system in the storage area of the position information conversion storage device 301, a search area for classifying obstacle position information and removing noise information is determined. This search area is an ellipse area 317 that has two points of focus, the position 310 of the distance measuring device 101 and the maximum detection distance position 316 on the measurement axis. By changing the search area 317 according to the distance measurement characteristic and the vehicle speed, the obstacle position information can be classified without depending on the vehicle speed.
[0014]
If the traveling direction of the vehicle 1 is taken on the x axis, the coordinates X of the ellipse focus position in the search area 317 are X0 and X1, the vehicle speed is Vc, and the measurement sampling period of the distance measuring device 101 is Ts, the search area 317 The coordinates X of the included points must satisfy the following formula (1).
| X−X0 | + | X−X1 | <Vc · Ts + α (1)
However, α is a correction term, and the elliptical focal point coordinates X 0 and X 1 correspond to the coordinate X of the maximum detection distance position 207 on the distance measuring device 101 and the measurement axis, respectively. FIG. 6A is a diagram showing the search region 317 when the vehicle speed Vc is low, and FIG. 6B is a diagram showing the search region 317 when the vehicle speed Vc is high. As can be seen from FIGS. 6A and 6B, the width of the search region in the x-axis direction is small when the vehicle speed Vc is low, and the width of the search region 317 in the x-axis direction is large when the vehicle speed is high.
[0015]
Referring to FIG. 5, the noise removing device 501 detects obstacle positions 311, 312, 313 included in the search region 317, and draws a straight line 318 constituted by the detected plurality of obstacle positions 311, 312, 313. , Using the least square method or the like. As shown in Expression (1), by changing the size of the search area 317 based on the vehicle speed Vc and the sampling period Ts, it is possible to secure a sufficient number of samples to specify the arrangement and structure of the obstacle. it can. Thereby, since the precision of the approximate straight line 318 can be improved, the precision which classifies the obstacle position information mentioned later can be improved.
[0016]
Subsequently, a variance value for the distance (deviation) from each obstacle position information 311, 312, 313 included in the search area 317 to the straight line 318 is obtained. The variance value depends on the resolution of the distance measuring device 101 and the like. Accordingly, the threshold value of the dispersion value is determined by the resolution of the distance measuring device 101, the measurement error, and the resolution of the position information conversion storage device 301. When the obtained variance value is less than or equal to a predetermined threshold value, it is determined that the obstacle positions 311, 312, and 313 belong to the same cluster (group). On the other hand, when the obtained variance value is larger than the predetermined threshold value, it is determined that the end point of the same cluster has been detected. That is, it is determined that a point whose variance value is equal to or smaller than a predetermined threshold belongs to the same cluster, and a point exceeding the predetermined threshold is noise information or position information belonging to another cluster. .
[0017]
Also, when the number of pieces of obstacle position information included in the search area 317 is smaller than a predetermined number, it is determined that the end point of the cluster has been detected. This will be described with reference to FIG. If the number of obstacle position information included in the search area 317 is smaller than a predetermined number when the clusters are sequentially classified, the obstacle position information 330 to 333 is as shown in FIG. Although the information belongs to the same cluster, the obstacle position information 334 belongs to another cluster. That is, since there is no continuity between the obstacle position information 330 and the obstacle position information 334, it is determined that both belong to different clusters.
[0018]
A method of obtaining the first obstacle map by removing noise information based on the result of classifying the obstacle position information will be described with reference to FIG. Examples of obstacles existing around the vehicle include a parked vehicle, a pillar, a wall, and a guardrail in a parking lot. When the vehicle moves, obstacles such as parked vehicles and guardrails are detected using the distance measuring device 101, and the obstacle position is stored on the coordinates of the storage area. You can see that it is composed. However, the obstacle position classification results described above include variations in the position information of the obstacles and measurement errors caused by the distance measuring device 101 itself. Therefore, in order to accurately detect an obstacle having a linear structure, it is necessary to perform a process for improving the linearity accuracy of the measurement result.
[0019]
In each cluster into which the obstacle position information described above is classified, re-search areas 320 and 321 for detecting obstacles having a linear structure are determined. The re-search areas 320 and 321 are defined based on the minimum area including the obstacle position information constituting the cluster. When the re-search areas 320 and 321 are defined, the y-axis direction shown in FIG. 8, that is, the area in the measurement axis direction, is the distance resolution of the distance measurement device 101, the distance resolution of the storage region of the position information conversion storage device 301, Expand in consideration of variations in measurement results of obstacle location information. Further, in the x-axis direction shown in FIG. 8, that is, the region in the traveling direction of the vehicle 1, in addition to the enlargement in the y-axis direction in consideration of variations in the measurement result of the obstacle position information, the vehicle speed Vc and the distance measuring device 101 Is increased in consideration of the sampling period Ts.
[0020]
As described above, by expanding the re-search areas 320 and 321, it is possible to reduce the influence of the quantization error when the obstacle position information is stored, that is, when analog data is converted into digital data and stored. . Also, since the obstacle position information that could not be classified as noise information can be used to define the obstacle structure, the accuracy of the obstacle map is improved.
[0021]
When the re-search areas 320 and 321 are determined, a point cloud of obstacle position information that satisfies a re-search condition described later is extracted from the obstacle position information included in the re-search areas 320 and 321. That is, the ellipse area 322 in which the number of points of the obstacle position information included in the ellipse area focusing on two arbitrary points of the obstacle position information included in the re-search area 320 is obtained (see FIG. 8). The obstacle position information included in this elliptical area is extracted.
[0022]
Specifically, the coordinates Y of the points included in the ellipse area 322 where the number of points of the obstacle position information is maximum must satisfy the following formula (2).
| Y−Y0 | + | Y−Y1 | <β (2)
However, Y0 and Y1 are two arbitrary coordinates Y of the obstacle position information included in the re-search area 320, and correspond to the focal coordinates of the ellipse. β is a predetermined constant. As β increases, the area of the ellipse 322 in the y-axis direction increases, and the linearity of the point group in the ellipse 322 decreases. Conversely, when β is small, the area of the ellipse 322 in the y-axis direction is small, and the linearity of the point group in the ellipse 322 in the x-axis direction is high. That is, the deviation between the straight line constituted by the point group included in the ellipse 322 and the point indicating each obstacle position information becomes small.
[0023]
In the re-search area 320 illustrated in FIG. 8, the obstacle position information 323 is not included in the ellipse 322. Therefore, the obstacle position information 323 is determined to be obstacle information different from the obstacle having a linear structure such as a side surface of the parked vehicle. Obstacle position information that satisfies the above condition (2) is used as the first obstacle map.
[0024]
The obstacle map generation device 601 generates a continuous obstacle map based on the first obstacle map. Vehicle control systems and warning systems for parking assistance control the brakes and steering wheel based on the information on the position of the vehicle and the predicted trajectory and the position of the obstacle, and determine the possibility of contact with the obstacle. Some alarms. In order to determine the possibility of contact between a vehicle and an obstacle, a map of obstacles around the vehicle can be used, but in order to calculate the possibility of contact with an obstacle as needed, a large amount of data Must use a high-speed processing device capable of handling For this reason, in the obstacle map creation device for a vehicle according to the present embodiment, the obstacle map itself includes data corresponding to the control target value or the alarm level.
[0025]
FIG. 9 is an obstacle map to which three levels of control / alarm levels are assigned based on the point cloud constituting each cluster of the first obstacle map shown in FIG. That is, a control / alarm level is assigned by defining a confidence interval with a confidence coefficient of 95%, 90%, 85%, etc. based on the obstacle position information. The reliability coefficient is a probability that a point indicating obstacle position information is included in the section, and the reliability coefficient of the central region including the point group included in the ellipse 322 is the lowest, and the region from the central region to the outer region The reliability coefficient increases.
[0026]
In FIG. 9, the central area including the point cloud is the control / alarm level 3, the control / alarm level in the middle area surrounding the control / alarm level 3 is 2, and the control / alarm level in the outermost area is 1. Yes. In this case, since the region where the control / warning level is 3 is most likely to have an obstacle, the possibility of contact between the vehicle and the obstacle when the vehicle enters this region is the highest. In the region of level 2 compared to level 3 and level 1 compared to level 2, the possibility of contact between the vehicle and the obstacle is low. By including the control / warning level together with the position information of the obstacle in the obstacle map, the possibility of contact between the vehicle and the obstacle can be easily checked. That is, when a vehicle enters an area where an obstacle exists, the current control level or alarm level of the vehicle can be grasped by examining the control / alarm level of the area where the vehicle has entered. Thereby, according to the control / alarm level of the area where the vehicle has entered, it is possible to issue an alarm using a speaker (not shown) or perform vehicle control using a brake (not shown).
[0027]
The obstacle map creation procedure described above will be briefly described with reference to the flowchart of FIG. In addition, in the processing content of each step, the description is abbreviate | omitted about the part detailed in the description mentioned above. In step S1, the distance measuring device 101 measures the distance to the obstacle 206. When the distance is measured, the process proceeds to step S2. In step S <b> 2, the vehicle information detection apparatus 201 detects the behavior of the vehicle. As described above, the behavior of the vehicle includes the position, traveling direction, speed, and the like of the vehicle. When the behavior of the vehicle is detected, the process proceeds to step S3. In step S3, the distance information to the obstacle detected in step S1 is converted into obstacle position information based on the behavior of the vehicle detected in step S2. The conversion to the position information is performed by the position information conversion storage device 301. Since the conversion method has been described above, the description thereof is omitted here. In step S4, the position information converted in step S3 is stored in the position information conversion storage device 301.
[0028]
Hereinafter, the processing performed in steps S5 to S8 is performed by the noise removing device 501. In step S5, a search area for classifying the position information of the obstacle stored in step S4 for each cluster is set. Since the search area setting method has also been described above, a description thereof will be omitted. In the next step S6, the position information of the obstacles included in the search area set in step S5 is classified for each cluster. That is, as described above, a straight line constituted by position information of a plurality of obstacles included in the search area is calculated, and a variance value for the distance between the calculated straight line and each obstacle position information is obtained. When the variance value is less than or equal to a predetermined threshold value, it is determined that they belong to the same cluster. When the variance value is larger than the threshold value, it is determined that the end point of the cluster has been detected, and it is determined that the obstacle position information having the variance value larger than the threshold value belongs to another cluster or is noise information.
[0029]
In step S7, a re-search area for detecting an obstacle having a linear structure is set from position information of a plurality of obstacles included in the cluster classified in step S6. Detailed description of the re-search area setting method is also omitted. In step S8, a point group satisfying the re-search condition is detected from the position information of the obstacle in the re-search area set in step S7. The point group that satisfies the re-search condition is a set of obstacle position information that satisfies the condition of Expression (2) as described above, and indicates an obstacle having a linear structure. When a point group satisfying the re-search condition is detected, the process proceeds to step S9. In step S9, an obstacle map is generated by the obstacle map generation device based on the point cloud detected in step S8, that is, the obstacle position information. The obstacle map includes the control / alarm level as well as the arrangement and structure of the obstacle as described above. Since the method for creating the obstacle map is also described above, the description thereof is omitted.
[0030]
As described above, according to the obstacle map creation device for a vehicle according to the present invention, the distance data to the obstacle is converted into the position information of the obstacle based on the vehicle behavior. can do. In addition, the obstacle position information is classified based on the vehicle behavior and the measurement characteristics of the distance measuring device, and further, the obstacle data having a linear structure is detected and the obstacle map is created to obtain the distance data that becomes noise. It can be eliminated, and the structure and arrangement of obstacles can be accurately grasped. In addition, by including control / alarm level information in the obstacle map, when the vehicle enters the area where the obstacle exists, the current control of the vehicle is checked by checking the control / alarm level of the area where the vehicle has entered. The level or alarm level can be grasped.
[0031]
The present invention is not limited to the embodiment described above. For example, the vehicle information detection device 201 detects the position and direction of the vehicle based on the vehicle speed sensor 201a and the steering angle sensor 201b, but may detect using a gyro or the like. Further, the control / alarm level is not limited to three stages, and can be divided into favorite stages. In the description of the embodiment described above, the control / alarm level region is set to the confidence intervals of 95%, 90%, and 85%, but the reliability coefficient is not limited to these values.
[Brief description of the drawings]
FIG. 1 is a diagram showing the configuration of an embodiment of a vehicle obstacle map creation device according to the present invention;
FIG. 2 is a diagram showing an in-vehicle position and a measurement range of the distance measuring device.
FIG. 3 is a diagram showing a configuration of a vehicle information detection device.
4A is a diagram showing a positional relationship between a vehicle and an obstacle in a real space coordinate system, and FIG. 4B is a diagram showing a positional relationship between the vehicle and an obstacle in a coordinate system of a storage area.
FIG. 5 is a diagram showing search areas for classifying obstacle position information.
6A is a diagram showing a search area when the vehicle is traveling at a low speed, and FIG. 6B is a diagram showing a search area when the vehicle is traveling at a high speed.
FIG. 7 is a diagram for explaining a classification method of obstacle position information;
FIG. 8 is a diagram showing a re-search area and a group of obstacle position information satisfying the re-search condition.
FIG. 9 is a diagram showing an obstacle map including control / alarm level information.
FIG. 10 is a flowchart showing a procedure for creating an embodiment of an obstacle map.
[Explanation of symbols]
DESCRIPTION OF SYMBOLS 1 ... Vehicle, 101 ... Distance measuring device, 102 ... Measuring range, 201 ... Vehicle information detecting device, 201a ... Vehicle speed sensor, 201b ... Steering angle sensor, 202 ... Position of vehicle, 203 ... Y axis and the advancing direction of a vehicle Angle formed by 204, position of distance measuring device, 205, measuring axis, 206, obstacle, 301, position information conversion storage device, 310, position of distance measuring device, 311, 312, 313, 314, 315, 323, 330 331, 332, 333, 334 ... obstacle position information, 316 ... maximum detection distance position, 317 ... search region, 318 ... approximate line, 320, 321 ... re-search region, 322 ... region satisfying the re-search condition, 401 ... Distance measurement characteristic storage device, 501 ... Noise removal device, 601 ... Obstacle map generation device

Claims (8)

対象物までの距離を計測する距離計測装置と、
車両挙動を検出する車両情報検出装置と、
前記車両情報検出装置により検出した車両挙動に基づいて、前記距離計測装置により計測した対象物までの距離情報を対象物の位置情報に変換して記憶する位置情報変換記憶装置と、
前記位置情報変換記憶装置に記憶された複数の前記対象物の位置情報を対象物ごとに分類する分類装置と、
前記分類装置によって分類された位置情報に基づいて、ノイズ情報を除去するノイズ除去装置と、
前記ノイズ除去装置によってノイズ情報が除去された位置情報に基づいて障害物の地図を生成する障害物地図生成装置とを備えることを特徴とする車両用障害物地図作成装置。
A distance measuring device for measuring the distance to the object;
A vehicle information detection device for detecting vehicle behavior;
Based on the vehicle behavior detected by the vehicle information detection device, a position information conversion storage device that converts and stores the distance information to the object measured by the distance measurement device into the position information of the object;
A classification device for classifying the position information of the plurality of objects stored in the position information conversion storage device for each object;
A noise removing device for removing noise information based on the position information classified by the classification device;
An obstacle map generation device for a vehicle, comprising: an obstacle map generation device that generates an obstacle map based on position information from which noise information has been removed by the noise removal device.
請求項1に記載の車両用障害物地図作成装置において、
前記距離計測装置の計測特性を記憶する距離計測特性記憶装置をさらに備え、
前記ノイズ除去装置は、前記車両情報検出装置により検出した車両挙動と、前記距離計測特性記憶装置に記憶された計測特性とに基づいて、前記ノイズ情報を除去することを特徴とする車両用障害物地図作成装置。
In the vehicle obstacle map creation device according to claim 1,
A distance measurement characteristic storage device for storing measurement characteristics of the distance measurement device;
The noise removing device removes the noise information based on a vehicle behavior detected by the vehicle information detecting device and a measurement characteristic stored in the distance measurement characteristic storage device. Map making device.
請求項2に記載の車両用障害物地図作成装置において、
前記距離計測特性記憶装置が記憶する計測特性は、前記距離計測装置の最大検知距離、検知幅、検知角、距離分解能、計測周期のうちのいずれか、もしくはそれらの組み合わせであることを特徴とする車両用障害物地図作成装置。
The obstacle map creation device for a vehicle according to claim 2,
The measurement characteristic stored in the distance measurement characteristic storage device is any one of a maximum detection distance, a detection width, a detection angle, a distance resolution, a measurement cycle of the distance measurement device, or a combination thereof. Obstacle map creation device for vehicles.
請求項1〜3のいずれかに記載の車両用障害物地図作成装置において、
前記車両情報検出装置が検出する車両挙動は、前記車両の位置と向きと速度であることを特徴とする車両用障害物地図作成装置。
In the obstacle map creation device for vehicles according to any one of claims 1 to 3,
The vehicle behavior map detected by the vehicle information detection device is a position, a direction, and a speed of the vehicle, and the obstacle map creation device for vehicles.
請求項1〜4のいずれかに記載の車両用障害物地図作成装置において、
前記分類装置は、対象物の位置情報を対象物ごとに分類するために、前記距離計測装置の位置と最大検知距離の位置とに基づいて定められる探索領域に含まれる対象物の位置情報を検出することを特徴とする車両用障害物地図作成装置。
In the obstacle map creation device for vehicles according to any one of claims 1 to 4,
The classifier, to classify the location information of the object for each object, detects the position information of the object contained in the search region determined based on the positions of the maximum detection distance of the distance measuring device vehicle obstacle mapping apparatus according to claim Rukoto issue.
請求項5に記載の車両用障害物地図作成装置において、
前記位置情報の探索領域の車両進行方向の幅を、前記車両の速度と前記距離計測装置の計測周期とに基づいて変化させることを特徴とする車両用障害物地図作成装置。
In the obstacle map creation device for vehicles according to claim 5,
An obstacle map creation device for a vehicle, wherein a width in a vehicle traveling direction of a search area of the position information is changed based on a speed of the vehicle and a measurement cycle of the distance measurement device.
請求項1〜6のいずれかに記載の車両用障害物地図作成装置において、
前記分類装置は、対象物ごとに分類した複数の対象物の位置情報の中から、直線構造を有する対象物の位置情報を検出することにより、さらに対象物の位置情報を分類することを特徴とする車両用障害物地図作成装置。
In the obstacle map creation device for a vehicle according to any one of claims 1 to 6 ,
The classification device further classifies the position information of the object by detecting position information of the object having a linear structure from the position information of the plurality of objects classified for each object. Vehicle obstacle map creation device.
請求項1〜7のいずれかに記載の車両用障害物地図作成装置において、
前記障害物地図生成装置は、前記分類された位置情報に基づいて対象物の存在する可能性に応じた複数の領域を設定し、前記設定した領域ごとに制御・警報レベル情報を含んだ障害物地図を生成することを特徴とする車両用障害物地図作成装置。
In the obstacle map creation device for vehicles according to any one of claims 1 to 7,
The obstacle map generation device sets a plurality of areas according to the possibility that an object exists based on the classified position information, and includes obstacle / control level information for each set area. A vehicle obstacle map creating device characterized by generating a map.
JP2001293638A 2001-09-26 2001-09-26 Obstacle map creation device for vehicles Expired - Fee Related JP3738719B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2001293638A JP3738719B2 (en) 2001-09-26 2001-09-26 Obstacle map creation device for vehicles

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2001293638A JP3738719B2 (en) 2001-09-26 2001-09-26 Obstacle map creation device for vehicles

Publications (2)

Publication Number Publication Date
JP2003098256A JP2003098256A (en) 2003-04-03
JP3738719B2 true JP3738719B2 (en) 2006-01-25

Family

ID=19115389

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001293638A Expired - Fee Related JP3738719B2 (en) 2001-09-26 2001-09-26 Obstacle map creation device for vehicles

Country Status (1)

Country Link
JP (1) JP3738719B2 (en)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3898157B2 (en) * 2003-06-04 2007-03-28 本田技研工業株式会社 Infrared image recognition device
JP5163084B2 (en) * 2007-12-06 2013-03-13 トヨタ自動車株式会社 Object detection device
JP5991731B2 (en) * 2012-02-01 2016-09-14 キヤノン株式会社 Information processing apparatus and information processing method
KR101734654B1 (en) 2015-06-25 2017-05-11 현대자동차주식회사 System and Method for writing Occupancy Grid Map of sensor centered coordinate system using laser scanner
JP6559535B2 (en) 2015-10-22 2019-08-14 株式会社東芝 Obstacle map generation device, method thereof, and program thereof
KR102441050B1 (en) * 2016-07-20 2022-09-06 현대자동차주식회사 Apparatus and method for controlling collision of vehicle
JP6552678B1 (en) * 2018-05-14 2019-07-31 三菱電機株式会社 Object recognition apparatus and object recognition method
CN111694287B (en) * 2020-05-14 2023-06-23 阿波罗智能技术(北京)有限公司 Obstacle simulation method and device in unmanned simulation scene

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05273341A (en) * 1992-03-30 1993-10-22 Mazda Motor Corp Obstruction detecting device
JP3147541B2 (en) * 1992-11-06 2001-03-19 株式会社豊田中央研究所 Obstacle recognition device for vehicles
JP3564897B2 (en) * 1996-10-03 2004-09-15 スズキ株式会社 Obstacle recognition device
JP3424908B2 (en) * 1998-07-08 2003-07-07 三菱ふそうトラック・バス株式会社 Vehicle rear side monitoring method and vehicle rear side monitoring device
JP2000180537A (en) * 1998-12-15 2000-06-30 Fujitsu Ten Ltd Method for identifying target to be controlled of scan- type radar
JP2000292538A (en) * 1999-04-07 2000-10-20 Mitsubishi Electric Corp Obstacle detector for vehicle
JP2001242242A (en) * 2000-02-29 2001-09-07 Hitachi Ltd Millimeter-wave radar device with function for improving detecting performance

Also Published As

Publication number Publication date
JP2003098256A (en) 2003-04-03

Similar Documents

Publication Publication Date Title
CN106255899B (en) Device for signaling an object to a navigation module of a vehicle equipped with such a device
CN109870680B (en) Target classification method and device
CN107490794B (en) Object identification processing device, object identification processing method and automatic driving system
US8849557B1 (en) Leveraging of behavior of vehicles to detect likely presence of an emergency vehicle
JP5402335B2 (en) Reliability evaluation apparatus, reliability evaluation method, and reliability evaluation program
CN110632921A (en) Robot path planning method and device, electronic equipment and storage medium
WO2016189112A1 (en) Collision avoidance method, computer program product for said collision avoidance method and collision avoidance system
JP2006031162A (en) Moving obstacle detection device
CN113139607B (en) Obstacle detection method and device
JP2013020458A (en) On-vehicle object discrimination device
JP3738719B2 (en) Obstacle map creation device for vehicles
JP2006160116A (en) Vehicle motion estimation device and moving body detection device
US20220343637A1 (en) Traffic flow machine-learning modeling system and method applied to vehicles
CN110612561A (en) Object recognition device, roadside device, and object recognition method
CN112313536A (en) Object state acquisition method, movable platform and storage medium
CN114296095A (en) Method, device, vehicle and medium for extracting effective target of automatic driving vehicle
JP3925285B2 (en) Road environment detection device
KR102337034B1 (en) Autonomous driving situation recognition program performance test method and apparatus for porceeding the same
JP6555132B2 (en) Moving object detection device
CN109195849B (en) Image pickup apparatus
CN113022593B (en) Obstacle processing method and device and traveling equipment
CN116189472A (en) Intersection early warning method and device
JP4069769B2 (en) Road shape recognition device
JP2007263725A (en) Object determination device, method, and program
CN110967040B (en) Method and system for identifying horizontal deviation angle of sensor

Legal Events

Date Code Title Description
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20050401

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

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20051024

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

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20101111

Year of fee payment: 5

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20111111

Year of fee payment: 6

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20121111

Year of fee payment: 7

LAPS Cancellation because of no payment of annual fees