JP2003098256A - 車両用障害物地図作成装置 - Google Patents
車両用障害物地図作成装置Info
- Publication number
- JP2003098256A JP2003098256A JP2001293638A JP2001293638A JP2003098256A JP 2003098256 A JP2003098256 A JP 2003098256A JP 2001293638 A JP2001293638 A JP 2001293638A JP 2001293638 A JP2001293638 A JP 2001293638A JP 2003098256 A JP2003098256 A JP 2003098256A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- obstacle
- position information
- obstacle map
- information
- 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.)
- Granted
Links
Abstract
(57)【要約】
【課題】正確に障害物の構造や配置を把握する
【解決手段】車両用障害物地図作成装置は、対象物まで
の距離を計測する距離計測装置１０１と、車両挙動を検
出する車両情報検出装置２０１と、車両情報検出装置２
０１により検出した車両挙動に基づいて、距離計測装置
１０１により計測した対象物までの距離情報を対象物の
位置情報に変換して記憶する位置情報変換記憶装置３０
１と、距離計測装置１０１の計測特性を記憶する距離計
測特性記憶装置４０１と、車両情報検出装置２０１によ
り検出した車両挙動と、距離計測特性記憶装置４０１に
記憶された計測特性とに基づいて、位置情報変換記憶装
置３０１に記憶された複数の対象物の位置情報からノイ
ズ情報を除去して対象物の位置情報を分類するノイズ除
去装置５０１と、分類された位置情報に基づいて障害物
の地図を生成する障害物地図生成装置６０１とを備え
る。
の距離を計測する距離計測装置１０１と、車両挙動を検
出する車両情報検出装置２０１と、車両情報検出装置２
０１により検出した車両挙動に基づいて、距離計測装置
１０１により計測した対象物までの距離情報を対象物の
位置情報に変換して記憶する位置情報変換記憶装置３０
１と、距離計測装置１０１の計測特性を記憶する距離計
測特性記憶装置４０１と、車両情報検出装置２０１によ
り検出した車両挙動と、距離計測特性記憶装置４０１に
記憶された計測特性とに基づいて、位置情報変換記憶装
置３０１に記憶された複数の対象物の位置情報からノイ
ズ情報を除去して対象物の位置情報を分類するノイズ除
去装置５０１と、分類された位置情報に基づいて障害物
の地図を生成する障害物地図生成装置６０１とを備え
る。
Description
【０００１】
【発明の属する技術分野】本発明は、車両周囲に存在す
る障害物を検出して、障害物地図を作成する装置に関す
る。
る障害物を検出して、障害物地図を作成する装置に関す
る。
【０００２】
【従来の技術】特開平１０−１１２０００号公報に記載
の障害物認識装置では、距離測定センサによって測定さ
れた障害物までの距離情報に基づいて、距離測定センサ
の計測範囲の各地点が「障害物あり」、「障害物無
し」、「不明」のいずれの領域であるかを判定する。こ
の判定結果と実際の障害物の有無との関係を判定正答率
として予め記憶しておき、判定正答率に基づいて「障害
物あり」と「障害物無し」の判定結果の確からしさを算
出して障害物の地図を作成している。
の障害物認識装置では、距離測定センサによって測定さ
れた障害物までの距離情報に基づいて、距離測定センサ
の計測範囲の各地点が「障害物あり」、「障害物無
し」、「不明」のいずれの領域であるかを判定する。こ
の判定結果と実際の障害物の有無との関係を判定正答率
として予め記憶しておき、判定正答率に基づいて「障害
物あり」と「障害物無し」の判定結果の確からしさを算
出して障害物の地図を作成している。
【０００３】
【発明が解決しようとする課題】しかしながら、上述し
た従来の障害物認識装置では、距離測定センサによる障
害物の有無の判定正答率を予め算出しておく必要があ
る。また、この方法では、障害物認識装置を車両に搭載
した場合に、車両の速度や方向の変化に対応して障害物
を正確に認識することが難しいという問題があった。
た従来の障害物認識装置では、距離測定センサによる障
害物の有無の判定正答率を予め算出しておく必要があ
る。また、この方法では、障害物認識装置を車両に搭載
した場合に、車両の速度や方向の変化に対応して障害物
を正確に認識することが難しいという問題があった。
【０００４】本発明の目的は、距離測定装置の特性や車
両挙動に基づいて、正確に障害物の構造や配置を把握す
ることができる車両用障害物地図作成装置を提供するこ
とにある。
両挙動に基づいて、正確に障害物の構造や配置を把握す
ることができる車両用障害物地図作成装置を提供するこ
とにある。
【０００５】
【課題を解決するための手段】（１）請求項１の発明
は、対象物までの距離を計測する距離計測装置と、車両
挙動を検出する車両情報検出装置と、車両情報検出装置
により検出した車両挙動に基づいて、距離計測装置によ
り計測した対象物までの距離情報を対象物の位置情報に
変換して記憶する位置情報変換記憶装置と、位置情報変
換記憶装置に記憶された複数の対象物の位置情報からノ
イズ情報を除去して対象物の位置情報を分類するノイズ
除去装置と、分類された位置情報に基づいて障害物の地
図を生成する障害物地図生成装置とを備えることによ
り、上記目的を達成する。 （２）請求項２の発明は、請求項１の車両用障害物地図
作成装置において、距離計測装置の計測特性を記憶する
距離計測特性記憶装置をさらに備え、ノイズ除去装置
は、車両情報検出装置により検出した車両挙動と、距離
計測特性記憶装置に記憶された計測特性とに基づいて、
ノイズ情報を除去することを特徴とする。 （３）請求項３の発明は、請求項２の車両用障害物地図
作成装置において、距離計測特性記憶装置が記憶する計
測特性は、距離計測装置の最大検知距離、検知幅、検知
角、距離分解能、計測周期のうちのいずれか、もしくは
それらの組み合わせであることを特徴とする。 （４）請求項４の発明は、請求項１〜３のいずれかの車
両用障害物地図作成装置において、車両情報検出装置が
検出する車両挙動は、車両の位置と向きと速度であるこ
とを特徴とする。 （５）請求項５の発明は、請求項１〜４のいずれかに記
載の車両用障害物地図作成装置において、ノイズ除去装
置は、距離計測装置の位置と最大検知距離の位置とに基
づいて定められる探索領域に含まれる対象物の位置情報
を検出して分類することを特徴とする。 （６）請求項６の発明は、請求項５の車両用障害物地図
作成装置において、位置情報の探索領域の車両進行方向
の幅を、車両の速度と距離計測装置の計測周期とに基づ
いて変化させることを特徴とする。 （７）請求項７の発明は、請求項５または６の車両用障
害物地図作成装置において、ノイズ除去装置は、分類さ
れた複数の対象物の位置情報の中から、直線構造を有す
る対象物の位置情報を検出することにより、さらに対象
物の位置情報を分類することを特徴とする。 （８）請求項８の発明は、請求項１〜７のいずれかの車
両用障害物地図作成装置において、障害物地図生成装置
は、分類された位置情報に基づいて対象物の存在する可
能性に応じた複数の領域を設定し、設定した領域ごとに
制御・警報レベル情報を含んだ障害物地図を生成するこ
とを特徴とする。
は、対象物までの距離を計測する距離計測装置と、車両
挙動を検出する車両情報検出装置と、車両情報検出装置
により検出した車両挙動に基づいて、距離計測装置によ
り計測した対象物までの距離情報を対象物の位置情報に
変換して記憶する位置情報変換記憶装置と、位置情報変
換記憶装置に記憶された複数の対象物の位置情報からノ
イズ情報を除去して対象物の位置情報を分類するノイズ
除去装置と、分類された位置情報に基づいて障害物の地
図を生成する障害物地図生成装置とを備えることによ
り、上記目的を達成する。 （２）請求項２の発明は、請求項１の車両用障害物地図
作成装置において、距離計測装置の計測特性を記憶する
距離計測特性記憶装置をさらに備え、ノイズ除去装置
は、車両情報検出装置により検出した車両挙動と、距離
計測特性記憶装置に記憶された計測特性とに基づいて、
ノイズ情報を除去することを特徴とする。 （３）請求項３の発明は、請求項２の車両用障害物地図
作成装置において、距離計測特性記憶装置が記憶する計
測特性は、距離計測装置の最大検知距離、検知幅、検知
角、距離分解能、計測周期のうちのいずれか、もしくは
それらの組み合わせであることを特徴とする。 （４）請求項４の発明は、請求項１〜３のいずれかの車
両用障害物地図作成装置において、車両情報検出装置が
検出する車両挙動は、車両の位置と向きと速度であるこ
とを特徴とする。 （５）請求項５の発明は、請求項１〜４のいずれかに記
載の車両用障害物地図作成装置において、ノイズ除去装
置は、距離計測装置の位置と最大検知距離の位置とに基
づいて定められる探索領域に含まれる対象物の位置情報
を検出して分類することを特徴とする。 （６）請求項６の発明は、請求項５の車両用障害物地図
作成装置において、位置情報の探索領域の車両進行方向
の幅を、車両の速度と距離計測装置の計測周期とに基づ
いて変化させることを特徴とする。 （７）請求項７の発明は、請求項５または６の車両用障
害物地図作成装置において、ノイズ除去装置は、分類さ
れた複数の対象物の位置情報の中から、直線構造を有す
る対象物の位置情報を検出することにより、さらに対象
物の位置情報を分類することを特徴とする。 （８）請求項８の発明は、請求項１〜７のいずれかの車
両用障害物地図作成装置において、障害物地図生成装置
は、分類された位置情報に基づいて対象物の存在する可
能性に応じた複数の領域を設定し、設定した領域ごとに
制御・警報レベル情報を含んだ障害物地図を生成するこ
とを特徴とする。
【０００６】
【発明の効果】以上詳細に説明したように本発明によれ
ば、次のような効果を奏する。 （１）請求項１〜７の発明によれば、対象物までの距離
データを車両挙動に基づいて対象物の位置情報に変換し
た後に、対象物の位置情報からノイズ情報を除去して分
類し、分類した位置情報に基づいて障害物地図を作成す
るので、ノイズとなる距離データを排除することがで
き、障害物の構造や配置を正確に把握することができ
る。 （２）請求項２の発明によれば、距離計測装置の計測特
性を記憶する距離計測特性記憶装置をさらに備え、ノイ
ズ除去装置は、車両情報検出装置により検出した車両挙
動と、距離計測特性記憶装置に記憶された計測特性とに
基づいて、ノイズ情報を除去するので、さらに正確に障
害物の構造や配置を把握することができる。 （３）請求項３の発明によれば、計測特性は、距離計測
装置の最大検知距離、検知幅、検知角、距離分解能、計
測周期のうちのいずれか、もしくはそれらの組み合わせ
であるので、これらの計測特性に基づいて正確にノイズ
情報を除去して対象物の位置情報を分類することができ
る。 （４）請求項４の発明によれば、車両挙動の情報は車両
の位置、向き、速度であるので、正確に車両と対象物と
の位置関係を把握することができるとともに、正確に対
象物の位置を分類することができる。 （５）請求項５の発明によれば、対象物の位置情報を分
類するための領域を距離計測装置の位置と最大検知距離
の位置とに基づいて定められる探索領域としているの
で、距離計測装置で検知不可能な領域に存在する情報を
処理する必要が無く、処理時間を短縮することができ
る。 （６）請求項６の発明によれば、位置情報の探索領域の
車両進行方向の幅を車両の速度と距離計測装置の計測周
期とに基づいて変化させるので、位置情報を分類する際
に車速や計測周期の変化の影響を受けることがない。 （７）請求項７の発明によれば、直線構造を有する対象
物の位置情報を検出してさらに位置情報を分類すること
により、さらに正確に障害物の位置・構造を把握するこ
とができる。 （８）請求項８の発明によれば、障害物地図には対象物
の存在する可能性の領域に応じた制御・警報レベルが含
まれているので、簡単かつ正確に車両と障害物との接触
可能性を検出することができる。
ば、次のような効果を奏する。 （１）請求項１〜７の発明によれば、対象物までの距離
データを車両挙動に基づいて対象物の位置情報に変換し
た後に、対象物の位置情報からノイズ情報を除去して分
類し、分類した位置情報に基づいて障害物地図を作成す
るので、ノイズとなる距離データを排除することがで
き、障害物の構造や配置を正確に把握することができ
る。 （２）請求項２の発明によれば、距離計測装置の計測特
性を記憶する距離計測特性記憶装置をさらに備え、ノイ
ズ除去装置は、車両情報検出装置により検出した車両挙
動と、距離計測特性記憶装置に記憶された計測特性とに
基づいて、ノイズ情報を除去するので、さらに正確に障
害物の構造や配置を把握することができる。 （３）請求項３の発明によれば、計測特性は、距離計測
装置の最大検知距離、検知幅、検知角、距離分解能、計
測周期のうちのいずれか、もしくはそれらの組み合わせ
であるので、これらの計測特性に基づいて正確にノイズ
情報を除去して対象物の位置情報を分類することができ
る。 （４）請求項４の発明によれば、車両挙動の情報は車両
の位置、向き、速度であるので、正確に車両と対象物と
の位置関係を把握することができるとともに、正確に対
象物の位置を分類することができる。 （５）請求項５の発明によれば、対象物の位置情報を分
類するための領域を距離計測装置の位置と最大検知距離
の位置とに基づいて定められる探索領域としているの
で、距離計測装置で検知不可能な領域に存在する情報を
処理する必要が無く、処理時間を短縮することができ
る。 （６）請求項６の発明によれば、位置情報の探索領域の
車両進行方向の幅を車両の速度と距離計測装置の計測周
期とに基づいて変化させるので、位置情報を分類する際
に車速や計測周期の変化の影響を受けることがない。 （７）請求項７の発明によれば、直線構造を有する対象
物の位置情報を検出してさらに位置情報を分類すること
により、さらに正確に障害物の位置・構造を把握するこ
とができる。 （８）請求項８の発明によれば、障害物地図には対象物
の存在する可能性の領域に応じた制御・警報レベルが含
まれているので、簡単かつ正確に車両と障害物との接触
可能性を検出することができる。
【０００７】
【発明の実施の形態】図１は、本発明による車両用障害
物地図作成装置の一実施の形態の構成を示す図である。
車両用障害物地図作成装置は、距離計測装置１０１と、
車両情報検出装置２０１と、位置情報変換記憶装置３０
１と、距離計測特性記憶装置４０１と、ノイズ除去装置
５０１と、障害物地図生成装置６０１とを備える。距離
計測装置１０１は、車両周囲に存在する障害物（対象
物）までの距離を測定する装置であり、超音波センサや
マイクロ波レーダ、レーザレーダ等を用いることができ
る。距離計測装置１０１は、車両の進行方向に対して横
向きに、左右対象な位置に１つずつ車載される。本実施
の形態では、図２に示すように、車両１の後輪の後方部
に外側を向いて左右に１つずつ搭載されている。距離計
測装置１０１による計測可能範囲は、図２に示す楕円１
０２の範囲内である。
物地図作成装置の一実施の形態の構成を示す図である。
車両用障害物地図作成装置は、距離計測装置１０１と、
車両情報検出装置２０１と、位置情報変換記憶装置３０
１と、距離計測特性記憶装置４０１と、ノイズ除去装置
５０１と、障害物地図生成装置６０１とを備える。距離
計測装置１０１は、車両周囲に存在する障害物（対象
物）までの距離を測定する装置であり、超音波センサや
マイクロ波レーダ、レーザレーダ等を用いることができ
る。距離計測装置１０１は、車両の進行方向に対して横
向きに、左右対象な位置に１つずつ車載される。本実施
の形態では、図２に示すように、車両１の後輪の後方部
に外側を向いて左右に１つずつ搭載されている。距離計
測装置１０１による計測可能範囲は、図２に示す楕円１
０２の範囲内である。
【０００８】車両情報検出装置２０１は、図３に示すよ
うに、車速センサ２０１ａと操舵角センサ２０１ｂとを
有し、車両１の位置や方向、速度などの車両挙動に関す
る情報を検出する。検出した車両挙動情報は、位置情報
変換記憶装置３０１に送られる。位置情報変換記憶装置
３０１は、車両情報検出装置２０１から送られる車両挙
動情報に基づいて、距離計測装置１０１によって計測さ
れた障害物までの距離データを障害物の位置情報に変換
して記憶する。
うに、車速センサ２０１ａと操舵角センサ２０１ｂとを
有し、車両１の位置や方向、速度などの車両挙動に関す
る情報を検出する。検出した車両挙動情報は、位置情報
変換記憶装置３０１に送られる。位置情報変換記憶装置
３０１は、車両情報検出装置２０１から送られる車両挙
動情報に基づいて、距離計測装置１０１によって計測さ
れた障害物までの距離データを障害物の位置情報に変換
して記憶する。
【０００９】障害物の位置情報は、位置情報変換記憶装
置３０１の記憶領域における座標上で表現される。図４
（ａ）は、実空間の座標系における車両１と障害物２０
６との位置関係を示す図であり、図４（ｂ）は、位置情
報変換記憶装置３０１の記憶領域における座標系にて、
車両１に対する相対的な障害物２０６の位置を示す図で
ある。実空間の座標系における障害物２０６の位置は、
車両１との相対的な位置を示す位置情報変換記憶装置３
０１の記憶領域における座標上の点３１１で示される。
また、図４（ａ）で符号２０４で示される距離計測装置
１０１の位置は点３１０で示される。
置３０１の記憶領域における座標上で表現される。図４
（ａ）は、実空間の座標系における車両１と障害物２０
６との位置関係を示す図であり、図４（ｂ）は、位置情
報変換記憶装置３０１の記憶領域における座標系にて、
車両１に対する相対的な障害物２０６の位置を示す図で
ある。実空間の座標系における障害物２０６の位置は、
車両１との相対的な位置を示す位置情報変換記憶装置３
０１の記憶領域における座標上の点３１１で示される。
また、図４（ａ）で符号２０４で示される距離計測装置
１０１の位置は点３１０で示される。
【００１０】実空間の座標系における障害物の位置を記
憶領域の座標系での点に変換する方法について図４
（ａ），（ｂ）を用いて説明する。予め、実空間座標系
に基準となるＸ軸、Ｙ軸を定めておき、車両１の位置２
０２と、Ｘ軸と車両の進行方向との成す角２０３とを検
出する。車両の位置２０２と進行方向を示す角２０３
は、車両情報検出装置３０１により検出する。具体的に
は、車両１の左右後輪を結ぶ軸とこの軸に直交して車両
中心を通る軸を車両１の固定座標系と定め、ある時刻ｔ
０における車両１の固定座標系を実空間座標系ＸＹに定
める。時間変化Δｔごとの車両１の位置２０２と進行方
向を示す角２０３とを車速センサ２０１ａ、操舵角セン
サ２０１ｂを用いて検出する。検出した車両の位置２０
２と進行方向を示す角２０３とに基づいて、距離計測装
置１０１の位置２０４と、２つの距離計測装置１０１を
結ぶ軸（以下、計測軸と呼ぶ）２０５の方向とを算出す
る。図４（ｂ）に示す記憶領域の座標系では、算出した
計測軸２０５上に、距離計測装置１０１により検出した
距離データに相当する位置に、障害物２０６の位置情報
である点３１１を定める。
憶領域の座標系での点に変換する方法について図４
（ａ），（ｂ）を用いて説明する。予め、実空間座標系
に基準となるＸ軸、Ｙ軸を定めておき、車両１の位置２
０２と、Ｘ軸と車両の進行方向との成す角２０３とを検
出する。車両の位置２０２と進行方向を示す角２０３
は、車両情報検出装置３０１により検出する。具体的に
は、車両１の左右後輪を結ぶ軸とこの軸に直交して車両
中心を通る軸を車両１の固定座標系と定め、ある時刻ｔ
０における車両１の固定座標系を実空間座標系ＸＹに定
める。時間変化Δｔごとの車両１の位置２０２と進行方
向を示す角２０３とを車速センサ２０１ａ、操舵角セン
サ２０１ｂを用いて検出する。検出した車両の位置２０
２と進行方向を示す角２０３とに基づいて、距離計測装
置１０１の位置２０４と、２つの距離計測装置１０１を
結ぶ軸（以下、計測軸と呼ぶ）２０５の方向とを算出す
る。図４（ｂ）に示す記憶領域の座標系では、算出した
計測軸２０５上に、距離計測装置１０１により検出した
距離データに相当する位置に、障害物２０６の位置情報
である点３１１を定める。
【００１１】従って、障害物２０６が検出されるまで
は、位置情報変換記憶装置３０１の記憶領域におけるデ
ータは０であり、障害物２０６を検出すると記憶領域に
おける座標上に対応するデータが追加される。以後、車
両の移動に伴い検出される障害物２０６の相対的な位置
が、記憶領域の座標上のデータとして追加されていく。
図４（ｂ）に示す記憶領域上の座標上の白丸３１２，３
１３，３１４，３１５は３１１よりも以前に検出された
障害物の位置を示すデータである。
は、位置情報変換記憶装置３０１の記憶領域におけるデ
ータは０であり、障害物２０６を検出すると記憶領域に
おける座標上に対応するデータが追加される。以後、車
両の移動に伴い検出される障害物２０６の相対的な位置
が、記憶領域の座標上のデータとして追加されていく。
図４（ｂ）に示す記憶領域上の座標上の白丸３１２，３
１３，３１４，３１５は３１１よりも以前に検出された
障害物の位置を示すデータである。
【００１２】ノイズ除去装置５０１は、距離計測特性記
憶装置４０１に記憶されている距離計測装置１０１の検
知範囲特性と、車両情報検出装置２０１によって検出さ
れる車速などの車両情報とに基づいて、位置情報変換記
憶装置３０１に記憶された障害物位置情報を分類して、
第１の障害物地図を作成する。障害物位置情報の分類方
法について、図５を用いて説明する。
憶装置４０１に記憶されている距離計測装置１０１の検
知範囲特性と、車両情報検出装置２０１によって検出さ
れる車速などの車両情報とに基づいて、位置情報変換記
憶装置３０１に記憶された障害物位置情報を分類して、
第１の障害物地図を作成する。障害物位置情報の分類方
法について、図５を用いて説明する。
【００１３】位置情報変換記憶装置３０１の記憶領域に
おける座標系にて、障害物の位置情報を分類してノイズ
情報を除去するための探索領域を定める。この探索領域
は、距離計測装置１０１の位置３１０と計測軸上の最大
検知距離位置３１６の２点を焦点とする楕円領域３１７
とする。この探索領域３１７を距離計測特性と車速とに
応じて変化させることにより、車速に依存することな
く、障害物位置情報を分類することができる。
おける座標系にて、障害物の位置情報を分類してノイズ
情報を除去するための探索領域を定める。この探索領域
は、距離計測装置１０１の位置３１０と計測軸上の最大
検知距離位置３１６の２点を焦点とする楕円領域３１７
とする。この探索領域３１７を距離計測特性と車速とに
応じて変化させることにより、車速に依存することな
く、障害物位置情報を分類することができる。
【００１４】車両１の進行方向をｘ軸に取り、探索領域
３１７の楕円の焦点位置の座標ＸをそれぞれＸ0，Ｘ1、
車速をＶc、距離計測装置１０１の計測サンプリング周
期をＴsとすると、探索領域３１７内に含まれる点の座
標Ｘは、次式（１）を満たさなければならない。 ｜Ｘ−Ｘ0｜＋｜Ｘ−Ｘ1｜＜Ｖc・Ｔs＋α …（１） ただし、αは補正項であり、楕円焦点座標Ｘ0，Ｘ1はそ
れぞれ、距離計測装置１０１，計測軸上の最大検知距離
位置２０７の座標Ｘに相当する。図６（ａ）は、車速Ｖ
cが小さい場合の探索領域３１７を示す図であり、図６
（ｂ）は、車速Ｖcが大きい場合の探索領域３１７を示
す図である。図６（ａ）、（ｂ）から分かるように、車
速Ｖcが小さい時は探索領域のｘ軸方向の幅は小さくな
り、車速が高いときは探索領域３１７のｘ軸方向の幅は
大きくなる。
３１７の楕円の焦点位置の座標ＸをそれぞれＸ0，Ｘ1、
車速をＶc、距離計測装置１０１の計測サンプリング周
期をＴsとすると、探索領域３１７内に含まれる点の座
標Ｘは、次式（１）を満たさなければならない。 ｜Ｘ−Ｘ0｜＋｜Ｘ−Ｘ1｜＜Ｖc・Ｔs＋α …（１） ただし、αは補正項であり、楕円焦点座標Ｘ0，Ｘ1はそ
れぞれ、距離計測装置１０１，計測軸上の最大検知距離
位置２０７の座標Ｘに相当する。図６（ａ）は、車速Ｖ
cが小さい場合の探索領域３１７を示す図であり、図６
（ｂ）は、車速Ｖcが大きい場合の探索領域３１７を示
す図である。図６（ａ）、（ｂ）から分かるように、車
速Ｖcが小さい時は探索領域のｘ軸方向の幅は小さくな
り、車速が高いときは探索領域３１７のｘ軸方向の幅は
大きくなる。
【００１５】ノイズ除去装置５０１は、図５を参照する
と、探索領域３１７内に含まれる障害物位置３１１，３
１２，３１３を検出し、検出した複数の障害物位置３１
１，３１２，３１３により構成される直線３１８を、最
小二乗法等を用いて算出する。式（１）で示すように、
車速Ｖcとサンプリング周期Ｔsとに基づいて探索領域３
１７の大きさを変えることにより、障害物の配置や構造
を特定するために十分なサンプル数を確保することがで
きる。これにより、近似直線３１８の精度を向上するこ
とができるので、後述する障害物位置情報を分類する精
度を向上することができる。
と、探索領域３１７内に含まれる障害物位置３１１，３
１２，３１３を検出し、検出した複数の障害物位置３１
１，３１２，３１３により構成される直線３１８を、最
小二乗法等を用いて算出する。式（１）で示すように、
車速Ｖcとサンプリング周期Ｔsとに基づいて探索領域３
１７の大きさを変えることにより、障害物の配置や構造
を特定するために十分なサンプル数を確保することがで
きる。これにより、近似直線３１８の精度を向上するこ
とができるので、後述する障害物位置情報を分類する精
度を向上することができる。
【００１６】続いて、探索領域３１７内に含まれる各障
害物位置情報３１１，３１２，３１３から直線３１８ま
での距離（偏差）ついての分散値を求める。分散値は、
距離計測装置１０１の分解能等に依存する。従って、分
散値のしきい値は、距離計測装置１０１の分解能、測定
誤差及び位置情報変換記憶装置３０１の分解能により決
定する。求めた分散値が所定値のしきい値以下であると
きは、各障害物位置３１１，３１２，３１３は同一のク
ラスタ（グループ）に属すると判定する。一方、求めた
分散値が所定のしきい値より大きいときは、同一クラス
タの終点を検出したと判定する。すなわち、分散値が所
定のしきい値以下の値を示す点は同一クラスタに属し、
所定のしきい値を越えた点は、ノイズ情報であるか別の
クラスタに属する位置情報であると判定する。
害物位置情報３１１，３１２，３１３から直線３１８ま
での距離（偏差）ついての分散値を求める。分散値は、
距離計測装置１０１の分解能等に依存する。従って、分
散値のしきい値は、距離計測装置１０１の分解能、測定
誤差及び位置情報変換記憶装置３０１の分解能により決
定する。求めた分散値が所定値のしきい値以下であると
きは、各障害物位置３１１，３１２，３１３は同一のク
ラスタ（グループ）に属すると判定する。一方、求めた
分散値が所定のしきい値より大きいときは、同一クラス
タの終点を検出したと判定する。すなわち、分散値が所
定のしきい値以下の値を示す点は同一クラスタに属し、
所定のしきい値を越えた点は、ノイズ情報であるか別の
クラスタに属する位置情報であると判定する。
【００１７】また、探索領域３１７に包含される障害物
位置情報の数が所定の数よりも少ないときも、クラスタ
の終点を検出したと判定する。このことを図７を用いて
説明する。順次、クラスタの分類を行っていった場合
に、探索領域３１７に包含される障害物位置情報の数が
所定の数よりも少ない場合、図７に示すように、障害物
位置情報３３０〜３３３は同一のクラスタに属する情報
であるが、障害物位置情報３３４は他のクラスタに属す
るものである。すなわち、障害物位置情報３３０と障害
物位置情報３３４との間に連続性が無いために、両者は
別のクラスタに属するものと判定する。
位置情報の数が所定の数よりも少ないときも、クラスタ
の終点を検出したと判定する。このことを図７を用いて
説明する。順次、クラスタの分類を行っていった場合
に、探索領域３１７に包含される障害物位置情報の数が
所定の数よりも少ない場合、図７に示すように、障害物
位置情報３３０〜３３３は同一のクラスタに属する情報
であるが、障害物位置情報３３４は他のクラスタに属す
るものである。すなわち、障害物位置情報３３０と障害
物位置情報３３４との間に連続性が無いために、両者は
別のクラスタに属するものと判定する。
【００１８】図８を用いて、障害物位置情報を分類した
結果に基づいて、ノイズ情報を除去して第１の障害物地
図を得る方法について説明する。車両周囲に存在する障
害物には、例えば駐車場における駐車車両や柱、壁、ガ
ードレール等がある。車両が移動しながら、駐車車両や
ガードレールなどの障害物を距離計測装置１０１を用い
て検出し、記憶領域の座標上に障害物位置を記憶してい
くと、比較的直線性の良い点列を構成することが分か
る。しかし、上述した障害物位置の分類結果には、障害
物の位置情報のバラツキや、距離計測装置１０１自身に
よる計測誤差なども含まれている。従って、直線構造を
有する障害物を正確に検出するために、測定結果の直線
性の精度を向上させるための処理を施す必要がある。
結果に基づいて、ノイズ情報を除去して第１の障害物地
図を得る方法について説明する。車両周囲に存在する障
害物には、例えば駐車場における駐車車両や柱、壁、ガ
ードレール等がある。車両が移動しながら、駐車車両や
ガードレールなどの障害物を距離計測装置１０１を用い
て検出し、記憶領域の座標上に障害物位置を記憶してい
くと、比較的直線性の良い点列を構成することが分か
る。しかし、上述した障害物位置の分類結果には、障害
物の位置情報のバラツキや、距離計測装置１０１自身に
よる計測誤差なども含まれている。従って、直線構造を
有する障害物を正確に検出するために、測定結果の直線
性の精度を向上させるための処理を施す必要がある。
【００１９】上述した障害物位置情報を分類した各クラ
スタにおいて、直線構造を有する障害物を検出するため
の再探索領域３２０，３２１を定める。再探索領域３２
０，３２１は、クラスタを構成する障害物位置情報を包
含する最小の領域に基づいて規定する。再探索領域３２
０，３２１を規定する際には、図８に示すｙ軸方向、す
なわち計測軸方向の領域は、距離計測装置１０１の距離
分解能、位置情報変換記憶装置３０１の記憶領域の距離
分解能、障害物位置情報の測定結果のバラツキを考慮し
て拡大する。また、図８に示すｘ軸方向、すなわち車両
１の進行方向の領域は、障害物位置情報の測定結果のバ
ラツキ等を考慮したｙ軸方向の拡大分に加えて、車速Ｖ
cと距離計測装置１０１のサンプリング周期Ｔsとを考慮
して拡大する。
スタにおいて、直線構造を有する障害物を検出するため
の再探索領域３２０，３２１を定める。再探索領域３２
０，３２１は、クラスタを構成する障害物位置情報を包
含する最小の領域に基づいて規定する。再探索領域３２
０，３２１を規定する際には、図８に示すｙ軸方向、す
なわち計測軸方向の領域は、距離計測装置１０１の距離
分解能、位置情報変換記憶装置３０１の記憶領域の距離
分解能、障害物位置情報の測定結果のバラツキを考慮し
て拡大する。また、図８に示すｘ軸方向、すなわち車両
１の進行方向の領域は、障害物位置情報の測定結果のバ
ラツキ等を考慮したｙ軸方向の拡大分に加えて、車速Ｖ
cと距離計測装置１０１のサンプリング周期Ｔsとを考慮
して拡大する。
【００２０】このように、再探索領域３２０，３２１を
拡大することにより、障害物位置情報を記憶する際、す
なわちアナログデータをデジタルデータに変換して記憶
する際の量子化誤差の影響を低減することができる。ま
た、ノイズ情報として分類することができなかった障害
物位置情報を障害物構造を規定するために用いることが
できるので、障害物地図としての正確性が向上する。
拡大することにより、障害物位置情報を記憶する際、す
なわちアナログデータをデジタルデータに変換して記憶
する際の量子化誤差の影響を低減することができる。ま
た、ノイズ情報として分類することができなかった障害
物位置情報を障害物構造を規定するために用いることが
できるので、障害物地図としての正確性が向上する。
【００２１】再探索領域３２０，３２１を定めると、再
探索領域３２０，３２１に含まれる障害物位置情報の中
から、後述する再探索条件を満たす障害物位置情報の点
群を抽出する。すなわち、再探索領域３２０に含まれる
障害物位置情報の任意の２点を焦点とする楕円領域内に
含まれる障害物位置情報の点の数が最大となる楕円領域
３２２を求め（図８参照）、この楕円領域内に含まれる
障害物位置情報を抽出する。
探索領域３２０，３２１に含まれる障害物位置情報の中
から、後述する再探索条件を満たす障害物位置情報の点
群を抽出する。すなわち、再探索領域３２０に含まれる
障害物位置情報の任意の２点を焦点とする楕円領域内に
含まれる障害物位置情報の点の数が最大となる楕円領域
３２２を求め（図８参照）、この楕円領域内に含まれる
障害物位置情報を抽出する。
【００２２】具体的には、障害物位置情報の点の数が最
大となる楕円領域３２２内に含まれる点の座標Ｙは、次
式（２）を満たす必要がある。 ｜Ｙ−Ｙ0｜＋｜Ｙ−Ｙ1｜＜β …（２） ただし、Ｙ0，Ｙ1は、再探索領域３２０に含まれる障害
物位置情報の任意の２点の座標Ｙであり、楕円の焦点座
標に相当する。βは所定の定数である。βが大きくなる
と、楕円３２２のｙ軸方向の領域が大きくなるので、楕
円３２２内の点群の直線性は低くなる。逆にβが小さい
と、楕円３２２のｙ軸方向の領域が小さくなるので、楕
円３２２内の点群のｘ軸方向の直線性は高くなる。すな
わち、楕円３２２内に含まれる点群により構成される直
線と各障害物位置情報を示す点との偏差は小さくなる。
大となる楕円領域３２２内に含まれる点の座標Ｙは、次
式（２）を満たす必要がある。 ｜Ｙ−Ｙ0｜＋｜Ｙ−Ｙ1｜＜β …（２） ただし、Ｙ0，Ｙ1は、再探索領域３２０に含まれる障害
物位置情報の任意の２点の座標Ｙであり、楕円の焦点座
標に相当する。βは所定の定数である。βが大きくなる
と、楕円３２２のｙ軸方向の領域が大きくなるので、楕
円３２２内の点群の直線性は低くなる。逆にβが小さい
と、楕円３２２のｙ軸方向の領域が小さくなるので、楕
円３２２内の点群のｘ軸方向の直線性は高くなる。すな
わち、楕円３２２内に含まれる点群により構成される直
線と各障害物位置情報を示す点との偏差は小さくなる。
【００２３】図８に示す再探索領域３２０では、障害物
位置情報３２３は楕円３２２内に含まれない。従って、
障害物位置情報３２３は、駐車車両の側面などの直線構
造を有する障害物とは別の障害物情報であると判定され
る。上記式（２）の条件を満たす障害物位置情報を、第
１の障害物地図として用いる。
位置情報３２３は楕円３２２内に含まれない。従って、
障害物位置情報３２３は、駐車車両の側面などの直線構
造を有する障害物とは別の障害物情報であると判定され
る。上記式（２）の条件を満たす障害物位置情報を、第
１の障害物地図として用いる。
【００２４】障害物地図生成装置６０１は、第１の障害
物地図に基づいて連続的な障害物地図を生成する。駐車
支援のための車両制御システムや警報システムには、自
車両の位置や予測軌道と障害物位置との情報に基づいて
ブレーキやハンドルを制御したり、障害物との接触可能
性を判断して警報を発するものがある。車両と障害物と
の接触可能性を判断するためには、車両周囲に存在する
障害物の地図を用いることができるが、障害物との接触
可能性を随時計算するためには、多大なデータを扱うこ
とができる高速演算処理装置を用いなければならない。
このため、本実施の形態の車両用障害物地図作成装置で
は、障害物の地図自体に、制御目標値または警報レベル
に相当するデータを含める。
物地図に基づいて連続的な障害物地図を生成する。駐車
支援のための車両制御システムや警報システムには、自
車両の位置や予測軌道と障害物位置との情報に基づいて
ブレーキやハンドルを制御したり、障害物との接触可能
性を判断して警報を発するものがある。車両と障害物と
の接触可能性を判断するためには、車両周囲に存在する
障害物の地図を用いることができるが、障害物との接触
可能性を随時計算するためには、多大なデータを扱うこ
とができる高速演算処理装置を用いなければならない。
このため、本実施の形態の車両用障害物地図作成装置で
は、障害物の地図自体に、制御目標値または警報レベル
に相当するデータを含める。
【００２５】図９は、図８に示す第１の障害物地図の各
クラスタを構成する点群に基づいて、３段階の制御・警
報レベルを割り当てた障害物地図である。すなわち、障
害物位置情報に基づいて、信頼係数が９５％、９０％、
８５％等の信頼区間を定めることにより、制御・警報レ
ベルを割り当てる。信頼係数とは、その区間に障害物位
置情報を示す点が含まれている確率であり、楕円３２２
内に含まれる点群を含む中心領域の信頼係数が最も低
く、中心領域から外側の領域になるほど信頼係数は大き
くなる。
クラスタを構成する点群に基づいて、３段階の制御・警
報レベルを割り当てた障害物地図である。すなわち、障
害物位置情報に基づいて、信頼係数が９５％、９０％、
８５％等の信頼区間を定めることにより、制御・警報レ
ベルを割り当てる。信頼係数とは、その区間に障害物位
置情報を示す点が含まれている確率であり、楕円３２２
内に含まれる点群を含む中心領域の信頼係数が最も低
く、中心領域から外側の領域になるほど信頼係数は大き
くなる。
【００２６】図９では、点群を含む中心の領域が制御・
警報レベル３であり、制御・警報レベル３を取り囲む真
ん中の領域の制御・警報レベルを２、最も外側の領域の
制御・警報レベルを１としている。この場合、制御・警
報レベルが３の領域は、障害物が存在する可能性が最も
高いため、車両がこの領域に進入したときの車両と障害
物との接触可能性は最も高い。レベル３に比べてレベル
２，レベル２に比べてレベル１の領域については、車両
と障害物との接触可能性は低くなる。障害物地図に障害
物の位置情報とともに制御・警報レベルを含めることに
より、車両と障害物との接触可能性を簡単に調べること
ができる。すなわち、障害物が存在する領域に車両が進
入した時に、車両が進入した領域の制御・警報レベルを
調べることにより、現在の車両の制御レベルまたは警報
レベルを把握することができる。これにより、車両が進
入した領域の制御・警報レベルに応じて、不図示のスピ
ーカを用いて警報を発したり、ブレーキ（不図示）を用
いて車両制御を行うことができる。
警報レベル３であり、制御・警報レベル３を取り囲む真
ん中の領域の制御・警報レベルを２、最も外側の領域の
制御・警報レベルを１としている。この場合、制御・警
報レベルが３の領域は、障害物が存在する可能性が最も
高いため、車両がこの領域に進入したときの車両と障害
物との接触可能性は最も高い。レベル３に比べてレベル
２，レベル２に比べてレベル１の領域については、車両
と障害物との接触可能性は低くなる。障害物地図に障害
物の位置情報とともに制御・警報レベルを含めることに
より、車両と障害物との接触可能性を簡単に調べること
ができる。すなわち、障害物が存在する領域に車両が進
入した時に、車両が進入した領域の制御・警報レベルを
調べることにより、現在の車両の制御レベルまたは警報
レベルを把握することができる。これにより、車両が進
入した領域の制御・警報レベルに応じて、不図示のスピ
ーカを用いて警報を発したり、ブレーキ（不図示）を用
いて車両制御を行うことができる。
【００２７】上述した障害物地図の作成手順について、
図１０のフローチャートを用いて簡単に説明しておく。
なお、各ステップの処理内容において、上述した説明の
中で詳しく述べた部分については、その説明を省略す
る。ステップＳ１では、距離計測装置１０１により障害
物２０６までの距離を計測する。距離を計測するとステ
ップＳ２に進む。ステップＳ２では、車両情報検出装置
２０１により車両の挙動を検出する。車両の挙動には、
上述したように、車両の位置、進行方向、速度などが含
まれる。車両の挙動を検出するとステップＳ３に進む。
ステップＳ３では、ステップＳ１で検出した障害物まで
の距離情報を、ステップＳ２で検出した車両の挙動に基
づいて障害物の位置情報に変換する。位置情報への変換
は、位置情報変換記憶装置３０１により行われるが、変
換方法は上述したのでここではその説明を省略する。ス
テップＳ４では、ステップＳ３で変換した位置情報を位
置情報変換記憶装置３０１に記憶する。
図１０のフローチャートを用いて簡単に説明しておく。
なお、各ステップの処理内容において、上述した説明の
中で詳しく述べた部分については、その説明を省略す
る。ステップＳ１では、距離計測装置１０１により障害
物２０６までの距離を計測する。距離を計測するとステ
ップＳ２に進む。ステップＳ２では、車両情報検出装置
２０１により車両の挙動を検出する。車両の挙動には、
上述したように、車両の位置、進行方向、速度などが含
まれる。車両の挙動を検出するとステップＳ３に進む。
ステップＳ３では、ステップＳ１で検出した障害物まで
の距離情報を、ステップＳ２で検出した車両の挙動に基
づいて障害物の位置情報に変換する。位置情報への変換
は、位置情報変換記憶装置３０１により行われるが、変
換方法は上述したのでここではその説明を省略する。ス
テップＳ４では、ステップＳ３で変換した位置情報を位
置情報変換記憶装置３０１に記憶する。
【００２８】以下、ステップＳ５〜Ｓ８で行われる処理
は、ノイズ除去装置５０１により行われる。ステップＳ
５では、ステップＳ４で記憶した障害物の位置情報をク
ラスタごとに分類するための探索領域を設定する。探索
領域の設定方法も上述したので説明を省略する。次のス
テップＳ６では、ステップＳ５で設定した探索領域内に
含まれる障害物の位置情報をクラスタごとに分類する。
すなわち、上述したように、探索領域内に含まれる複数
の障害物の位置情報が構成する直線を算出し、算出した
直線と各障害物位置情報との距離についての分散値を求
める。分散値が所定のしきい値以下であるときは同一の
クラスタに属すると判定する。分散値がしきい値より大
きいときはクラスタの終点を検出したと判定して、しき
い値より大きい分散値の障害物位置情報は別のクラスタ
に属するかノイズ情報であると判定する。
は、ノイズ除去装置５０１により行われる。ステップＳ
５では、ステップＳ４で記憶した障害物の位置情報をク
ラスタごとに分類するための探索領域を設定する。探索
領域の設定方法も上述したので説明を省略する。次のス
テップＳ６では、ステップＳ５で設定した探索領域内に
含まれる障害物の位置情報をクラスタごとに分類する。
すなわち、上述したように、探索領域内に含まれる複数
の障害物の位置情報が構成する直線を算出し、算出した
直線と各障害物位置情報との距離についての分散値を求
める。分散値が所定のしきい値以下であるときは同一の
クラスタに属すると判定する。分散値がしきい値より大
きいときはクラスタの終点を検出したと判定して、しき
い値より大きい分散値の障害物位置情報は別のクラスタ
に属するかノイズ情報であると判定する。
【００２９】ステップＳ７では、ステップＳ６で分類し
たクラスタ内に含まれる複数の障害物の位置情報の中か
ら、直線構造を有する障害物を検出するための再探索領
域を設定する。再探索領域の設定方法についても詳しい
説明は省略する。ステップＳ８では、ステップＳ７で設
定した再探索領域内の障害物の位置情報のうち、再探索
条件を満たす点群を検出する。再探索条件を満たす点群
とは、上述したように式（２）の条件を満たす障害物位
置情報の集合であり、直線構造を有する障害物を示す。
再探索条件を満たす点群を検出すると、ステップＳ９に
進む。ステップＳ９では、ステップＳ８で検出した点
群、すなわち障害物位置情報に基づいて、障害物地図生
成装置により障害物地図を生成する。障害物地図は、上
述したように障害物の配置や構造とともに、制御・警報
レベルを含んだものである。障害物地図の作成方法も上
述したので説明を省略する。
たクラスタ内に含まれる複数の障害物の位置情報の中か
ら、直線構造を有する障害物を検出するための再探索領
域を設定する。再探索領域の設定方法についても詳しい
説明は省略する。ステップＳ８では、ステップＳ７で設
定した再探索領域内の障害物の位置情報のうち、再探索
条件を満たす点群を検出する。再探索条件を満たす点群
とは、上述したように式（２）の条件を満たす障害物位
置情報の集合であり、直線構造を有する障害物を示す。
再探索条件を満たす点群を検出すると、ステップＳ９に
進む。ステップＳ９では、ステップＳ８で検出した点
群、すなわち障害物位置情報に基づいて、障害物地図生
成装置により障害物地図を生成する。障害物地図は、上
述したように障害物の配置や構造とともに、制御・警報
レベルを含んだものである。障害物地図の作成方法も上
述したので説明を省略する。
【００３０】以上、本発明による車両用障害物地図作成
装置によれば、障害物までの距離データを車両挙動に基
づいて障害物の位置情報に変換するので、正確に車両と
障害物との位置関係を把握することができる。また、障
害物の位置情報を車両挙動と距離計測装置の計測特性と
に基づいて分類し、さらに直線構造を有する障害物を検
出して障害物地図を作成することにより、ノイズとなる
距離データを排除することができ、障害物の構造や配置
を正確に把握することができる。また、障害物地図に制
御・警報レベルの情報を含めることにより、障害物が存
在する領域に車両が進入した時に、車両が進入した領域
の制御・警報レベルを調べることにより、現在の車両の
制御レベルまたは警報レベルを把握することができる。
装置によれば、障害物までの距離データを車両挙動に基
づいて障害物の位置情報に変換するので、正確に車両と
障害物との位置関係を把握することができる。また、障
害物の位置情報を車両挙動と距離計測装置の計測特性と
に基づいて分類し、さらに直線構造を有する障害物を検
出して障害物地図を作成することにより、ノイズとなる
距離データを排除することができ、障害物の構造や配置
を正確に把握することができる。また、障害物地図に制
御・警報レベルの情報を含めることにより、障害物が存
在する領域に車両が進入した時に、車両が進入した領域
の制御・警報レベルを調べることにより、現在の車両の
制御レベルまたは警報レベルを把握することができる。
【００３１】本発明は上述した実施の形態に限定される
ことはない。例えば、車両情報検出装置２０１は、車速
センサ２０１ａと操舵角センサ２０１ｂとに基づいて、
車両の位置と方向を検出したが、ジャイロ等を用いて検
出してもよい。また、制御・警報レベルは３段階に限ら
れず、好みの段階に分けることができる。上述した一実
施の形態の説明では、制御・警報レベルの領域を信頼係
数が９５％、９０％、８５％の信頼区間としたが、信頼
係数もこれらの値に限定されることはない。
ことはない。例えば、車両情報検出装置２０１は、車速
センサ２０１ａと操舵角センサ２０１ｂとに基づいて、
車両の位置と方向を検出したが、ジャイロ等を用いて検
出してもよい。また、制御・警報レベルは３段階に限ら
れず、好みの段階に分けることができる。上述した一実
施の形態の説明では、制御・警報レベルの領域を信頼係
数が９５％、９０％、８５％の信頼区間としたが、信頼
係数もこれらの値に限定されることはない。
【図１】本発明による車両用障害物地図作成装置の一実
施の形態の構成を示す図
施の形態の構成を示す図
【図２】距離計測装置の車載位置と計測範囲を示す図
【図３】車両情報検出装置の構成を示す図
【図４】（ａ）は、実空間座標系において車両と障害物
との位置関係を示す図、（ｂ）は、記憶領域の座標系に
おいて車両と障害物との位置関係を示す図
との位置関係を示す図、（ｂ）は、記憶領域の座標系に
おいて車両と障害物との位置関係を示す図
【図５】障害物位置情報を分類するための探索領域を示
す図
す図
【図６】（ａ）は、車両が低速で走行しているときの探
索領域を示す図、（ｂ）は、車両が高速で走行している
ときの探索領域を示す図
索領域を示す図、（ｂ）は、車両が高速で走行している
ときの探索領域を示す図
【図７】障害物位置情報の分類方法について説明するた
めの図
めの図
【図８】再探索領域と再探索条件を満たす障害物位置情
報群を示す図
報群を示す図
【図９】制御・警報レベル情報を含む障害物地図を示す
図
図
【図１０】障害物地図の一実施の形態の作成手順を示す
フローチャート
フローチャート
【符号の説明】
１…車両、１０１…距離計測装置、１０２…計測範囲、
２０１…車両情報検出装置、２０１ａ…車速センサ、２
０１ｂ…操舵角センサ、２０２…車両の位置、２０３…
Ｙ軸と車両の進行方向との成す角、２０４…距離計測装
置の位置、２０５…計測軸、２０６…障害物、３０１…
位置情報変換記憶装置、３１０…距離計測装置の位置、
３１１，３１２，３１３，３１４，３１５，３２３，３
３０，３３１，３３２，３３３，３３４…障害物の位置
情報、３１６…最大検知距離の位置、３１７…探索領
域、３１８…近似直線、３２０，３２１…再探索領域、
３２２…再探索条件を満たす領域、４０１…距離計測特
性記憶装置、５０１…ノイズ除去装置、６０１…障害物
地図生成装置
２０１…車両情報検出装置、２０１ａ…車速センサ、２
０１ｂ…操舵角センサ、２０２…車両の位置、２０３…
Ｙ軸と車両の進行方向との成す角、２０４…距離計測装
置の位置、２０５…計測軸、２０６…障害物、３０１…
位置情報変換記憶装置、３１０…距離計測装置の位置、
３１１，３１２，３１３，３１４，３１５，３２３，３
３０，３３１，３３２，３３３，３３４…障害物の位置
情報、３１６…最大検知距離の位置、３１７…探索領
域、３１８…近似直線、３２０，３２１…再探索領域、
３２２…再探索条件を満たす領域、４０１…距離計測特
性記憶装置、５０１…ノイズ除去装置、６０１…障害物
地図生成装置
─────────────────────────────────────────────────────
フロントページの続き
(51)Int.Cl.7 識別記号 ＦＩ テーマコート゛(参考）
Ｂ６０Ｒ 21/00 Ｂ６０Ｒ 21/00 ６２６Ｇ
６２８ ６２８Ｆ
Ｇ０８Ｇ 1/16 Ｇ０８Ｇ 1/16 Ｃ
Ｆターム(参考） 5H180 AA01 CC03 CC11 CC12 CC14
LL01 LL02 LL04 LL08
5J070 AC02 AC06 AC13 AE01 AF03
AJ13 AK22 AK28 BF12
Claims (8)
- 【請求項１】対象物までの距離を計測する距離計測装置
と、 車両挙動を検出する車両情報検出装置と、 前記車両情報検出装置により検出した車両挙動に基づい
て、前記距離計測装置により計測した対象物までの距離
情報を対象物の位置情報に変換して記憶する位置情報変
換記憶装置と、 前記位置情報変換記憶装置に記憶された複数の前記対象
物の位置情報からノイズ情報を除去して前記対象物の位
置情報を分類するノイズ除去装置と、 前記分類された位置情報に基づいて障害物の地図を生成
する障害物地図生成装置とを備えることを特徴とする車
両用障害物地図作成装置。 - 【請求項２】請求項１に記載の車両用障害物地図作成装
置において、 前記距離計測装置の計測特性を記憶する距離計測特性記
憶装置をさらに備え、 前記ノイズ除去装置は、前記車両情報検出装置により検
出した車両挙動と、前記距離計測特性記憶装置に記憶さ
れた計測特性とに基づいて、前記ノイズ情報を除去する
ことを特徴とする車両用障害物地図作成装置。 - 【請求項３】請求項２に記載の車両用障害物地図作成装
置において、 前記距離計測特性記憶装置が記憶する計測特性は、前記
距離計測装置の最大検知距離、検知幅、検知角、距離分
解能、計測周期のうちのいずれか、もしくはそれらの組
み合わせであることを特徴とする車両用障害物地図作成
装置。 - 【請求項４】請求項１〜３のいずれかに記載の車両用障
害物地図作成装置において、 前記車両情報検出装置が検出する車両挙動は、前記車両
の位置と向きと速度であることを特徴とする車両用障害
物地図作成装置。 - 【請求項５】請求項１〜４のいずれかに記載の車両用障
害物地図作成装置において、 前記ノイズ除去装置は、前記距離計測装置の位置と最大
検知距離の位置とに基づいて定められる探索領域に含ま
れる対象物の位置情報を検出して分類することを特徴と
する車両用障害物地図作成装置。 - 【請求項６】請求項５に記載の車両用障害物地図作成装
置において、 前記位置情報の探索領域の車両進行方向の幅を、前記車
両の速度と前記距離計測装置の計測周期とに基づいて変
化させることを特徴とする車両用障害物地図作成装置。 - 【請求項７】請求項５または６に記載の車両用障害物地
図作成装置において、 前記ノイズ除去装置は、前記分類された複数の対象物の
位置情報の中から、直線構造を有する対象物の位置情報
を検出することにより、さらに前記対象物の位置情報を
分類することを特徴とする車両用障害物地図作成装置。 - 【請求項８】請求項１〜７のいずれかに記載の車両用障
害物地図作成装置において、 前記障害物地図生成装置は、前記分類された位置情報に
基づいて対象物の存在する可能性に応じた複数の領域を
設定し、前記設定した領域ごとに制御・警報レベル情報
を含んだ障害物地図を生成することを特徴とする車両用
障害物地図作成装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001293638A JP3738719B2 (ja) | 2001-09-26 | 2001-09-26 | 車両用障害物地図作成装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001293638A JP3738719B2 (ja) | 2001-09-26 | 2001-09-26 | 車両用障害物地図作成装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2003098256A true JP2003098256A (ja) | 2003-04-03 |
| JP3738719B2 JP3738719B2 (ja) | 2006-01-25 |
Family
ID=19115389
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2001293638A Expired - Fee Related JP3738719B2 (ja) | 2001-09-26 | 2001-09-26 | 車両用障害物地図作成装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3738719B2 (ja) |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004362265A (ja) * | 2003-06-04 | 2004-12-24 | Honda Motor Co Ltd | 赤外線画像認識装置 |
| JP2009139228A (ja) * | 2007-12-06 | 2009-06-25 | Toyota Motor Corp | 物体検出装置 |
| JP2013158361A (ja) * | 2012-02-01 | 2013-08-19 | Canon Inc | 情報処理装置及び情報処理方法 |
| KR101734654B1 (ko) * | 2015-06-25 | 2017-05-11 | 현대자동차주식회사 | 레이저 스캐너를 이용한 센서 중심 좌표계의 점유 격자 지도를 작성하는 시스템 및 방법 |
| KR20180009934A (ko) * | 2016-07-20 | 2018-01-30 | 현대자동차주식회사 | 차량의 충돌 제어 장치 및 방법 |
| US10354150B2 (en) | 2015-10-22 | 2019-07-16 | Kabushiki Kaisha Toshiba | Apparatus, method and program for generating occupancy grid map |
| JP2019200049A (ja) * | 2018-05-14 | 2019-11-21 | 三菱電機株式会社 | 物体認識装置および物体認識方法 |
| CN111694287A (zh) * | 2020-05-14 | 2020-09-22 | 北京百度网讯科技有限公司 | 无人驾驶仿真场景中的障碍物模拟方法和装置 |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH05273341A (ja) * | 1992-03-30 | 1993-10-22 | Mazda Motor Corp | 障害物検出装置 |
| JPH06148328A (ja) * | 1992-11-06 | 1994-05-27 | Toyota Central Res & Dev Lab Inc | 車両用障害物認識装置 |
| JPH10112000A (ja) * | 1996-10-03 | 1998-04-28 | Suzuki Motor Corp | 障害物認識装置 |
| JP2000028713A (ja) * | 1998-07-08 | 2000-01-28 | Mitsubishi Motors Corp | 車両の後側方監視方法及び車両の後側方監視装置 |
| JP2000180537A (ja) * | 1998-12-15 | 2000-06-30 | Fujitsu Ten Ltd | スキャン式レーダの制御対象物体識別方法 |
| JP2000292538A (ja) * | 1999-04-07 | 2000-10-20 | Mitsubishi Electric Corp | 車両用障害物検出装置 |
| JP2001242242A (ja) * | 2000-02-29 | 2001-09-07 | Hitachi Ltd | 検知性能向上機能を備えたミリ波レーダ装置 |
-
2001
- 2001-09-26 JP JP2001293638A patent/JP3738719B2/ja not_active Expired - Fee Related
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH05273341A (ja) * | 1992-03-30 | 1993-10-22 | Mazda Motor Corp | 障害物検出装置 |
| JPH06148328A (ja) * | 1992-11-06 | 1994-05-27 | Toyota Central Res & Dev Lab Inc | 車両用障害物認識装置 |
| JPH10112000A (ja) * | 1996-10-03 | 1998-04-28 | Suzuki Motor Corp | 障害物認識装置 |
| JP2000028713A (ja) * | 1998-07-08 | 2000-01-28 | Mitsubishi Motors Corp | 車両の後側方監視方法及び車両の後側方監視装置 |
| JP2000180537A (ja) * | 1998-12-15 | 2000-06-30 | Fujitsu Ten Ltd | スキャン式レーダの制御対象物体識別方法 |
| JP2000292538A (ja) * | 1999-04-07 | 2000-10-20 | Mitsubishi Electric Corp | 車両用障害物検出装置 |
| JP2001242242A (ja) * | 2000-02-29 | 2001-09-07 | Hitachi Ltd | 検知性能向上機能を備えたミリ波レーダ装置 |
Cited By (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2004362265A (ja) * | 2003-06-04 | 2004-12-24 | Honda Motor Co Ltd | 赤外線画像認識装置 |
| JP2009139228A (ja) * | 2007-12-06 | 2009-06-25 | Toyota Motor Corp | 物体検出装置 |
| JP2013158361A (ja) * | 2012-02-01 | 2013-08-19 | Canon Inc | 情報処理装置及び情報処理方法 |
| KR101734654B1 (ko) * | 2015-06-25 | 2017-05-11 | 현대자동차주식회사 | 레이저 스캐너를 이용한 센서 중심 좌표계의 점유 격자 지도를 작성하는 시스템 및 방법 |
| US9827994B2 (en) | 2015-06-25 | 2017-11-28 | Hyundai Motor Company | System and method for writing occupancy grid map of sensor centered coordinate system using laser scanner |
| US10354150B2 (en) | 2015-10-22 | 2019-07-16 | Kabushiki Kaisha Toshiba | Apparatus, method and program for generating occupancy grid map |
| KR20180009934A (ko) * | 2016-07-20 | 2018-01-30 | 현대자동차주식회사 | 차량의 충돌 제어 장치 및 방법 |
| KR102441050B1 (ko) | 2016-07-20 | 2022-09-06 | 현대자동차주식회사 | 차량의 충돌 제어 장치 및 방법 |
| JP2019200049A (ja) * | 2018-05-14 | 2019-11-21 | 三菱電機株式会社 | 物体認識装置および物体認識方法 |
| CN111694287A (zh) * | 2020-05-14 | 2020-09-22 | 北京百度网讯科技有限公司 | 无人驾驶仿真场景中的障碍物模拟方法和装置 |
| CN111694287B (zh) * | 2020-05-14 | 2023-06-23 | 阿波罗智能技术(北京)有限公司 | 无人驾驶仿真场景中的障碍物模拟方法和装置 |
| US11840259B2 (en) | 2020-05-14 | 2023-12-12 | Apollo Intelligent Driving Technology (Beijing) Co., Ltd. | Method for simulating obstacle in unmanned simulation scene |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3738719B2 (ja) | 2006-01-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107490794B (zh) | 物体辨识处理装置、物体辨识处理方法及自动驾驶系统 | |
| US9092977B1 (en) | Leveraging of behavior of vehicles to detect likely presence of an emergency vehicle | |
| JP6714513B2 (ja) | 車両のナビゲーションモジュールに対象物の存在を知らせる車載装置 | |
| JP4906398B2 (ja) | 車載道路形状識別装置、車載システム、道路形状識別方法及び周辺監視方法 | |
| CN104554258B (zh) | 采用虚拟势场技术的避让转向操作的路径规划 | |
| JP5971341B2 (ja) | 物体検出装置及び運転支援装置 | |
| CN104554272B (zh) | 存在目标车辆和周围物体时的避让转向操作的路径规划 | |
| US20090076702A1 (en) | Method and Apparatus for Predicting a Movement Trajectory | |
| KR20190016332A (ko) | 딥 러닝 기반 자율 주행 차량, 딥 러닝 기반 자율 주행 제어 장치 및 딥 러닝 기반 자율 주행 제어 방법 | |
| WO2016189112A1 (en) | Collision avoidance method, computer program product for said collision avoidance method and collision avoidance system | |
| WO2013168246A1 (ja) | 運転支援装置 | |
| JP2002168953A (ja) | 車両周辺監視装置 | |
| JP2006031162A (ja) | 移動障害物検出装置 | |
| JP2009237898A (ja) | 画像認識装置 | |
| JP2019002769A (ja) | 物標判定装置及び運転支援システム | |
| JP2006160116A (ja) | 車両運動推定装置及び移動体検出装置 | |
| JP2003098256A (ja) | 車両用障害物地図作成装置 | |
| JP6263453B2 (ja) | 運動量推定装置及びプログラム | |
| CN109195849B (zh) | 摄像装置 | |
| KR20180006635A (ko) | 교차로 충돌 회피 시스템 및 그 제어 방법 | |
| JP5130959B2 (ja) | 車両周囲環境検出装置 | |
| US20050004719A1 (en) | Device and method for determining the position of objects in the surroundings of a motor vehicle | |
| KR102178992B1 (ko) | 차량 동작 계획방법 및 그를 위한 장치 | |
| KR20210108600A (ko) | 자율 주행 상황 인지 프로그램 성능 테스트 방법 및 동일 방법을 수행하기 위한 자율 주행 상황 인지 프로그램 성능 테스트 장치 | |
| JP2017122646A (ja) | 移動物体検出装置 |
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 |