JP2002228734A - Peripheral object confirming device - Google Patents

Peripheral object confirming device

Info

Publication number
JP2002228734A
JP2002228734A JP2001027960A JP2001027960A JP2002228734A JP 2002228734 A JP2002228734 A JP 2002228734A JP 2001027960 A JP2001027960 A JP 2001027960A JP 2001027960 A JP2001027960 A JP 2001027960A JP 2002228734 A JP2002228734 A JP 2002228734A
Authority
JP
Japan
Prior art keywords
vehicle
line segment
unit
traveling
reference direction
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.)
Withdrawn
Application number
JP2001027960A
Other languages
Japanese (ja)
Inventor
Hiroshi Sato
宏 佐藤
Yoshihiro Sato
好宏 佐藤
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 JP2001027960A priority Critical patent/JP2002228734A/en
Publication of JP2002228734A publication Critical patent/JP2002228734A/en
Withdrawn legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems 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/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9314Parking operations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/932Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations
    • G01S2015/933Sonar 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/935Sonar 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/932Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations
    • G01S2015/933Sonar 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/936Sonar 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

  • Position Fixing By Use Of Radio Waves (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

PROBLEM TO BE SOLVED: To enable the accurate driving operation by accurately detecting position of an object existing in the periphery of the own-vehicle, and displaying a map to a driver when parking. SOLUTION: Distance and direction to the object existing in the periphery of the own-vehicle obtained by a distance measuring device 4 such as a laser radar is stored in a distance data memory unit 5 in order as a data point sequence with position of the own-vehicle obtained by an own-vehicle position detecting device 1. An object position judging unit 8 judges the positional condition of the peripheral object on the basis of a residual line segment, which is obtained by eliminating a line segment out of the nearly horizontal or nearly vertical angle relation in relation to the reference direction obtained by a reference direction computing unit 3 when the own-vehicle straightly travels, from the line segment, which is obtained by computing a linear approximation in a linear approximation unit 6 on the basis of the data point sequence, in a noise eliminating unit 7. Arrangement of the peripheral object is displayed in a display unit 10 by a map generating unit 9.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、車庫や駐車場など
において、自車両の周囲にある物体の位置状況を運転者
に分かりやすく表示することで、運転者が周囲状況を容
易に把握して的確な運転操作を行うことができるように
した周囲物体認識装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a method for displaying the position of an object around a host vehicle in a garage or a parking lot in a manner that is easy for the driver to understand. The present invention relates to a surrounding object recognition device capable of performing an accurate driving operation.

【0002】[0002]

【従来の技術】このような周囲物体認識装置としては、
特開平7−248382号公報に記載のものがある。こ
の公報に記載された周囲物体認識装置は、レーザレーダ
等の測距装置により自車両から物体までの相対距離を測
定して得た距離データを、この測距時における自車両の
位置データと対応させたデータ点列として蓄積し、この
データ点列を直線近似あるいは曲線近似して物体の位置
状態を表示するようにしている。
2. Description of the Related Art Such a surrounding object recognition device includes:
There is one described in JP-A-7-248382. The peripheral object recognition device described in this publication uses the distance data obtained by measuring the relative distance from the host vehicle to the object with a distance measuring device such as a laser radar to correspond to the position data of the host vehicle at the time of the distance measurement. The data point sequence is accumulated as a sequence of data points, and the data point sequence is approximated by a straight line or a curve to display the position state of the object.

【0003】[0003]

【発明が解決しようとする課題】上記従来の周囲物体認
識装置では、レーザレーダ等により物体までの距離や方
位を測定するが、他のレーダからの回り込んでくるレー
ザ信号を拾ったり、路面の凹凸で車体とともにレーダの
向きが変化したりすることなどにより、上記測距データ
点列中にエラーが含まれることは避けられない。
In the above-mentioned conventional peripheral object recognition apparatus, the distance and direction to the object are measured by a laser radar or the like. However, a laser signal coming from another radar is picked up or a road surface is detected. It is inevitable that an error is included in the distance measurement data point sequence due to a change in the direction of the radar together with the vehicle body due to unevenness.

【0004】例えば、図8に示すような、壁13にそっ
て3台の他車両14、15、16が駐車し、他車両14
と他車両15の間にスペースがある駐車場に、壁13と
平行に進入しながら取得したデータ点列を図示すると、
たとえば図9のようになる。図9において、点列14A
は他車両14の外周部分、点列15Aは他車両15の外
周部分、点列16Aは他車両16の外周部分、データ点
列のプロット13Aは他車両14と15とのスペース間
に見える壁13の部分にそれぞれ対応している。同図か
ら分かるように、データ中にはエラーでノイズとなるデ
ータ点(分かりやすくするため、図中、ノイズ分は太い
ドットで表してある)が混入している。
For example, as shown in FIG. 8, three other vehicles 14, 15, 16 are parked along a wall 13, and the other vehicles 14, 15, 16 are parked.
When the data point sequence acquired while entering the parking lot with a space between the other vehicle 15 and the wall 13 in parallel is illustrated,
For example, as shown in FIG. In FIG. 9, the dot sequence 14A
Is the outer peripheral portion of the other vehicle 14, the dot sequence 15A is the outer peripheral portion of the other vehicle 15, the dot sequence 16A is the outer peripheral portion of the other vehicle 16, and the plot 13A of the data point sequence is the wall 13 seen between the spaces between the other vehicles 14 and 15. Corresponds to each part. As can be seen from the figure, data points that become noise due to errors (for the sake of simplicity, noise is represented by thick dots in the figure) are mixed in the data.

【0005】したがって、このデータ点列をそのまま物
体の位置状況を表すものとして直線近似して周囲物体の
配置状況地図を作製すると、図10に示すように、図8
に示される実際の周囲物体の位置とはかなりのずれが生
じることになる。なお図10中、線分13Bは壁13、
線分14Bは他車両14、線分15Bは他車両15、線
分16Bは他車両16Bのそれぞれ外周部分に対応す
る。このように、従来の装置ではデータ中にエラーが混
入するとノイズとなって周囲物体の位置の認識精度が悪
化してしまう場合がある。
[0005] Therefore, when this data point sequence is directly represented as a straight line to represent the position status of the object, and a map of the arrangement status of the surrounding objects is created, as shown in FIG.
The actual position of the surrounding object shown in FIG. In FIG. 10, the line segment 13B is the wall 13,
The line segment 14B corresponds to the other vehicle 14, the line segment 15B corresponds to the other vehicle 15, and the line segment 16B corresponds to the outer peripheral portion of the other vehicle 16B. As described above, in the conventional apparatus, if an error is mixed in the data, the error becomes noise and the recognition accuracy of the position of the surrounding object may deteriorate.

【0006】したがって本発明は、測距データ中にエラ
ーがあっても、それによるノイズの影響を排除して、正
確に周囲物体の位置を認識できるようにした周囲物体認
識装置を提供することを目的とする。
Accordingly, the present invention provides a surrounding object recognizing apparatus capable of accurately recognizing the position of a surrounding object by eliminating the influence of noise caused by an error in the distance measurement data. Aim.

【0007】[0007]

【課題を解決するための手段】請求項1に記載の本発明
は、自車両の位置を検出する自車両位置検出装置と、自
車両の位置の推移に基づく自車両の所定の進行方向を基
準方向として設定する基準方向設定手段と、自車両に設
置されて、自車両の周囲に存在する物体までの距離及び
方位を測定可能な測距装置と、該測距装置により検出さ
れた物体までの距離及び方位と該物体検出時点に自車両
位置検出装置により検出された自車両の位置との組をデ
ータ点列として記憶する距離データ蓄積部と、該距離デ
ータ蓄積部に蓄積されたデータ点列から物体に対応する
線分を抽出する線分抽出手段と、該線分抽出手段により
抽出された線分の中から基準方向設定手段により得られ
た基準方向に対して所定の角度関係を満たす線分のみを
抽出するノイズ除去部と、該ノイズ除去部で抽出された
線分をもとに車両周囲に存在する物体の位置を判断する
物体位置判断部とを有するものとした。
According to a first aspect of the present invention, there is provided an own-vehicle position detecting device for detecting a position of an own-vehicle, and a predetermined traveling direction of the own vehicle based on a change in the position of the own vehicle. A reference direction setting means for setting the direction, a distance measuring device installed in the own vehicle and capable of measuring a distance and an azimuth to an object existing around the own vehicle, and a distance measuring device to the object detected by the distance measuring device. A distance data storage unit that stores a set of a distance and an azimuth and the position of the host vehicle detected by the host vehicle position detection device at the time of detecting the object as a data point sequence, and a data point sequence stored in the distance data storage unit A line segment extracting means for extracting a line segment corresponding to an object from a line, and a line satisfying a predetermined angle relationship with respect to a reference direction obtained by a reference direction setting means from among the line segments extracted by the line segment extracting means. Noise removal to extract only minutes And parts, and to have the object position determination unit for determining the position of an object existing around the vehicle based on the line segment extracted by the noise removing unit.

【0008】請求項2の発明は、基準方向設定手段が、
自車両の直進走行時を判別する直進走行判断部と、該直
進走行判断部が直進走行と判断したときの自車両の進行
方向を基準方向として出力する基準方向算出部とからな
るものとした。
According to a second aspect of the present invention, the reference direction setting means includes:
The vehicle includes a straight traveling determination unit that determines when the vehicle is traveling straight, and a reference direction calculation unit that outputs the traveling direction of the own vehicle when the straight traveling determination unit determines that the vehicle is traveling straight as a reference direction.

【0009】請求項3の発明は、自車両位置検出装置が
自車両の位置として走行距離と進行方向を検出し、直進
走行判断部は、走行距離と進行方向から走行軌跡を求
め、該走行軌跡が直線であるとき直進走行時であると判
断するものとしたものである。
According to a third aspect of the present invention, the own vehicle position detecting device detects a traveling distance and a traveling direction as a position of the own vehicle, and a straight traveling judging section obtains a traveling locus from the traveling distance and the traveling direction. Is a straight line, it is determined that the vehicle is traveling straight.

【0010】請求項4の発明は、線分抽出手段がデータ
点列から物体に対応する線分を直線として抽出するよう
にしたものである。
According to a fourth aspect of the present invention, the line segment extracting means extracts a line segment corresponding to the object from the data point sequence as a straight line.

【0011】請求項5の発明は、所定の角度関係が、基
準方向に対して略平行あるいは略垂直となる関係である
こととしたものである。また、請求項6の発明は、所定
の角度関係が、線分抽出手段により抽出された線分のう
ち最大長さを有する線分が基準方向に対してなす角度を
基準角度とし、該基準角度に対して略平行あるいは略垂
直となる関係であることとしたものである。
According to a fifth aspect of the present invention, the predetermined angular relationship is a relationship that is substantially parallel or substantially perpendicular to the reference direction. The invention according to claim 6, wherein the predetermined angle relationship is such that the angle formed by the line segment having the maximum length among the line segments extracted by the line segment extraction means with respect to the reference direction is a reference angle, Is substantially parallel or substantially perpendicular to.

【0012】さらに、請求項7の発明は、所定の角度関
係が、線分抽出手段により抽出された線分のうち基準方
向に対してなす角度が略等しいものの数が最大となる線
分の角度を基準角度とし、該基準角度に対して略平行あ
るいは略垂直となる関係であることとしたものである。
Further, according to a seventh aspect of the present invention, the predetermined angular relationship is such that the number of the line segments extracted by the line segment extracting means which have substantially the same angle with respect to the reference direction is the largest. Is a reference angle, and the relationship is substantially parallel or substantially perpendicular to the reference angle.

【0013】請求項8の発明は、物体位置判断部により
得られた車両周囲に存在する物体の位置を表す地図を作
成する地図生成部を有するものとした。また、請求項9
の発明は、さらに上記地図生成部で作成した地図を表示
する表示部を有しているものである。
The invention according to claim 8 is provided with a map generation unit for creating a map representing the position of an object existing around the vehicle obtained by the object position determination unit. Claim 9
The invention further has a display unit for displaying the map created by the map generation unit.

【0014】[0014]

【発明の効果】請求項1の発明は、測距装置で周囲物体
までの距離及び方位のデータを、自車両位置検出装置で
得た自車位置のデータとともに組として逐次蓄積したデ
ータ点列から線分抽出手段により線分を抽出する一方、
直進走行判断部が直進走行と判断したときの進行方向を
基準方向として、ノイズ除去部が線分抽出手段により抽
出した線分から基準方向に所定角度の関係にあるもの以
外を排除するので、周囲物体の位置状況を精度よく判断
することができる。
According to the first aspect of the present invention, the distance measuring device and the distance and azimuth data to the surrounding object are sequentially collected from the data point sequence as a set together with the own vehicle position data obtained by the own vehicle position detecting device. While extracting the line segment by the line segment extraction means,
With the traveling direction when the straight traveling determination unit determines that the vehicle is traveling straight as the reference direction, the noise elimination unit excludes from the line segments extracted by the line segment extraction unit those other than those having a predetermined angle relationship with the reference direction. Can be accurately determined.

【0015】請求項2の発明は、直進走行判断部が直進
走行と判断したときの自車両の進行方向を基準方向とす
るので、例えば駐車場に駐車している他車両の列にそっ
て走行している状態を表すことができ、ノイズエラーの
識別が容易となる。
According to the second aspect of the present invention, since the traveling direction of the own vehicle when the straight traveling judgment unit judges that the vehicle is traveling straight is set as the reference direction, the vehicle travels along a line of other vehicles parked in a parking lot, for example. This makes it possible to represent the noise state, and the noise error can be easily identified.

【0016】請求項3の発明は、直進走行判断部が走行
距離と進行方向から求めた走行軌跡が直線であるときを
直進走行時と判断するので、直進走行の判断が容易であ
る。
According to the third aspect of the present invention, since the straight traveling judgment unit judges that the traveling locus obtained from the traveling distance and the traveling direction is a straight line, it is the time of straight traveling, it is easy to determine the straight traveling.

【0017】請求項4の発明は、線分抽出手段がデータ
点列から物体に対応する線分を単純な直線として抽出す
るようにしたので、抽出処理が簡単で処理負荷が少なく
て済むとともに、駐車場に並んでいる車両の輪郭に精度
を落とすことなく対応させることができる。
According to a fourth aspect of the present invention, since the line segment extracting means extracts a line segment corresponding to the object from the data point sequence as a simple straight line, the extraction process is simple and the processing load is small. It is possible to correspond to the contours of the vehicles lined up in the parking lot without lowering the accuracy.

【0018】請求項5の発明は、所定の角度関係を基準
方向に対して略平行あるいは略垂直としたので、これに
該当しない線分を排除することにより、他車両が自車両
の直進方向に対して垂直方向に向けて駐車している駐車
場などで精度よく周囲物体の位置状況を認識できる。
According to the fifth aspect of the present invention, since the predetermined angle relationship is substantially parallel or substantially perpendicular to the reference direction, by eliminating a line segment which does not correspond to this, the other vehicle can move in the straight traveling direction of the own vehicle. On the other hand, it is possible to accurately recognize the position of a surrounding object in a parking lot or the like that is parked vertically.

【0019】また、請求項6の発明は、抽出された線分
のうち最大長さを有する線分が基準方向に対してなす角
度を基準角度として、所定の角度関係を基準角度に対し
て略平行あるいは略垂直としたので、他車両が自車両の
直進方向に対して斜め方向に向けて駐車している駐車場
などでも精度よく周囲物体の位置状況を認識できる。
Further, according to the present invention, the angle formed by the line segment having the maximum length among the extracted line segments with respect to the reference direction is set as the reference angle, and the predetermined angular relationship is substantially equal to the reference angle. Since the vehicle is parallel or substantially vertical, it is possible to accurately recognize the position of a surrounding object even in a parking lot where another vehicle is parked in an oblique direction with respect to the straight traveling direction of the own vehicle.

【0020】さらに、請求項7の発明は、抽出された線
分のうち基準方向に対してなす角度が略等しいものの数
が最大となる線分の角度を基準角度とし、所定の角度関
係を基準角度に対して略平行あるいは略垂直としたの
で、これによっても他車両が自車両の直進方向に対して
斜め方向に向けて駐車している駐車場などで精度よく周
囲物体の位置状況を認識することができる。
Further, according to a seventh aspect of the present invention, an angle of a line segment having the largest number of the extracted line segments having substantially the same angle with respect to the reference direction is set as a reference angle, and a predetermined angle relationship is set as a reference angle. Since it is substantially parallel or substantially perpendicular to the angle, the position of surrounding objects can be accurately recognized even in a parking lot where another vehicle is parked in an oblique direction with respect to the straight traveling direction of the own vehicle. be able to.

【0021】請求項8の発明は、地図生成部で車両周囲
に存在する物体の位置を表す地図を作成するので、当該
地図に基づいて例えば自車両の駐車位置を設定し、自動
的な車両制御に用いることができる。また請求項9の発
明は、さらに車両周囲に存在する物体の位置を表す地図
を表示部に表示するものとしたので、運転者は周囲物体
の位置状況を視覚的に容易に把握することができる。
According to the eighth aspect of the present invention, a map representing the position of an object existing around the vehicle is created by the map generation unit. For example, a parking position of the own vehicle is set based on the map, and automatic vehicle control is performed. Can be used. According to the ninth aspect of the present invention, a map representing the position of an object existing around the vehicle is displayed on the display unit, so that the driver can easily grasp the position of the surrounding object easily. .

【0022】[0022]

【発明の実施の形態】以下、本発明の実施の形態を実施
例により説明する。図1は、第1の実施例による周囲物
体認識装置の構成を示す。周囲物体認識装置は、自車両
の状況を把握するため、自車両の位置を逐次検出する自
車両位置検出装置1と、この自車両位置検出装置1から
の検出信号を元に自車両が直進走行しているか否かを判
断する直進走行判断部2と、直進走行判断部2が直進走
行であると判断したときの自車両の進行方向を算出する
基準方向算出部3を有する。
Embodiments of the present invention will be described below with reference to examples. FIG. 1 shows the configuration of the surrounding object recognition device according to the first embodiment. The surrounding object recognition device includes an own vehicle position detecting device 1 that sequentially detects the position of the own vehicle in order to grasp the situation of the own vehicle, and the own vehicle travels straight based on a detection signal from the own vehicle position detecting device 1. The vehicle includes a straight traveling determination unit 2 that determines whether or not the vehicle is running, and a reference direction calculation unit 3 that calculates the traveling direction of the own vehicle when the straight traveling determination unit 2 determines that the vehicle is traveling straight.

【0023】周囲物体認識装置はさらに、周囲物体まで
の距離及び物体の方位を検出する測距装置4と、自車両
位置検出装置1で検出した自車両位置とともに測距装置
4が検出した物体までの距離及び物体の方位を、データ
点列として記憶する距離データ蓄積部5と、距離データ
蓄積部5に蓄積したデータ点列を直線近似して線分とす
る直線近似部6と、直線近似部6で得た線分のうち基準
方向算出部3で得た自車両の進行方向に基づきノイズと
なる線分を除去するノイズ除去部7と、ノイズ除去部7
で上記ノイズ分を除いた線分に基づいて物体の位置を判
断する物体位置判断部8と、物体位置判断部8で確定さ
れた配置状況を地図として生成する地図生成部9と、地
図生成部9で生成した物体の配置地図を運転者へ表示す
る表示装置10とを有する。
The surrounding object recognizing device further includes a distance measuring device 4 for detecting a distance to the surrounding object and an azimuth of the object, and an object detected by the distance measuring device 4 together with the own vehicle position detected by the own vehicle position detecting device 1. Distance data storage unit 5 for storing the distance of the object and the azimuth of the object as a data point sequence, a linear approximation unit 6 for linearly approximating the data point sequence stored in the distance data storage unit 5 as a line segment, and a linear approximation unit 6, a noise removing unit 7 for removing a line segment that becomes a noise based on the traveling direction of the own vehicle obtained by the reference direction calculating unit 3 from the line segments obtained by the reference direction calculating unit 3;
An object position determining unit 8 that determines the position of the object based on the line segment excluding the noise component, a map generating unit 9 that generates the arrangement status determined by the object position determining unit 8 as a map, and a map generating unit And a display device 10 for displaying the layout map of the objects generated in 9 to the driver.

【0024】上記自車両位置検出装置1としては、たと
えば、左右の後車輪に各々設けた車輪速センサ、ステア
リング装置に設けた舵角センサからそれぞれ検出された
検出信号をもとに、アッカーマン式操舵機構における関
係を適用して自車両の走行距離及び進行方向を推定する
デッドレコニングの手法を用いる。なお、駐車時は車両
速度が低いので、上記アッカーマンの関係を適用しても
誤差は少ない。
The self-vehicle position detecting device 1 includes, for example, Ackerman-type steering based on detection signals detected from a wheel speed sensor provided on each of left and right rear wheels and a steering angle sensor provided on a steering device. A dead reckoning method for estimating the traveling distance and traveling direction of the host vehicle by applying the relationship in the mechanism is used. In addition, since the vehicle speed is low at the time of parking, the error is small even if the above-mentioned Ackerman relation is applied.

【0025】直進走行判断部2は、自車両位置検出装置
1で検出した自車両位置信号から実質的に直進走行であ
るか否かを判別する。すなわち、上記走行距離と進行方
向とから自車両の走行軌跡を算出し、走行軌跡が略直線
であるとき、直進走行であると判断する。
The straight traveling judgment section 2 judges whether or not the vehicle is substantially traveling straight based on the own vehicle position signal detected by the own vehicle position detecting device 1. That is, the traveling locus of the host vehicle is calculated from the traveling distance and the traveling direction, and when the traveling locus is substantially straight, it is determined that the vehicle is traveling straight.

【0026】上記基準方向算出部3は、直進走行判断部
2が略直進走行であると判断したときには、その直進走
行の進行方向を基準方向として後述のノイズ除去部7へ
出力するように構成してある。このときの進行方向、す
なわち基準方向は、測距装置4で検出したデータ等に基
づき物体の配置状況を表す線分のうちノイズ分を排除す
るために利用する。直進走行判断部2と基準方向算出部
3とで発明の基準方向設定手段を構成している。
The reference direction calculation section 3 is configured to output the traveling direction of the straight traveling to the noise removing section 7 as a reference direction when the straight traveling determining section 2 determines that the vehicle is traveling substantially straight. It is. The traveling direction at this time, that is, the reference direction, is used to eliminate noise components from the line segments indicating the arrangement state of the object based on the data detected by the distance measuring device 4 and the like. The straight traveling judgment unit 2 and the reference direction calculation unit 3 constitute a reference direction setting means of the present invention.

【0027】上記測距装置4としては、先の図8に示す
ように自車両100の車体の後部両側端に設置したレー
ザレーダ11a、11bを用いる。これらのビーム12
a、12bは、それぞれ車両の幅方向外側へ向くように
してある。レーザレーダ11a、11bは、これらから
発射したレーザビーム12a、12bが物体に当たって
帰ってくる反射波を捕らえ、この間の時間を計測するこ
とで物体との距離を検出する。各レーザレーダ11a、
11bは、対象物体の方向が特定しやすいように、ビー
ム12a、12bの指向性を強く、また検知角度を狭く
設定し、その方向を固定してある。
As the distance measuring device 4, laser radars 11 a and 11 b installed at both rear ends of the body of the vehicle 100 as shown in FIG. 8 are used. These beams 12
Each of a and 12b is directed outward in the width direction of the vehicle. The laser radars 11a and 11b capture the reflected waves that return when the laser beams 12a and 12b emitted from the laser beams hit the object, and measure the time between them to detect the distance to the object. Each laser radar 11a,
In 11b, the directionality of the beams 12a and 12b is set strong, the detection angle is set narrow, and the direction is fixed so that the direction of the target object can be easily specified.

【0028】上記距離データ蓄積部5は、測距装置4と
してのレーザレーダ11a、11bにより検出された物
体までの距離や方位のデータと、自車位置検出装置1に
よりその物体が検出された時点における自車両の位置の
データとを組として、物体が検出された数だけデータ点
列として逐次記憶していく。
The distance data storage unit 5 stores data on the distance and azimuth to the object detected by the laser radars 11a and 11b as the distance measuring device 4 and the time when the object is detected by the own vehicle position detecting device 1. And the data of the position of the own vehicle in the set are sequentially stored as a data point sequence for the number of detected objects.

【0029】線分抽出手段としての直線近似部6は、距
離データ蓄積部5に蓄積された上記データ点列から、ハ
フ変換等を用いて直線近似して線分を抽出する。この直
線近似で得られた線分は、自車両に隣接する他車両や駐
車場の壁などの周囲物体の位置を表すものと、とりあえ
ず見なすことができるが、前述のように測距装置1によ
る誤検出データ等が混入していることがあるから、これ
らの線分は、実際の物体位置から大きくずれている線分
を含んでいる場合がある。
The straight line approximation unit 6 as a line segment extraction unit extracts a line segment from the data point sequence stored in the distance data storage unit 5 by performing a line approximation using Hough transform or the like. The line segment obtained by this straight-line approximation can be considered for the time being to indicate the position of a surrounding object such as another vehicle adjacent to the own vehicle or the wall of a parking lot. Since erroneous detection data and the like may be mixed in, these line segments may include line segments that are greatly deviated from the actual object position.

【0030】上記ノイズ除去部7は、直線近似部6で得
られた線分のうち、基準方向算出部3で得られた基準方
向、すなわち自車両100の直進走行の進行方向に対し
て、略平行あるいは略垂直となる線分のみを抽出し、そ
れ以外の線分をノイズとして除去する。物体位置判断部
8は、ノイズ除去部7でノイズを除去された線分をもと
に車両周囲の物体の配置を判断し、物体各部位までの距
離を確定してそのデータを記憶する。
The noise elimination unit 7 is configured to generate a signal corresponding to the reference direction obtained by the reference direction calculation unit 3, that is, the traveling direction of the vehicle 100 traveling straight ahead, of the line segments obtained by the straight line approximation unit 6. Only parallel or substantially vertical line segments are extracted, and other line segments are removed as noise. The object position determining unit 8 determines the arrangement of the object around the vehicle based on the line segment from which the noise has been removed by the noise removing unit 7, determines the distance to each part of the object, and stores the data.

【0031】このように、直進走行時の進行方向を基準
方向として決定するのは、以下の理由による。すなわ
ち、駐車場では駐車のための進入路が狭く駐車スペース
に到着するまではほぼ直進しなければならない上、他車
両は、この直線進行方向に沿って並び、上記基準方向に
対して垂直方向あるいは斜め方向に向けて駐車されるの
が普通であることから、上記直進方向を基準に他車両等
の位置を決定することができるからである。ここでは、
先の図8に示すように、他車両14〜16が自車両10
0の直進方向(基準方向)に対して垂直方向に向けて駐
車している場合に着目しており、この場合、基準方向に
対し駐車場の壁13が略平行となり、他車両14〜16
の外周部分、したがってこれらを表す線分が基準方向に
対して略垂直方向あるいは略平行になることを利用して
いる。
The reason for determining the traveling direction when traveling straight ahead as the reference direction is as follows. In other words, in the parking lot, the approach path for parking is narrow and the vehicle must travel substantially straight until it arrives at the parking space, and other vehicles are aligned along this straight traveling direction and are perpendicular to the reference direction or This is because the vehicle is normally parked in an oblique direction, so that the position of another vehicle or the like can be determined based on the straight traveling direction. here,
As shown in FIG. 8, the other vehicles 14 to 16
In this case, attention is paid to a case where the vehicle is parked in a direction perpendicular to the straight traveling direction (reference direction) 0. In this case, the wall 13 of the parking lot is substantially parallel to the reference direction, and the other vehicles 14 to 16
, That is, the line segments representing these are substantially perpendicular or substantially parallel to the reference direction.

【0032】地図生成部9は、物体位置判断部8で判断
された自車両周囲に存在する物体の配置状況を表す地図
を生成する。表示部10は、地図生成部9で生成した地
図を運転者に表示する液晶ディスプレィ装置で構成す
る。
The map generator 9 generates a map indicating the arrangement of objects existing around the host vehicle determined by the object position determiner 8. The display unit 10 includes a liquid crystal display device that displays a map generated by the map generation unit 9 to a driver.

【0033】次に、上記構成になる周囲物体認識装置の
作用につき、説明する。ここでは、図8に示す駐車場で
駐車する場合を説明する。すなわち、駐車場には、図8
中、水平方向へ伸びる壁13が設けられており、この壁
13に対して垂直方向の状態で、図中左側から順に3台
の他車両14、15、16が駐車している。他車両14
と他車両15の間にスペースがあり、自車両100は、
図中右方から進入してきてこのスペースに駐車しようと
する。
Next, the operation of the surrounding object recognizing device having the above configuration will be described. Here, a case where the vehicle is parked in the parking lot shown in FIG. 8 will be described. That is, in the parking lot, FIG.
A wall 13 extending in the middle and horizontal directions is provided, and three other vehicles 14, 15 and 16 are parked in order from the left side in the figure in a state perpendicular to the wall 13. Other vehicles 14
There is a space between the other vehicle 15 and the own vehicle 100,
You approach from the right in the figure and try to park in this space.

【0034】この場合、自車両100は、他車両14〜
16の前方を図中右方から左方に向かって水平方向に直
進(この走行軌跡を17aで示す)し、上記スペース付
近でハンドルを右に切って車両10を図中左上方向へ移
動(この走行軌跡を17bで示す)させた後、前進走行
から後退走行へ切り替えるとともにハンドルをさらに左
に切りながら車体をその重心回りに時計方向へ回転させ
ながら後退(この走行軌跡を17cで示す)し、他車両
14、15間のスペースへ他車両と平行(図中垂直方
向)に直進後退し壁13の手前で停止する。
In this case, the own vehicle 100 is connected to the other vehicles 14 to
The vehicle travels straight ahead in the horizontal direction from right to left in the figure (the running locus is indicated by 17a), turns the steering wheel to the right near the space, and moves the vehicle 10 in the upper left direction in the figure. After the traveling locus is indicated by 17b), the vehicle is switched from the forward traveling to the reversing traveling, and while turning the steering wheel further to the left, the vehicle body is rotated clockwise around its center of gravity to retreat (this traveling locus is indicated by 17c). The vehicle recedes straight back into the space between the other vehicles 14 and 15 in the direction parallel to the other vehicle (vertical direction in the figure) and stops before the wall 13.

【0035】以上の駐車操作中、自車両100の自車両
位置検出装置1は、図示しない左右の後車輪速度センサ
及び舵角センサから、それぞれ左右の後車輪速度信号、
操舵角信号を受けて、これらから各車輪の移動量及び車
両の回転角度を算出することで車両の走行距離及び進行
方向を求め、自車位置を逐次検出していく。この自車位
置の具体的算出方法は、本出願人の特開平7−2483
2号公報に記載してあるので、ここではその詳細な説明
を省略する。
During the parking operation described above, the host vehicle position detecting device 1 of the host vehicle 100 outputs left and right rear wheel speed signals from left and right rear wheel speed sensors and a steering angle sensor (not shown).
Upon receiving the steering angle signals, the travel distance and traveling direction of the vehicle are obtained by calculating the movement amount of each wheel and the rotation angle of the vehicle from these signals, and the own vehicle position is sequentially detected. The specific method of calculating the own vehicle position is disclosed in Japanese Patent Application Laid-Open No. 7-2483 of the present applicant.
Since it is described in Japanese Patent Laid-Open No. 2 (Kokai) No. 2, detailed description thereof is omitted here.

【0036】このようにして自車両位置検出装置1で検
出した自車位置、すなわち車両の走行距離及び移動方向
のデータ信号は、直進走行判断部2及び距離データ蓄積
部5へ送られる。直進走行判断部2は、これらの信号を
もとに自車両100の走行軌跡を算出し、この走行軌跡
が略直線であるか否かを判別する。直進走行判断部2が
略直線であると判別したら、直進走行である旨の信号を
基準方向算出部3へ送る。基準方向算出部3は、そのと
きの直進走行の進行方向を基準方向としてノイズ除去部
7へ出力する。
The own vehicle position detected by the own vehicle position detecting device 1 in this manner, that is, the data signal of the traveling distance and the moving direction of the vehicle is sent to the straight traveling judging section 2 and the distance data accumulating section 5. The straight traveling determination unit 2 calculates the traveling locus of the vehicle 100 based on these signals, and determines whether or not the traveling locus is a substantially straight line. When the straight traveling determining unit 2 determines that the vehicle is traveling straight, a signal indicating that the vehicle is traveling straight is sent to the reference direction calculating unit 3. The reference direction calculation unit 3 outputs the traveling direction of the straight running at that time to the noise removal unit 7 as a reference direction.

【0037】一方、自車両100の後部両側端に設置し
たレーザレーダ11a、11bは、これらから車両幅方
向外側に発射したビーム12a、12bが周囲の物体に
当たって返ってきた反射波を受けることで、車両周囲の
物体までの距離及び方位を逐次検出する。この物体まで
の距離及び方位の検出データは、距離データ蓄積部5へ
送られ、自車両位置検出装置1から送られてきた、上記
物体検出時における自車位置に関するデータとともに1
組のデータとして、物体が検出された数だけデータ点列
として記憶・蓄積する。ここで、上記両データがデータ
組として記憶されるのは、物体までの距離及び方位がそ
のとき検出した自車両の位置に依存しているからであ
る。
On the other hand, the laser radars 11a and 11b installed at the rear side edges of the host vehicle 100 receive reflected waves that are returned from the beams 12a and 12b emitted from these to the outside in the vehicle width direction and hit surrounding objects. The distance and direction to an object around the vehicle are sequentially detected. The detection data of the distance and the azimuth to the object is sent to the distance data storage unit 5 and together with the data on the own vehicle position at the time of the object detection sent from the own vehicle position detecting device 1,
As a set of data, a number of data points is stored and accumulated as many as the number of detected objects. Here, the two data are stored as a data set because the distance and the azimuth to the object depend on the position of the host vehicle detected at that time.

【0038】上記のデータ点列を先の図9に示したもの
とする。このデータ点列をそのまま用いると先の図10
のように実際の周囲物体の位置とずれが生じるから、本
実施例では、距離データ蓄積部5に蓄積されたデータ点
列を直線近似部6においてハフ変換などの方法で直線近
似して、まず図2に示すような複数の線分を得た後、ノ
イズ除去部7でノイズとなる線分を除去するようにす
る。
It is assumed that the above data point sequence is shown in FIG. If this data point sequence is used as it is,
Thus, in this embodiment, the data point sequence stored in the distance data storage unit 5 is linearly approximated by a straight line approximation unit 6 by a method such as Hough transform. After obtaining a plurality of line segments as shown in FIG. 2, the noise removing unit 7 removes a line segment that becomes a noise.

【0039】すなわち、多くの駐車場にあっては、図8
のように自車両100の直進方向に対し、他車両14〜
16や壁13などの周囲物体の外面は、略水平方向か略
垂直方向になることがほとんどであるから、それら以外
の傾きとなる線分はノイズである公算が大きい。そこ
で、ノイズ除去部7は、基準方向算出部3から基準方向
(直進走行の進行方向)18の信号を受け、直線近似部
6で得た図2に示す線分のうちこの基準方向に対して略
平行(略水平)あるいは略垂直となる方向の線分のみを
抽出し、その他はノイズ分として除去する。
That is, in many parking lots, FIG.
As shown in FIG.
Since the outer surface of a surrounding object such as 16 or the wall 13 is almost in a substantially horizontal direction or a substantially vertical direction, a line segment having a slope other than these is likely to be noise. Therefore, the noise removing unit 7 receives the signal of the reference direction (the traveling direction of the straight traveling) 18 from the reference direction calculation unit 3 and receives the signal of the line segment shown in FIG. Only line segments in a direction substantially parallel (substantially horizontal) or substantially vertical are extracted, and the others are removed as noise components.

【0040】ノイズ除去部7でノイズ分が除去された残
りの線分は、図3に示すように、周囲物体の外周部分を
表す輪郭に良く一致した線分となる。すなわち、線分1
3Cは図8における壁13、線分14Cは他車両14、
線分15Cは他車両15、線分16Cは他車両16の外
周部分に対応している。物体位置判断部8ではノイズ除
去処理後のこの線分(直線群)に基づいて周囲物体の配
置を判断し、物体までの距離を確定する。そのデータは
一時記憶され、地図生成部9へ出力されるとともに、必
要に応じて運転支援制御のための情報として図示しない
制御装置などへ出力可能となっている。なお、運転支援
の例としては、警報を発したり、あるいは自動的にブレ
ーキを作用させたり、操舵角や車速を制御するようにし
てもよい。
The remaining line segment from which the noise component has been removed by the noise removing unit 7 is a line segment that matches well with the contour representing the outer peripheral portion of the surrounding object, as shown in FIG. That is, line segment 1
3C is the wall 13 in FIG. 8, the line segment 14C is the other vehicle 14,
Line 15C corresponds to the other vehicle 15 and line 16C corresponds to the outer peripheral portion of the other vehicle 16. The object position judging unit 8 judges the arrangement of the surrounding objects based on the line segment (straight line group) after the noise removal processing, and determines the distance to the object. The data is temporarily stored and output to the map generation unit 9 and, if necessary, can be output to a control device (not shown) or the like as information for driving support control. In addition, as an example of driving assistance, a warning may be issued, a brake may be automatically applied, or a steering angle or a vehicle speed may be controlled.

【0041】地図生成部9では、物体位置判断部8から
のデータを用いて物体の位置状況を表す地図を生成す
る。この地図は、表示部10の画面に表示されること
で、運転者に自車両100の周囲に存在する物体の位置
状況を容易に認識させる。運転者は、この情報を参考に
することで、ハンドル操作など的確な運転操作が可能に
なる。
The map generator 9 uses the data from the object position determiner 8 to generate a map representing the position of the object. This map is displayed on the screen of the display unit 10 so that the driver can easily recognize the position situation of an object existing around the host vehicle 100. By referring to this information, the driver can perform a proper driving operation such as a steering wheel operation.

【0042】次に、第2の実施例について説明する。第
1の実施例では図8に示すように他車両14〜16が自
車両100の直進進入方向と垂直向きに駐車している駐
車場を対象としたが、本実施例は図4に示すように自車
両100の直進進入方向に対し他車両14〜16が斜め
向きに停車している駐車場にも対応できるようにしたも
のである。本実施例は、ノイズ除去部7におけるノイズ
除去方法を異ならせてあるほかは、第1の実施例の構成
と同じである。
Next, a second embodiment will be described. In the first embodiment, as shown in FIG. 8, the other vehicles 14 to 16 are targeted for a parking lot parked in a direction perpendicular to the straight approach direction of the own vehicle 100, but this embodiment is as shown in FIG. 4. In this case, the vehicle can cope with a parking lot where other vehicles 14 to 16 are parked obliquely with respect to the straight approach direction of the vehicle 100. This embodiment is the same as the configuration of the first embodiment except that the noise removing method in the noise removing unit 7 is different.

【0043】直線近似部6において周囲物体の検出部分
に対応する線分を得るまで、及び基準方向算出部3で自
車両100の直進走行方向、すなわち基準方向を算出す
るまでの作用は、第1の実施例の場合と同一である。た
だし、他車両14〜16が壁13や自車両100の直進
方向に対して傾いた向きで駐車されているので、距離デ
ータ蓄積部5に蓄積されたデータ点列を図示した結果
は、図5に示すようになる。なお、同図においてもノイ
ズは、分かりやすくするため太いドットで描いてある。
点列13Dは壁13、点列14Dは他車両14、点列1
5Dは他車両15、点列16Dは他車両16の外周部分
にそれぞれ対応する。
The operation until the straight line approximation unit 6 obtains a line segment corresponding to the detected portion of the surrounding object and the operation in which the reference direction calculation unit 3 calculates the straight traveling direction of the vehicle 100, that is, the reference direction, are as follows. This is the same as the embodiment. However, since the other vehicles 14 to 16 are parked in a direction inclined with respect to the wall 13 or the straight traveling direction of the host vehicle 100, the result of the data point sequence stored in the distance data storage unit 5 is shown in FIG. It becomes as shown in. Note that, also in the figure, noise is drawn by thick dots for easy understanding.
Point sequence 13D is wall 13, point sequence 14D is another vehicle 14, point sequence 1
5D corresponds to the other vehicle 15 and the point sequence 16D corresponds to the outer peripheral portion of the other vehicle 16, respectively.

【0044】ノイズ除去部7では、まず図6に示すよう
に、直線近似部6で得られた各線分につき、これらが基
準方向算出部3で得られた基準方向に対して傾いている
角度をそれぞれ算出する。さらに、上記各線分の長さを
算出して、これらの線分のうち最大長さを有する線分を
抽出し、当該最大長さの線分が上記基準方向に対してな
す角度θ7を基準角度とする。
In the noise removing section 7, first, as shown in FIG. 6, for each line segment obtained by the straight line approximating section 6, the angle at which these are inclined with respect to the reference direction obtained by the reference direction calculating section 3 is calculated. Calculate each. Further, the length of each of the line segments is calculated, a line segment having the maximum length is extracted from these line segments, and the angle θ7 formed by the line segment with the maximum length with respect to the reference direction is defined as a reference angle. And

【0045】次いで、上記各線分のうちこの基準角度θ
7に略等しい線分(最大長さの線分に略平行な線分)、
あるいはこの基準角度を有する最大長さの線分に対して
略垂直となる線分のみを抽出し、その他の線分をノイズ
として除去する。この結果を図7に示す。同図におい
て、線分14Eは他車両14、線分15Eは他車両15
E、線分16Eは他車両16の外周部分に良く一致して
いる。
Next, the reference angle θ among the above line segments
A line segment approximately equal to 7 (a line segment approximately parallel to the maximum length line segment),
Alternatively, only the line segment that is substantially perpendicular to the line segment having the maximum length having the reference angle is extracted, and the other line segments are removed as noise. The result is shown in FIG. In the figure, a line segment 14E is another vehicle 14, and a line segment 15E is another vehicle 15.
E and the line segment 16E are in good agreement with the outer peripheral portion of the other vehicle 16.

【0046】このようにしてノイズ除去部7で抽出して
得た線分14E〜16Eをもとに地図生成部8は、周囲
物体の検出した部分を線分で描いた地図を生成する。こ
の地図は、表示部9にて運転手に表示され、運転者の周
囲物体の認識を容易にする。
Based on the line segments 14E to 16E extracted by the noise removing unit 7 in this manner, the map generating unit 8 generates a map in which the detected parts of the surrounding objects are drawn by the line segments. This map is displayed to the driver on the display unit 9 to facilitate recognition of objects surrounding the driver.

【0047】次に、本発明の第3の実施例について説明
する。本実施例は、ノイズ除去装置における基準角度の
決定方法を第2の実施例と異ならせたもので、他の構成
は第2の実施例と同じである。ノイズ除去装置7は、直
線近似部6で得られた各線分につき、これらが基準方向
算出部3で得られた基準方向に対して傾いている角度θ
1〜θ8を、先の図6に示したと同様に、それぞれ算出
する。
Next, a third embodiment of the present invention will be described. The present embodiment differs from the second embodiment in the method of determining the reference angle in the noise elimination device, and the other configuration is the same as that of the second embodiment. The noise elimination device 7 determines, for each line segment obtained by the straight line approximation unit 6, the angle θ at which these are inclined with respect to the reference direction obtained by the reference direction calculation unit 3.
1 to θ8 are calculated in the same manner as shown in FIG.

【0048】そして、上記基準方向に対してなす角度が
略等しい線分の数が最も多い線分を抽出し、これらの線
分の角度を基準角度として設定する。次いで、上記各線
分のうちこの基準角度に略等しい線分(すなわち平行な
線分)、あるいはこの基準角度を有する線分に対して略
垂直となる線分のみを抽出し、その他の線分をノイズと
して除去する。その他の作用は第2の実施例と同じであ
る。この場合にも、図7に示したと同様に、他車両の外
周輪郭に良く一致した周囲物体の位置状況が得られる。
Then, line segments having the largest number of line segments having substantially the same angle with respect to the reference direction are extracted, and the angles of these line segments are set as reference angles. Next, of the above-described line segments, only a line segment substantially equal to the reference angle (that is, a parallel line segment) or a line segment substantially perpendicular to the line segment having the reference angle is extracted, and other line segments are extracted. Remove as noise. Other operations are the same as those of the second embodiment. Also in this case, similarly to the case shown in FIG. 7, the position situation of the surrounding object that well matches the outer peripheral contour of the other vehicle can be obtained.

【0049】また、測距装置1として、レーザレーダの
方向を固定して一次元的に物体までの距離を測定するい
わゆる1次元センサを構成したが、これに代わり、物体
までの距離と方位の両方が測定できる2次元センサを用
いてもよく、あるいは物体までの距離、高さ及び方位を
測定できる3次元センサを用いるようにしてもよい。と
くに3次元センサを用いる場合、周囲物体を面として把
握することが可能となる。したがって、本発明において
線分は広く面を含むものとする。一方、センサの具体的
構成としては、レーダレーダの代わりに、マイクロ波レ
ーダ、ミリ波レーダ、超音波センサ、ステレオ画像処理
装置等任意の手段を用いることもできる。とくにステレ
オ画像処理装置は距離と方位の両方を測定するのに好適
である。
Further, as the distance measuring device 1, a so-called one-dimensional sensor for measuring the distance to the object one-dimensionally while fixing the direction of the laser radar is configured. A two-dimensional sensor that can measure both may be used, or a three-dimensional sensor that can measure the distance, height, and orientation to an object may be used. In particular, when a three-dimensional sensor is used, it is possible to grasp a surrounding object as a surface. Therefore, in the present invention, a line segment includes a wide surface. On the other hand, as a specific configuration of the sensor, any means such as a microwave radar, a millimeter wave radar, an ultrasonic sensor, and a stereo image processing device can be used instead of the radar radar. In particular, a stereo image processing device is suitable for measuring both distance and azimuth.

【0050】さらに実施例では、自車両位置検出装置1
として、車輪速センサと舵角センサを用いて走行距離と
進行方向を推定する例を示したが、舵角センサの代わり
にジャイロ等を用いてもよいし、あるいはデッドレコニ
ングの手法に代え、GPS(グローバル・ポジショニン
グ・システム)等を用いることも可能である。
Further, in the embodiment, the own vehicle position detecting device 1
As an example, the traveling distance and the traveling direction are estimated using the wheel speed sensor and the steering angle sensor, but a gyro may be used instead of the steering angle sensor, or the GPS may be used instead of the dead reckoning method. (Global positioning system) or the like can be used.

【0051】また、直進走行判断部2は、走行距離と進
行方向から算出した走行軌跡が略直線であるとき、直進
走行であると判断するものとしたが、そのほか、走行軌
跡を求めることなく、車両の進行方向を時系列的に記憶
していき、その変化がほぼゼロである場合に直進走行で
あると判断するようにしてもよい。この方法は、自車両
位置検出装置1に、車両の方位を直接検出できるジャイ
ロ等を用いるときに特に有効である。
The straight traveling judgment unit 2 judges that the vehicle is traveling straight when the traveling locus calculated from the traveling distance and the traveling direction is substantially a straight line. The traveling direction of the vehicle may be stored in chronological order, and if the change is substantially zero, it may be determined that the vehicle is traveling straight. This method is particularly effective when a gyro or the like that can directly detect the azimuth of the vehicle is used as the host vehicle position detection device 1.

【0052】さらに、実施例では地図生成部9で生成し
た地図を表示部10に表示させるものとしたが、このほ
か、上記生成した地図を基に、物体の存在しない部位を
自車両の駐車位置と設定し、検出した自車両位置から設
定駐車位置までの走行軌跡を算出して、その走行軌跡に
そって走行するように操舵角を制御するようにしてもよ
い。
Further, in the embodiment, the map generated by the map generation unit 9 is displayed on the display unit 10. In addition, based on the generated map, a part where an object does not exist is determined by the parking position of the host vehicle. May be set, a traveling locus from the detected own vehicle position to the set parking position may be calculated, and the steering angle may be controlled to travel along the traveling locus.

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明に係る実施例の構成を示すブロック図で
ある。
FIG. 1 is a block diagram showing a configuration of an embodiment according to the present invention.

【図2】図9のデータ点列を直線近似して得た線分を示
す図である。
FIG. 2 is a diagram showing a line segment obtained by linearly approximating the data point sequence of FIG. 9;

【図3】ノイズ除去処理後の線分を示す図である。FIG. 3 is a diagram illustrating a line segment after a noise removal process.

【図4】第2の実施例にかかる他車両が壁にそって斜め
方向の状態で駐車している駐車場を示す図である。
FIG. 4 is a diagram illustrating a parking lot in which another vehicle according to the second embodiment is parked in an oblique direction along a wall.

【図5】図4の駐車場において測距したデータ点列を示
す図である。
FIG. 5 is a diagram showing a data point sequence measured in the parking lot of FIG. 4;

【図6】図5のデータ点列を直線近似して得た線分の角
度算出状態を示す図である。
FIG. 6 is a diagram showing a state of calculating an angle of a line segment obtained by linearly approximating the data point sequence of FIG. 5;

【図7】ノイズ除去処理後の線分を示す図である。FIG. 7 is a diagram illustrating a line segment after noise removal processing.

【図8】他車両が壁にそって垂直方向の状態で駐車して
いる駐車場を示す図である。
FIG. 8 is a diagram showing a parking lot in which another vehicle is parked in a vertical state along a wall.

【図9】図8の駐車場において測距したデータ点列を示
す図である。
9 is a diagram showing a data point sequence measured in the parking lot shown in FIG. 8;

【図10】従来装置により図9のデータ点列に基づいて
周囲物体の配置を求めた状態を示す図である。
FIG. 10 is a diagram showing a state in which the arrangement of surrounding objects is obtained based on the data point sequence of FIG. 9 by the conventional device.

【符号の説明】[Explanation of symbols]

1 自車位置検出装置 2 直進走行判断部 3 基準方向算出部 4 測距装置 5 距離データ蓄積部 6 直線近似部(線分抽出手段) 7 ノイズ除去部 8 物体位置判断部 9 地図生成部 10 表示部 100 自車両 11a、11b レーザレーダ(測距装置) 13 駐車場の壁(周囲物体) 14〜16 他車両(周囲物体) REFERENCE SIGNS LIST 1 own vehicle position detection device 2 straight traveling judgment unit 3 reference direction calculation unit 4 distance measurement device 5 distance data storage unit 6 straight line approximation unit (line segment extraction means) 7 noise removal unit 8 object position judgment unit 9 map generation unit 10 display Part 100 Own vehicle 11a, 11b Laser radar (ranging device) 13 Wall of parking lot (surrounding object) 14-16 Other vehicle (surrounding object)

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.7 識別記号 FI テーマコート゛(参考) // G01S 13/93 G01S 17/88 A Fターム(参考) 5J062 BB01 CC07 CC11 HH05 5J070 AB24 AC02 AC13 AE01 AF03 AK22 AK28 5J084 AA05 AA10 AB01 AC02 EA01 EA04 ──────────────────────────────────────────────────続 き Continued on the front page (51) Int.Cl. 7 Identification symbol FI Theme coat ゛ (Reference) // G01S 13/93 G01S 17/88 A F term (Reference) 5J062 BB01 CC07 CC11 HH05 5J070 AB24 AC02 AC13 AE01 AF03 AK22 AK28 5J084 AA05 AA10 AB01 AC02 EA01 EA04

Claims (9)

【特許請求の範囲】[Claims] 【請求項1】 自車両の位置を検出する自車両位置検出
装置と、自車両の位置の推移に基づく自車両の所定の進
行方向を基準方向として設定する基準方向設定手段と、
自車両に設置されて、自車両の周囲に存在する物体まで
の距離及び方位を測定可能な測距装置と、該測距装置に
より検出された物体までの距離及び方位と該物体検出時
点に前記自車両位置検出装置により検出された自車両の
位置との組をデータ点列として記憶する距離データ蓄積
部と、該距離データ蓄積部に蓄積された前記データ点列
から物体に対応する線分を抽出する線分抽出手段と、該
線分抽出手段により抽出された線分の中から前記基準方
向設定手段により得られた前記基準方向に対して所定の
角度関係を満たす線分のみを抽出するノイズ除去部と、
該ノイズ除去部で抽出された線分をもとに車両周囲に存
在する物体の位置を判断する物体位置判断部と、を有す
ることを特徴とする周囲物体認識装置。
1. An own-vehicle position detecting device for detecting a position of an own-vehicle; reference direction setting means for setting a predetermined traveling direction of the own vehicle based on a change in the position of the own vehicle as a reference direction;
A distance measuring device installed in the own vehicle and capable of measuring a distance and an azimuth to an object existing around the own vehicle, a distance and an azimuth to the object detected by the distance measuring device, and A distance data storage unit that stores a set of the position of the host vehicle detected by the host vehicle position detection device as a data point sequence, and a line segment corresponding to an object from the data point sequence stored in the distance data storage unit. A line segment extracting means for extracting, and a noise for extracting only a line segment satisfying a predetermined angle relationship with respect to the reference direction obtained by the reference direction setting means from the line segments extracted by the line segment extracting means. A removing unit;
An object position determining unit that determines a position of an object existing around the vehicle based on the line segment extracted by the noise removing unit.
【請求項2】 前記基準方向設定手段は、自車両の直進
走行時を判別する直進走行判断部と、該直進走行判断部
が直進走行と判断したときの自車両の進行方向を前記基
準方向として出力する基準方向算出部とからなることを
特徴とする請求項1記載の周囲物体認識装置。
2. The vehicle according to claim 1, wherein the reference direction setting unit determines a straight traveling direction of the own vehicle when the vehicle is traveling straight, and sets a reference direction to the traveling direction of the own vehicle when the straight traveling determining unit determines that the vehicle is traveling straight. The surrounding object recognition device according to claim 1, further comprising a reference direction calculation unit that outputs the reference direction.
【請求項3】 前記自車両位置検出装置は自車両の位置
として走行距離と進行方向を検出し、前記直進走行判断
部は、前記走行距離と進行方向から走行軌跡を求め、該
走行軌跡が直線であるとき直進走行時であると判断する
ものであることを特徴とする請求項2記載の周囲物体認
識装置。
3. The own vehicle position detecting device detects a travel distance and a traveling direction as a position of the own vehicle, and the straight traveling determination unit obtains a traveling locus from the traveling distance and the traveling direction. 3. The surrounding object recognition device according to claim 2, wherein when it is determined that the vehicle is traveling straight ahead.
【請求項4】 前記線分抽出手段が、前記データ点列か
ら物体に対応する線分を直線として抽出することを特徴
とする請求項1、2または3記載の周囲物体認識装置。
4. The peripheral object recognition device according to claim 1, wherein the line segment extracting unit extracts a line segment corresponding to the object from the data point sequence as a straight line.
【請求項5】 前記所定の角度関係は、前記基準方向に
対して略平行あるいは略垂直となる関係であることを特
徴とする請求項1、2、3または4記載の周囲物体認識
装置。
5. The peripheral object recognition device according to claim 1, wherein the predetermined angular relationship is a relationship that is substantially parallel or substantially perpendicular to the reference direction.
【請求項6】 前記所定の角度関係は、前記線分抽出手
段により抽出された線分のうち最大長さを有する線分が
前記基準方向に対してなす角度を基準角度とし、該基準
角度に対して略平行あるいは略垂直となる関係であるこ
とを特徴とする請求項1、2、3または4記載の周囲物
体認識装置。
6. The predetermined angle relation is defined as an angle formed by a line segment having a maximum length among the line segments extracted by the line segment extraction unit with respect to the reference direction, and 5. The surrounding object recognition device according to claim 1, wherein the relationship is substantially parallel or substantially perpendicular to the object.
【請求項7】 前記所定の角度関係は、前記線分抽出手
段により抽出された線分のうち前記基準方向に対してな
す角度が略等しいものの数が最大となる線分の角度を基
準角度とし、該基準角度に対して略平行あるいは略垂直
となる関係であることを特徴とする請求項1、2、3ま
たは4記載の周囲物体認識装置。
7. The predetermined angle relationship is defined as a line segment extracted by the line segment extraction unit, the line segment having substantially the same number of angles with respect to the reference direction as the reference angle. 5. The peripheral object recognition device according to claim 1, wherein the relationship is substantially parallel or substantially perpendicular to the reference angle.
【請求項8】 前記物体位置判断部により得られた車両
周囲に存在する物体の位置を表す地図を作成する地図生
成部を有することを特徴とする請求項1から7のいずれ
かに記載の周囲物体認識装置。
8. The surroundings according to claim 1, further comprising a map generating unit that creates a map that represents a position of an object existing around the vehicle obtained by the object position determining unit. Object recognition device.
【請求項9】 前記地図生成部で作成した地図を表示す
る表示部を有することを特徴とする請求項8記載の周囲
物体認識装置。
9. The surrounding object recognition device according to claim 8, further comprising a display unit for displaying a map created by said map generation unit.
JP2001027960A 2001-02-05 2001-02-05 Peripheral object confirming device Withdrawn JP2002228734A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2001027960A JP2002228734A (en) 2001-02-05 2001-02-05 Peripheral object confirming device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2001027960A JP2002228734A (en) 2001-02-05 2001-02-05 Peripheral object confirming device

Publications (1)

Publication Number Publication Date
JP2002228734A true JP2002228734A (en) 2002-08-14

Family

ID=18892538

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001027960A Withdrawn JP2002228734A (en) 2001-02-05 2001-02-05 Peripheral object confirming device

Country Status (1)

Country Link
JP (1) JP2002228734A (en)

Cited By (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006031412A (en) * 2004-07-16 2006-02-02 Nippon Soken Inc Automatic parking system
EP1683707A1 (en) * 2005-01-12 2006-07-26 Toyota Jidosha Kabushiki Kaisha Parking support device
JP2006193011A (en) * 2005-01-12 2006-07-27 Toyota Motor Corp Parking supporting device
WO2006090736A1 (en) * 2005-02-23 2006-08-31 Aisin Seiki Kabushiki Kaisha Object recognizing device
WO2007033755A1 (en) * 2005-09-22 2007-03-29 Valeo Schalter Und Sensoren Gmbh Method for measuring a parking space
JP2007114056A (en) * 2005-10-20 2007-05-10 Aisin Seiki Co Ltd Object recognition device
JP2007114057A (en) * 2005-10-20 2007-05-10 Aisin Seiki Co Ltd Object recognition device
US7218385B2 (en) 2004-04-28 2007-05-15 Denso Corporation Preceding vehicle recognition apparatus
WO2008099846A1 (en) * 2007-02-16 2008-08-21 Toyota Jidosha Kabushiki Kaisha Parking assistance device
JP2010164349A (en) * 2009-01-13 2010-07-29 Equos Research Co Ltd Control unit
JP2011178393A (en) * 2004-06-05 2011-09-15 Robert Bosch Gmbh Method and device for supporting and garaging automobile
JP2012008114A (en) * 2009-12-25 2012-01-12 Honda Motor Co Ltd Measurement apparatus, position determination system, measurement method, calibration method and program
KR20130128894A (en) * 2012-05-18 2013-11-27 현대모비스 주식회사 System for controlling parking and method thereof
US8885889B2 (en) 2012-10-12 2014-11-11 Hyundai Mobis Co., Ltd. Parking assist apparatus and parking assist method and parking assist system using the same
JP2016161340A (en) * 2015-02-27 2016-09-05 株式会社デンソー Noise reduction method and object recognition device
JP2018043599A (en) * 2016-09-13 2018-03-22 日立建機株式会社 Mine work machine and method of monitoring backward thereof
JP2018151315A (en) * 2017-03-14 2018-09-27 本田技研工業株式会社 Method for specifying noise data of laser range finder
EP3453595A1 (en) * 2017-09-08 2019-03-13 Valeo Schalter und Sensoren GmbH Method for characterising a parking space for a motor vehicle delimited by two objects, parking assistance system and motor vehicle
WO2019119944A1 (en) * 2017-12-20 2019-06-27 广州汽车集团股份有限公司 Method for detecting angled parking space and method and system for automatic parking
JP2019537715A (en) * 2016-10-25 2019-12-26 ツァイニャオ スマート ロジスティクス ホールディング リミティド Obstacle detection system and method

Cited By (31)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7218385B2 (en) 2004-04-28 2007-05-15 Denso Corporation Preceding vehicle recognition apparatus
JP2011178393A (en) * 2004-06-05 2011-09-15 Robert Bosch Gmbh Method and device for supporting and garaging automobile
JP2006031412A (en) * 2004-07-16 2006-02-02 Nippon Soken Inc Automatic parking system
EP1683707A1 (en) * 2005-01-12 2006-07-26 Toyota Jidosha Kabushiki Kaisha Parking support device
JP2006193014A (en) * 2005-01-12 2006-07-27 Toyota Motor Corp Parking supporting device
JP2006193011A (en) * 2005-01-12 2006-07-27 Toyota Motor Corp Parking supporting device
EP1852713A4 (en) * 2005-02-23 2008-10-15 Aisin Seiki Object recognizing device
WO2006090736A1 (en) * 2005-02-23 2006-08-31 Aisin Seiki Kabushiki Kaisha Object recognizing device
EP1852713A1 (en) * 2005-02-23 2007-11-07 Aisin Seiki Kabushiki Kaisha Object recognizing device
WO2007033755A1 (en) * 2005-09-22 2007-03-29 Valeo Schalter Und Sensoren Gmbh Method for measuring a parking space
EP1939585B1 (en) * 2005-10-20 2009-06-17 Aisin Seiki Kabushiki Kaisha Object recognizing device
EP1939585A1 (en) * 2005-10-20 2008-07-02 Aisin Seiki Kabushiki Kaisha Object recognizing device
JP2007114057A (en) * 2005-10-20 2007-05-10 Aisin Seiki Co Ltd Object recognition device
JP4618506B2 (en) * 2005-10-20 2011-01-26 アイシン精機株式会社 Object recognition device
JP4662147B2 (en) * 2005-10-20 2011-03-30 アイシン精機株式会社 Object recognition device
JP2007114056A (en) * 2005-10-20 2007-05-10 Aisin Seiki Co Ltd Object recognition device
US8031908B2 (en) 2005-10-20 2011-10-04 Aisin Seiki Kabushiki Kaisha Object recognizing apparatus including profile shape determining section
WO2008099846A1 (en) * 2007-02-16 2008-08-21 Toyota Jidosha Kabushiki Kaisha Parking assistance device
JP2008201178A (en) * 2007-02-16 2008-09-04 Toyota Motor Corp Parking assist device
JP2010164349A (en) * 2009-01-13 2010-07-29 Equos Research Co Ltd Control unit
JP2012008114A (en) * 2009-12-25 2012-01-12 Honda Motor Co Ltd Measurement apparatus, position determination system, measurement method, calibration method and program
KR20130128894A (en) * 2012-05-18 2013-11-27 현대모비스 주식회사 System for controlling parking and method thereof
US8885889B2 (en) 2012-10-12 2014-11-11 Hyundai Mobis Co., Ltd. Parking assist apparatus and parking assist method and parking assist system using the same
JP2016161340A (en) * 2015-02-27 2016-09-05 株式会社デンソー Noise reduction method and object recognition device
JP2018043599A (en) * 2016-09-13 2018-03-22 日立建機株式会社 Mine work machine and method of monitoring backward thereof
JP2019537715A (en) * 2016-10-25 2019-12-26 ツァイニャオ スマート ロジスティクス ホールディング リミティド Obstacle detection system and method
JP2018151315A (en) * 2017-03-14 2018-09-27 本田技研工業株式会社 Method for specifying noise data of laser range finder
EP3453595A1 (en) * 2017-09-08 2019-03-13 Valeo Schalter und Sensoren GmbH Method for characterising a parking space for a motor vehicle delimited by two objects, parking assistance system and motor vehicle
CN109466544A (en) * 2017-09-08 2019-03-15 法雷奥开关和传感器有限责任公司 The method for characterizing parking space, parking assistance system and motor vehicles
WO2019119944A1 (en) * 2017-12-20 2019-06-27 广州汽车集团股份有限公司 Method for detecting angled parking space and method and system for automatic parking
US11285940B2 (en) 2017-12-20 2022-03-29 Guangzhou Automobile Group Co., Ltd. Diagonal parking space detection method, and automatic parking method and system

Similar Documents

Publication Publication Date Title
JP2002228734A (en) Peripheral object confirming device
JP4600760B2 (en) Obstacle detection device
CN101808852B (en) Control device for a display device of a parking device, and representation method
JP6705414B2 (en) Operating range determination device
EP1908641A1 (en) Parking assistance device
CN102310857A (en) The parking assisting system that is used for horizontal parking position
US11300415B2 (en) Host vehicle position estimation device
US20120062396A1 (en) Parking support device
JP2002243857A (en) Surrounding body recognizer
WO2007132860A1 (en) Object recognition device
JP2013220802A (en) Parking support device, parking support method and parking support program
CN103534729A (en) Method and system for determining a self-movement of a vehicle
EP3708466B1 (en) Parking assistance device and parking assistance method
CN102016635A (en) Driver assistance method for moving a motor vehicle and driver assistance device
CN112771591B (en) Method for evaluating the influence of an object in the environment of a vehicle on the driving maneuver of the vehicle
JP5511431B2 (en) Parking assistance device
JP4759878B2 (en) Parking assistance device for vehicles
US11326889B2 (en) Driver assistance system and control method for the same
JP3763733B2 (en) Parking assistance device and control method thereof
JP6263453B2 (en) Momentum estimation device and program
JP2012234373A (en) Driving support device
WO2022168437A1 (en) Vehicle and driving assistance device
US9132858B2 (en) Method and device for assisting a driver of a motor vehicle during a driving maneuver
JP2019032607A (en) Parking support device
JP5460413B2 (en) Own vehicle position recognition device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20071221

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20080912

A761 Written withdrawal of application

Free format text: JAPANESE INTERMEDIATE CODE: A761

Effective date: 20090805