JP3473378B2 - 駐車空間検出装置 - Google Patents
駐車空間検出装置Info
- Publication number
- JP3473378B2 JP3473378B2 JP05831098A JP5831098A JP3473378B2 JP 3473378 B2 JP3473378 B2 JP 3473378B2 JP 05831098 A JP05831098 A JP 05831098A JP 5831098 A JP5831098 A JP 5831098A JP 3473378 B2 JP3473378 B2 JP 3473378B2
- Authority
- JP
- Japan
- Prior art keywords
- obstacle
- parking space
- straight line
- vehicle
- approximate straight
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9314—Parking operations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
- G01S15/931—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2015/932—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations
- G01S2015/933—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations for measuring the dimensions of the parking space when driving past
- G01S2015/935—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations for measuring the dimensions of the parking space when driving past for measuring the contour, e.g. a trajectory of measurement points, representing the boundary of the parking space
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
- G01S15/931—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2015/932—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations
- G01S2015/933—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations for measuring the dimensions of the parking space when driving past
- G01S2015/936—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations for measuring the dimensions of the parking space when driving past for measuring parking spaces extending transverse or diagonal to the driving direction, i.e. not parallel to the driving direction
Landscapes
- Traffic Control Systems (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Description
【０００１】
【発明の属する技術分野】この発明は車両駐車に関して
車両間のスペースに駐車できるかどうかの判断に活用さ
れる駐車空間検出装置に関する。
車両間のスペースに駐車できるかどうかの判断に活用さ
れる駐車空間検出装置に関する。
【０００２】
【従来の技術】従来の駐車空間検出装置としては、たと
えば特開平６−１２７３１８号公報のようなものがあ
る。この駐車空間検出装置は車両の前後端に横向きに超
音波センサを設け、それぞれのセンサの指向角の中心を
互いに外広がり方向とすることにより各超音波センサの
距離測定値は駐車車両前端の真横で急変し、車両後端の
超音波センサの距離測定値は駐車車両後端の真横で急変
するから、これらの急変点を用いて駐車スペースの端部
を検出することにより駐車スペースの長さを正確に求め
ようとしていた。
えば特開平６−１２７３１８号公報のようなものがあ
る。この駐車空間検出装置は車両の前後端に横向きに超
音波センサを設け、それぞれのセンサの指向角の中心を
互いに外広がり方向とすることにより各超音波センサの
距離測定値は駐車車両前端の真横で急変し、車両後端の
超音波センサの距離測定値は駐車車両後端の真横で急変
するから、これらの急変点を用いて駐車スペースの端部
を検出することにより駐車スペースの長さを正確に求め
ようとしていた。
【０００３】
【発明が解決しようとする課題】しかしながら、このよ
うな従来の駐車空間検出装置にあっては、対象物までの
距離しか測定できない対物距離検出手段となっていたた
め、一般駐車場などの車両を斜めに整列して駐車させる
ような駐車場では駐車空間の長さを正確に求めることは
困難であるという問題点があった。この発明は、このよ
うな従来の問題点に着目してなされたもので、対象物ま
での距離および方向角を測距するセンサと自車の移動距
離およびヨー角の変化を検出する手段とを有し、それら
に基づいて対象の形状の一点の位置をセンサのサンプリ
ングタイム毎に計算して求め、さらにそれらの位置のデ
ータ点列から対象の形状を推定して駐車スペースの長さ
を求めることにより、従来の問題点を解決することを目
的としている。
うな従来の駐車空間検出装置にあっては、対象物までの
距離しか測定できない対物距離検出手段となっていたた
め、一般駐車場などの車両を斜めに整列して駐車させる
ような駐車場では駐車空間の長さを正確に求めることは
困難であるという問題点があった。この発明は、このよ
うな従来の問題点に着目してなされたもので、対象物ま
での距離および方向角を測距するセンサと自車の移動距
離およびヨー角の変化を検出する手段とを有し、それら
に基づいて対象の形状の一点の位置をセンサのサンプリ
ングタイム毎に計算して求め、さらにそれらの位置のデ
ータ点列から対象の形状を推定して駐車スペースの長さ
を求めることにより、従来の問題点を解決することを目
的としている。
【０００４】
【課題を解決するための手段】上述の目的を達成するた
め請求項１記載の発明は、自車両から障害物までの距離
および方向角を検出する対物距離検出手段と、自車両の
移動距離およびヨー角の変化を検出する自車移動量検出
手段と、前記対物距離検出手段で得られた自車両から障
害物までの距離および方向角と前記自車移動量検出手段
で得られた地面に固定した基準座標系での自車両の移動
量に基づいて、障害物の一点の地面に固定した基準座標
系での位置データを演算して求める演算手段と、障害物
の形状を直線近似で推定して複数の近似直線を得るとと
もに、前記複数の近似直線のうちの一つの近似直線であ
る近似直線１を構成する障害物の複数個の位置データを
前記近似直線１の方向を示す単位ベクトル上に正射影し
た長さを求め、それらの長さの最大値を計算する一方、
前記近似直線１を構成する障害物に隣接する障害物の形
状を表す近似直線２を構成する複数個の位置データを前
記近似直線２の方向を示す単位ベクトル上に正射影した
長さを求め、それらの長さの最小値を計算し、この最小
値から前記最大値を減じたものを駐車スペースの幅とす
る演算を行う手段と、を備えることを特徴とする。請求
項２記載の発明は、請求項１記載の駐車空間検出装置に
おいて、前記近似直線１を構成する障害物の複数個の位
置データを前記近似直線１の方向を示す単位ベクトル上
へ正射影した長さを求め、それらの長さの最大値から最
小値を減じたものを障害物の幅とすることを特徴とす
る。請求項３記載の発明は、請求項１または２記載の駐
車空間検出装置において、前記障害物の形状を推定する
手段にハフ（Ｈｏｕｇｈ）変換による直線検出の手法を
用いることを特徴とする。
め請求項１記載の発明は、自車両から障害物までの距離
および方向角を検出する対物距離検出手段と、自車両の
移動距離およびヨー角の変化を検出する自車移動量検出
手段と、前記対物距離検出手段で得られた自車両から障
害物までの距離および方向角と前記自車移動量検出手段
で得られた地面に固定した基準座標系での自車両の移動
量に基づいて、障害物の一点の地面に固定した基準座標
系での位置データを演算して求める演算手段と、障害物
の形状を直線近似で推定して複数の近似直線を得るとと
もに、前記複数の近似直線のうちの一つの近似直線であ
る近似直線１を構成する障害物の複数個の位置データを
前記近似直線１の方向を示す単位ベクトル上に正射影し
た長さを求め、それらの長さの最大値を計算する一方、
前記近似直線１を構成する障害物に隣接する障害物の形
状を表す近似直線２を構成する複数個の位置データを前
記近似直線２の方向を示す単位ベクトル上に正射影した
長さを求め、それらの長さの最小値を計算し、この最小
値から前記最大値を減じたものを駐車スペースの幅とす
る演算を行う手段と、を備えることを特徴とする。請求
項２記載の発明は、請求項１記載の駐車空間検出装置に
おいて、前記近似直線１を構成する障害物の複数個の位
置データを前記近似直線１の方向を示す単位ベクトル上
へ正射影した長さを求め、それらの長さの最大値から最
小値を減じたものを障害物の幅とすることを特徴とす
る。請求項３記載の発明は、請求項１または２記載の駐
車空間検出装置において、前記障害物の形状を推定する
手段にハフ（Ｈｏｕｇｈ）変換による直線検出の手法を
用いることを特徴とする。
【０００５】
【発明の実施の形態】以下、この発明の実施の形態を図
面に基づいて説明する。図１は、本発明の構成を示すブ
ロック図である。まず構成を説明すると、本発明の駐車
距離検出装置は、対象までの距離および方向角を測定す
る対物距離検出手段１と、自車両の移動距離およびヨー
角の変化を検出する自車移動量検出手段２と、前記対物
距離検出手段１および自車移動量検出手段２から得られ
たデータに基づいて対象の形状を推定し、駐車スペース
の長さを演算する演算手段３から構成される。
面に基づいて説明する。図１は、本発明の構成を示すブ
ロック図である。まず構成を説明すると、本発明の駐車
距離検出装置は、対象までの距離および方向角を測定す
る対物距離検出手段１と、自車両の移動距離およびヨー
角の変化を検出する自車移動量検出手段２と、前記対物
距離検出手段１および自車移動量検出手段２から得られ
たデータに基づいて対象の形状を推定し、駐車スペース
の長さを演算する演算手段３から構成される。
【０００６】
【発明の効果】以上説明してきたように、この発明によ
れば、その構成を、対象物までの距離及び方向角を測距
するセンサと自車の移動量を算出する手段を有し、それ
らに基づいて対象の形状の一点の位置をセンサのサンプ
リングタイム毎に計算して求め、さらに隣接する障害物
同士の間隔は、複数の近似直線のうちのある一つの近似
直線１に属する位置データの、当該近似直線１の単位ベ
クトル上に正射影した値の最大値と、近似直線１が示す
障害物に隣接する障害物形状を示す近似直線２に属する
位置データの、近似直線２の単位ベクトル上に正射影し
た値の最小値との差によって演算する構成としたので、
一般駐車場などで車両が斜めに整列して駐車してある場
合でも駐車空間の長さを正確に求めることができるとい
う効果が得られる。
れば、その構成を、対象物までの距離及び方向角を測距
するセンサと自車の移動量を算出する手段を有し、それ
らに基づいて対象の形状の一点の位置をセンサのサンプ
リングタイム毎に計算して求め、さらに隣接する障害物
同士の間隔は、複数の近似直線のうちのある一つの近似
直線１に属する位置データの、当該近似直線１の単位ベ
クトル上に正射影した値の最大値と、近似直線１が示す
障害物に隣接する障害物形状を示す近似直線２に属する
位置データの、近似直線２の単位ベクトル上に正射影し
た値の最小値との差によって演算する構成としたので、
一般駐車場などで車両が斜めに整列して駐車してある場
合でも駐車空間の長さを正確に求めることができるとい
う効果が得られる。
【０００７】次に図３のフローチャートにより、作用を
説明する。まずドライバからの入力操作によって駐車空
間の推定を開始する。図４に示すように、推定を開始し
た時点ｔ＝０における後車軸点Ｐの位置を地面に固定し
た基準座標系の原点０（０，０）とし、そのときの車両
の進行方向を基準座標系のｘ軸とする（ステップ１１０
〜１２０）。
説明する。まずドライバからの入力操作によって駐車空
間の推定を開始する。図４に示すように、推定を開始し
た時点ｔ＝０における後車軸点Ｐの位置を地面に固定し
た基準座標系の原点０（０，０）とし、そのときの車両
の進行方向を基準座標系のｘ軸とする（ステップ１１０
〜１２０）。
【０００８】サンプリング時刻ｔ＝ｉτ毎に右輪の右車
輪速センサ１４のパルスの増分値ΔＰr （ｉ）および左
輪の左車輪速センサ１５のパルスの増分値ΔＰl （ｉ）
を計測する（ステップ１３０〜１４０）。このとき時刻
ｔ＝ｉτにおける基準座標系に対する自車両の位置Ｐ
（ｉ）（ｘp （ｉ），ｙp （ｉ），θ（ｉ））は、 ｘp （ｉ）＝ｘp （ｉ−１）＋（Ｒr ΔＰr （ｉ）＋Ｒl ΔＰl （ｉ））ｃｏ ｓθ（ｉ）／２…（１） ｙp （ｉ）＝ｙp （ｉ−１）＋（Ｒr ΔＰr （ｉ）＋Ｒl ΔＰl （ｉ））ｓｉ ｎθ（ｉ）／２…（２） θ（ｉ）＝θ（ｉ−１）＋（Ｒr ΔＰr （ｉ）−Ｒl ΔＰl （ｉ））／Ｔ…（ ３） で与えられる。ここでＲr は右車輪速センサ１４の１パ
ルス分の移動距離、Ｒlは左車輪速センサ１５の１パル
ス分の移動距離、Ｔはトレッド幅である。
輪速センサ１４のパルスの増分値ΔＰr （ｉ）および左
輪の左車輪速センサ１５のパルスの増分値ΔＰl （ｉ）
を計測する（ステップ１３０〜１４０）。このとき時刻
ｔ＝ｉτにおける基準座標系に対する自車両の位置Ｐ
（ｉ）（ｘp （ｉ），ｙp （ｉ），θ（ｉ））は、 ｘp （ｉ）＝ｘp （ｉ−１）＋（Ｒr ΔＰr （ｉ）＋Ｒl ΔＰl （ｉ））ｃｏ ｓθ（ｉ）／２…（１） ｙp （ｉ）＝ｙp （ｉ−１）＋（Ｒr ΔＰr （ｉ）＋Ｒl ΔＰl （ｉ））ｓｉ ｎθ（ｉ）／２…（２） θ（ｉ）＝θ（ｉ−１）＋（Ｒr ΔＰr （ｉ）−Ｒl ΔＰl （ｉ））／Ｔ…（ ３） で与えられる。ここでＲr は右車輪速センサ１４の１パ
ルス分の移動距離、Ｒlは左車輪速センサ１５の１パル
ス分の移動距離、Ｔはトレッド幅である。
【０００９】センサの取付け位置Ｂ（ｘb （ｉ），ｙb
（ｉ））が後車軸点Ｐから（ａ，ｂ）の位置にあるとす
ると、センサの取付け位置Ｂ（ｘb （ｉ），ｙb
（ｉ））は 、 ｘb （ｉ）＝ｘp （ｉ）＋ａｃｏｓθ（ｉ）−ｂｓｉｎθ（ｉ）…（４） ｙb （ｉ）＝ｙp （ｉ）＋ａｃｏｓθ（ｉ）＋ｂｓｉｎθ（ｉ）…（５） となる。
（ｉ））が後車軸点Ｐから（ａ，ｂ）の位置にあるとす
ると、センサの取付け位置Ｂ（ｘb （ｉ），ｙb
（ｉ））は 、 ｘb （ｉ）＝ｘp （ｉ）＋ａｃｏｓθ（ｉ）−ｂｓｉｎθ（ｉ）…（４） ｙb （ｉ）＝ｙp （ｉ）＋ａｃｏｓθ（ｉ）＋ｂｓｉｎθ（ｉ）…（５） となる。
【００１０】そのときの超音波センサにより対象物まで
の距離ｌ（ｉ）および方向角Φ（ｉ）を計測する（ステ
ップ１５０）。このとき対象物の位置Ｓ（ｉ）（ｘs
（ｉ），ｙs （ｉ））は、 ｘs （ｉ）＝ｘb （ｉ）＋ｌｃｏｓ（θ（ｉ）＋Φ（ｉ））…（６） ｙs （ｉ）＝ｙb （ｉ）＋ｌｓｉｎ（θ（ｉ）＋Φ（ｉ））…（７） で計算される（ステップ１６０）。
の距離ｌ（ｉ）および方向角Φ（ｉ）を計測する（ステ
ップ１５０）。このとき対象物の位置Ｓ（ｉ）（ｘs
（ｉ），ｙs （ｉ））は、 ｘs （ｉ）＝ｘb （ｉ）＋ｌｃｏｓ（θ（ｉ）＋Φ（ｉ））…（６） ｙs （ｉ）＝ｙb （ｉ）＋ｌｓｉｎ（θ（ｉ）＋Φ（ｉ））…（７） で計算される（ステップ１６０）。
【００１１】サンプリング時刻ｔ＝ｉτ毎に（６）式お
よび（７）式を計算することによって図５に示すように
対象物の形状を推定するデータ列が得られる。このデー
タ列から対象の形状を推定するために以下のようにハフ
変換の手法を用いる。図６に示すような直線に座標原点
から下ろした垂線の長さρ，ｘ軸とのなす角度αを用い
ると、その直線は以下の（８）式によって表わされる。 ρ＝ｘｃｏｓα＋ｙｓｉｎα…（８） さて（８）式より対象の形状を推定するためのデータ列
（ｘs （ｉ），ｙs （ｉ））に対して決まる以下の
（９）式はρ，αに関する合成三角関数となりこの正弦
曲線（ハフ曲線）は点（ｘs （ｉ），ｙs （ｉ））を通
過するすべての直線群を表すことになる。 ρ＝ｘs （ｉ）ｃｏｓα＋ｙs （ｉ）ｓｉｎα…（９） したがって与えられたデータ点列（ｘs （ｉ），ｙs
（ｉ））に対して（９）式を計算し、その都度ρ−α平
面上にハフ曲線を描くとその度数分布が得られる。この
後、ハフ曲線群の交点の度数の高いところを抽出する
と、それらはデータ点列に含まれていた直線または直線
群に相当する（α，ρ）の組となる。実際に行なうステ
ップとしては対象物の位置Ｓ（ｉ）（ｘs （ｉ），ｙs
（ｉ））に対して、αを−１８０°〜１８０°まで刻み
幅Δα°で変化させ、各αに対して（９）式よりρを計
算する（ステップ１７０）。
よび（７）式を計算することによって図５に示すように
対象物の形状を推定するデータ列が得られる。このデー
タ列から対象の形状を推定するために以下のようにハフ
変換の手法を用いる。図６に示すような直線に座標原点
から下ろした垂線の長さρ，ｘ軸とのなす角度αを用い
ると、その直線は以下の（８）式によって表わされる。 ρ＝ｘｃｏｓα＋ｙｓｉｎα…（８） さて（８）式より対象の形状を推定するためのデータ列
（ｘs （ｉ），ｙs （ｉ））に対して決まる以下の
（９）式はρ，αに関する合成三角関数となりこの正弦
曲線（ハフ曲線）は点（ｘs （ｉ），ｙs （ｉ））を通
過するすべての直線群を表すことになる。 ρ＝ｘs （ｉ）ｃｏｓα＋ｙs （ｉ）ｓｉｎα…（９） したがって与えられたデータ点列（ｘs （ｉ），ｙs
（ｉ））に対して（９）式を計算し、その都度ρ−α平
面上にハフ曲線を描くとその度数分布が得られる。この
後、ハフ曲線群の交点の度数の高いところを抽出する
と、それらはデータ点列に含まれていた直線または直線
群に相当する（α，ρ）の組となる。実際に行なうステ
ップとしては対象物の位置Ｓ（ｉ）（ｘs （ｉ），ｙs
（ｉ））に対して、αを−１８０°〜１８０°まで刻み
幅Δα°で変化させ、各αに対して（９）式よりρを計
算する（ステップ１７０）。
【００１２】次に、求めたρと用意した（α，ρ）の２
次元配列（分解能はΔα，Δρ）の一致する要素に１を
加える（ステップ１８０）。
次元配列（分解能はΔα，Δρ）の一致する要素に１を
加える（ステップ１８０）。
【００１３】以上の１４０〜１８０のステップをサンプ
リングタイム毎にＮ回繰り返し（ステップ１９０〜２０
０）、（α，ρ）の２次元配列の要素で累積した度数が
極大値となるような要素を抽出し（ステップ２１０）、
図７に示すように得られた極大値の要素群Ｑｊ（αj ，
ρj ）（ｉ＝１，２，‥Ｍ、Ｍは得られた直線あるいは
線分の個数）を障害物の形状を表わす直線と推定する
（ステップ２２０）。
リングタイム毎にＮ回繰り返し（ステップ１９０〜２０
０）、（α，ρ）の２次元配列の要素で累積した度数が
極大値となるような要素を抽出し（ステップ２１０）、
図７に示すように得られた極大値の要素群Ｑｊ（αj ，
ρj ）（ｉ＝１，２，‥Ｍ、Ｍは得られた直線あるいは
線分の個数）を障害物の形状を表わす直線と推定する
（ステップ２２０）。
【００１４】次に得られた障害物の形状を表わす直線群
およびデータ点列Ｓ（ｉ）（ｘs （ｉ），ｙs （ｉ））
から障害物の幅および駐車空間の幅を推定する方法を図
８に基づいて説明する。各Ｑj （αj ，ρj ）（ｊ＝
１，２，‥Ｍ）について、Ｑj に属する対象の位置のデ
ータ点列Ｓ（ｉ）（ｉ＝Ｊ＋１〜Ｊ＋ｍ、ここでＪ＝ｍ
1 ＋ｍ2 ＋…ｍj- 1 ，ｍj は累積度数）について単位ベ
クトルＵj ＝（ｃｏｓ（αj −π／２），ｓｉｎ（αj
−π／２）への正射影の長さｈ（ｉ）（ｉ＝Ｊ＋１〜Ｊ
＋ｍj 、ここでＪ＝ｍ1 ＋ｍ2 ＋…ｍj-1 、ｍj は累積
度数）を求める（ステップ２３０）。求めたｈ（ｉ）の
中から最小値ｈj_min とｈj_max とを求め、対応する障
害物の位置の点をＳj_min とＳj_max とする（ステップ
２４０）。障害物の幅Ｗojは、 Ｗoj＝ｈj_max −ｈj_min …（１０） で与えられる（ステップ２５０）。
およびデータ点列Ｓ（ｉ）（ｘs （ｉ），ｙs （ｉ））
から障害物の幅および駐車空間の幅を推定する方法を図
８に基づいて説明する。各Ｑj （αj ，ρj ）（ｊ＝
１，２，‥Ｍ）について、Ｑj に属する対象の位置のデ
ータ点列Ｓ（ｉ）（ｉ＝Ｊ＋１〜Ｊ＋ｍ、ここでＪ＝ｍ
1 ＋ｍ2 ＋…ｍj- 1 ，ｍj は累積度数）について単位ベ
クトルＵj ＝（ｃｏｓ（αj −π／２），ｓｉｎ（αj
−π／２）への正射影の長さｈ（ｉ）（ｉ＝Ｊ＋１〜Ｊ
＋ｍj 、ここでＪ＝ｍ1 ＋ｍ2 ＋…ｍj-1 、ｍj は累積
度数）を求める（ステップ２３０）。求めたｈ（ｉ）の
中から最小値ｈj_min とｈj_max とを求め、対応する障
害物の位置の点をＳj_min とＳj_max とする（ステップ
２４０）。障害物の幅Ｗojは、 Ｗoj＝ｈj_max −ｈj_min …（１０） で与えられる（ステップ２５０）。
【００１５】駐車スペースの傾きの方向はαj （ｊ＝１
〜Ｍ）の中央値αmed から推定する（ステップ２６
０）。駐車スペースの幅Ｗpjについては、Ｑj に隣接す
るＱj+1に属する対象の位置のデータ点列Ｓ（ｉ）（ｉ
＝Ｊ＋ｍj ＋１〜ｊ＋ｍj ＋ｍj+ 1 、ｍj+1 は累積度
数）について上と同様に単位ベクトルＵj+1 ＝（ｃｏｓ
（αj+1 −π／２），ｓｉｎ（αj+1 −π／２））への
正射影の長さｈ（ｉ）（ｉ＝Ｊ＋ｍj ＋１〜ｊ＋ｍj ＋
ｍj+1 、ｍj+1 は累積度数）を求め、求めたｈ（ｉ）の
中から最小値ｈj+1_min と最大値ｈj+1_max を求め、対
応する障害物の位置の点をＳj+1_min とＳj+1_max とす
るとき、 Ｗpj＝ｈj+1_min −ｈj_max …（１１） で与えられる（ステップ２７０）。（１１）式で求めた
駐車スペースの幅Ｗpjが駐車可能なスペースのしきい値
Ｗth以上であれば駐車可能と判断し（ステップ２８０〜
２９０）、そうでなければ最初のステップ１１０に再度
駐車可能な空間を探索する。
〜Ｍ）の中央値αmed から推定する（ステップ２６
０）。駐車スペースの幅Ｗpjについては、Ｑj に隣接す
るＱj+1に属する対象の位置のデータ点列Ｓ（ｉ）（ｉ
＝Ｊ＋ｍj ＋１〜ｊ＋ｍj ＋ｍj+ 1 、ｍj+1 は累積度
数）について上と同様に単位ベクトルＵj+1 ＝（ｃｏｓ
（αj+1 −π／２），ｓｉｎ（αj+1 −π／２））への
正射影の長さｈ（ｉ）（ｉ＝Ｊ＋ｍj ＋１〜ｊ＋ｍj ＋
ｍj+1 、ｍj+1 は累積度数）を求め、求めたｈ（ｉ）の
中から最小値ｈj+1_min と最大値ｈj+1_max を求め、対
応する障害物の位置の点をＳj+1_min とＳj+1_max とす
るとき、 Ｗpj＝ｈj+1_min −ｈj_max …（１１） で与えられる（ステップ２７０）。（１１）式で求めた
駐車スペースの幅Ｗpjが駐車可能なスペースのしきい値
Ｗth以上であれば駐車可能と判断し（ステップ２８０〜
２９０）、そうでなければ最初のステップ１１０に再度
駐車可能な空間を探索する。
【００１６】
【発明の効果】以上説明してきたように、この発明によ
れば、その構成を、対象物までの距離および方向角を測
距するセンサと自車の移動量を算出する手段を有し、そ
れらに基づいて対象の形状の一点の位置をセンサのサン
プリングタイム毎に計算して求め、さらにそれらの位置
のデータ点列から対象の形状を推定して駐車スペースの
長さを演算する構成としたので、一般駐車場などで車両
が斜めに整列して駐車してある場合でも駐車空間の長さ
を正確に求めることができるという効果が得られる。
れば、その構成を、対象物までの距離および方向角を測
距するセンサと自車の移動量を算出する手段を有し、そ
れらに基づいて対象の形状の一点の位置をセンサのサン
プリングタイム毎に計算して求め、さらにそれらの位置
のデータ点列から対象の形状を推定して駐車スペースの
長さを演算する構成としたので、一般駐車場などで車両
が斜めに整列して駐車してある場合でも駐車空間の長さ
を正確に求めることができるという効果が得られる。
【図１】本発明の構成を示すブロック図である。
【図２】実施の形態を示すブロック図である。
【図３】実施の形態のアルゴリズムの流れを示すフロー
チャートである。
チャートである。
【図４】車両の位置を表わすための地上座標系の定義を
説明するための図である。
説明するための図である。
【図５】距離センサから得られた障害物の測距データ点
列を示した図である。
列を示した図である。
【図６】ハフ変換を説明するための図である。
【図７】障害物の測距データ点列にハフ変換を施すこと
により得られた（α，ρ）平面上の度数の極大点を示し
た図である。
により得られた（α，ρ）平面上の度数の極大点を示し
た図である。
【図８】障害物の形状を表わす直線群およびデータ点列
Ｓ（ｉ）（ｘs （ｉ），ｙs （ｉ））から障害物の幅お
よび駐車空間の幅を推定する方法を説明した図である。
Ｓ（ｉ）（ｘs （ｉ），ｙs （ｉ））から障害物の幅お
よび駐車空間の幅を推定する方法を説明した図である。
１ 対物距離検出手段
２ 自車移動量検出手段
３ 演算手段
１１ 超音波センサ送・受波子
１２ 超音波センサ受波子
１３ 超音波センサコントロールユニット
１４ 右車輪速センサ
１５ 左車輪速センサ
１６ 演算装置
Claims (3)
- 【請求項１】 自車両から障害物までの距離および方向
角を検出する対物距離検出手段と、自車両の移動距離お
よびヨー角の変化を検出する自車移動量検出手段と、前
記対物距離検出手段で得られた自車両から障害物までの
距離および方向角と前記自車移動量検出手段で得られた
地面に固定した基準座標系での自車両の移動量に基づい
て、障害物の一点の地面に固定した基準座標系での位置
データを演算して求める演算手段と、障害物の形状を直
線近似で推定して複数の近似直線を得るとともに、前記
複数の近似直線のうちの一つの近似直線である近似直線
１を構成する障害物の複数個の位置データを前記近似直
線１の方向を示す単位ベクトル上に正射影した長さを求
め、それらの長さの最大値を計算する一方、前記近似直
線１を構成する障害物に隣接する障害物の形状を表す近
似直線２を構成する複数個の位置データを前記近似直線
２の方向を示す単位ベクトル上に正射影した長さを求
め、それらの長さの最小値を計算し、この最小値から前
記最大値を減じたものを駐車スペースの幅とする演算を
行う手段と、を備えることを特徴とする駐車空間検出装
置。 - 【請求項２】 請求項１記載の駐車空間検出装置におい
て、前記近似直線１を構成する障害物の複数個の位置デ
ータを前記近似直線１の方向を示す単位ベクトル上へ正
射影した長さを求め、それらの長さの最大値から最小値
を減じたものを障害物の幅とすることを特徴とする駐車
空間検出装置。 - 【請求項３】 請求項１または２記載の駐車空間検出装
置において、前記障害物の形状を推定する手段にハフ
（Ｈｏｕｇｈ）変換による直線検出の手法を用いること
を特徴とする駐車空間検出装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP05831098A JP3473378B2 (ja) | 1998-03-10 | 1998-03-10 | 駐車空間検出装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP05831098A JP3473378B2 (ja) | 1998-03-10 | 1998-03-10 | 駐車空間検出装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH11255052A JPH11255052A (ja) | 1999-09-21 |
| JP3473378B2 true JP3473378B2 (ja) | 2003-12-02 |
Family
ID=13080680
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP05831098A Expired - Fee Related JP3473378B2 (ja) | 1998-03-10 | 1998-03-10 | 駐車空間検出装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3473378B2 (ja) |
Families Citing this family (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002240661A (ja) * | 2001-02-19 | 2002-08-28 | Nissan Motor Co Ltd | 駐車支援装置 |
| JP4686934B2 (ja) * | 2001-08-14 | 2011-05-25 | 日産自動車株式会社 | 車両駐車装置 |
| JP3991731B2 (ja) * | 2002-03-14 | 2007-10-17 | 日産自動車株式会社 | 車両用駐車方向設定装置 |
| JP4016980B2 (ja) * | 2004-10-25 | 2007-12-05 | 株式会社豊田自動織機 | 省スペース型の駐車支援装置 |
| JP4179285B2 (ja) * | 2005-01-12 | 2008-11-12 | トヨタ自動車株式会社 | 駐車支援装置 |
| JP2006343309A (ja) * | 2005-05-09 | 2006-12-21 | Nippon Soken Inc | 障害物検出装置 |
| JP2010217193A (ja) * | 2005-05-09 | 2010-09-30 | Nippon Soken Inc | 障害物検出装置 |
| DE102005045260A1 (de) * | 2005-09-22 | 2007-03-29 | Valeo Schalter Und Sensoren Gmbh | Verfahren zur Vermessung von Parklücken |
| JP4645542B2 (ja) * | 2006-07-11 | 2011-03-09 | トヨタ自動車株式会社 | 駐車空間検出装置 |
| JP5257138B2 (ja) * | 2009-02-26 | 2013-08-07 | 日産自動車株式会社 | 駐車支援装置及び駐車支援方法 |
| DE102009040375A1 (de) * | 2009-09-07 | 2011-04-07 | Valeo Schalter Und Sensoren Gmbh | Verfahren und Vorrichtung zur Unterstützung eines Einparkvorgangs eines Fahrzeugs |
| KR20130128894A (ko) * | 2012-05-18 | 2013-11-27 | 현대모비스 주식회사 | 주차 제어 시스템 및 그 방법 |
| KR20130136078A (ko) * | 2012-06-04 | 2013-12-12 | 현대모비스 주식회사 | 자동 주차 제어 장치 및 방법 |
| JP7034271B2 (ja) * | 2018-05-07 | 2022-03-11 | 三菱電機株式会社 | 駐車支援装置 |
| WO2020110229A1 (ja) * | 2018-11-28 | 2020-06-04 | 三菱電機株式会社 | 運転支援装置 |
| CN110853399A (zh) * | 2019-10-12 | 2020-02-28 | 惠州市德赛西威智能交通技术研究院有限公司 | 一种基于超声波传感器车位检测***的车位识别补偿方法 |
| CN111310663A (zh) * | 2020-02-17 | 2020-06-19 | 北京三快在线科技有限公司 | 道路栅栏检测方法、装置、设备及存储介质 |
| JP2023032737A (ja) * | 2021-08-27 | 2023-03-09 | 株式会社デンソー | 物体検知装置および物体検知プログラム |
| CN114572223A (zh) * | 2022-02-25 | 2022-06-03 | 智己汽车科技有限公司 | 一种超声波雷达障碍物车位感知***和方法 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06187597A (ja) * | 1992-12-16 | 1994-07-08 | Toyota Motor Corp | 駐車補助装置 |
| JP2799375B2 (ja) * | 1993-09-30 | 1998-09-17 | 本田技研工業株式会社 | 衝突防止装置 |
| JP3961584B2 (ja) * | 1996-02-08 | 2007-08-22 | 株式会社デンソー | 区画線検出装置 |
| JP3600378B2 (ja) * | 1996-07-24 | 2004-12-15 | 本田技研工業株式会社 | 車両の外界認識装置 |
-
1998
- 1998-03-10 JP JP05831098A patent/JP3473378B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH11255052A (ja) | 1999-09-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3473378B2 (ja) | 駐車空間検出装置 | |
| CN105270410B (zh) | 用于自主驾驶车辆的路径规划的精确曲率估计算法 | |
| WO2020168769A1 (zh) | 垂直泊车方法 | |
| CN107000745B (zh) | 车辆的行驶控制装置以及行驶控制方法 | |
| US10267640B2 (en) | Vehicle position estimation device, vehicle position estimation method | |
| US10776634B2 (en) | Method for determining the course of the road for a motor vehicle | |
| US7388475B2 (en) | Lane departure warning and avoidance system with warning modification criteria | |
| WO2018181974A1 (ja) | 判定装置、判定方法、及び、プログラム | |
| US11300415B2 (en) | Host vehicle position estimation device | |
| US20090121899A1 (en) | Parking assistance device | |
| US10289120B2 (en) | Self-position estimation device and self-position estimation method | |
| CN102208012A (zh) | 风景匹配参考数据生成***及位置测量*** | |
| WO2006090736A1 (ja) | 物体認識装置 | |
| JP6020729B2 (ja) | 車両位置姿勢角推定装置及び車両位置姿勢角推定方法 | |
| JP6593088B2 (ja) | 車両位置推定装置及びプログラム | |
| JP4406608B2 (ja) | 車両の駐車過程用の幾何学的形状データを検出するための方法 | |
| JP2018105636A (ja) | 経路生成装置 | |
| WO2017109978A1 (ja) | 距離推定装置、距離推定方法及びプログラム | |
| JP2011034435A (ja) | 車両位置演算装置及び車両位置演算方法 | |
| JP7319940B2 (ja) | タイヤ摩耗推定方法、及び、タイヤ摩耗形状判別方法 | |
| JP6747157B2 (ja) | 自己位置推定方法及び自己位置推定装置 | |
| WO2017109973A1 (ja) | 距離推定装置、距離推定方法及びプログラム | |
| JP2018036075A (ja) | 自車位置特定装置、自車位置特定方法 | |
| JPH07198349A (ja) | 道路形状及び自車両姿勢の計測装置 | |
| JP3484020B2 (ja) | 車両の横滑り角計測方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080919 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090919 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100919 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100919 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110919 Year of fee payment: 8 |
|
| LAPS | Cancellation because of no payment of annual fees |