JP6599075B2 - Obstacle detection device - Google Patents

Obstacle detection device Download PDF

Info

Publication number
JP6599075B2
JP6599075B2 JP2019541811A JP2019541811A JP6599075B2 JP 6599075 B2 JP6599075 B2 JP 6599075B2 JP 2019541811 A JP2019541811 A JP 2019541811A JP 2019541811 A JP2019541811 A JP 2019541811A JP 6599075 B2 JP6599075 B2 JP 6599075B2
Authority
JP
Japan
Prior art keywords
distance
distance sensor
wave
obstacle
determination unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2019541811A
Other languages
Japanese (ja)
Other versions
JPWO2019058507A1 (en
Inventor
裕 小野寺
井上　　悟
亘 辻田
努 朝比奈
良次 澤
光昭 岡田
涼太郎 鈴木
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Application granted granted Critical
Publication of JP6599075B2 publication Critical patent/JP6599075B2/en
Publication of JPWO2019058507A1 publication Critical patent/JPWO2019058507A1/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/06—Systems determining position data of a target
    • G01S13/42—Simultaneous measurement of distance and other co-ordinates
    • 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
    • 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/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/06—Systems determining the position data of a target
    • G01S15/42—Simultaneous measurement of distance and other co-ordinates
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Acoustics & Sound (AREA)
  • Electromagnetism (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)

Description

この発明は、車両周辺の障害物を検出する障害物検出装置に関するものである。 The present invention relates to an obstacle detection equipment for detecting an obstacle around the vehicle.

距離センサを用いて車両周辺の障害物を検出する障害物検出装置は、壁等の車両が衝突する可能性のある高い障害物だけでなく、路面付近の段差等の車両が衝突する可能性のない低い障害物も検出してしまうことがある。このような障害物検出装置は、低い障害物を検出すると、運転者に対して不要な警告を行ってしまう等の問題があった。   Obstacle detection devices that detect obstacles around the vehicle using a distance sensor are not limited to obstacles that are likely to collide with vehicles such as walls, but may also collide with vehicles such as steps near the road surface. There may be no low obstacles detected. Such an obstacle detection device has a problem that, when a low obstacle is detected, an unnecessary warning is given to the driver.

上記問題の対策として、検出した障害物が低い障害物か高い障害物かを判定する技術が提案されている。例えば、特許文献１に係る障害物検出装置は、車両の後方に向けて超音波を送信して障害物からの反射波を受信し、反射波のピーク値を検出し、車両の後方移動に伴って変化するピーク値の差分が負の値であるときに低い障害物と判定し、正の値であるときに高い障害物と判定する。   As a countermeasure for the above problem, a technique for determining whether a detected obstacle is a low obstacle or a high obstacle has been proposed. For example, the obstacle detection device according to Patent Document 1 transmits an ultrasonic wave toward the rear of the vehicle, receives a reflected wave from the obstacle, detects a peak value of the reflected wave, and accompanies the movement of the vehicle backward. When the difference between the peak values changing in a negative value is a negative value, the obstacle is determined to be low, and when the difference is positive, the obstacle is determined to be high.

特開２０１０−１９７３５１号公報JP 2010-197351 A

従来の障害物検出装置は以上のように構成されているので、車両が停止している場合に障害物の高さを判定できないという課題があった。   Since the conventional obstacle detection apparatus is configured as described above, there is a problem that the height of the obstacle cannot be determined when the vehicle is stopped.

この発明は、上記のような課題を解決するためになされたもので、車両が走行している場合だけでなく停止している場合にも、障害物の高さを判定することを目的とする。   The present invention has been made to solve the above-described problems, and an object thereof is to determine the height of an obstacle not only when the vehicle is running but also when it is stopped. .

この発明に係る障害物検出装置は、車両に設置された第１の距離センサと、第１の距離センサの設置高さよりも低い位置に設置された第２の距離センサと、第１の距離センサおよび第２の距離センサから探査波を送信させ障害物で反射した探査波である反射波を受信させて距離情報および反射波の強度を取得する送受信部と、第１の距離センサの距離情報および第２の距離センサの距離情報に基づき、第１の距離センサの反射波および第２の距離センサの反射波が同一の障害物で反射した直接波であることを判定する同一性判定部と、同一性判定部により同一の障害物で反射した直接波であると特定された第１の距離センサの直接波と第２の距離センサの直接波との強度比に基づき、同一の障害物の高さを判定する高さ判定部とを備えるものである。
同一性判定部は、第１の距離センサの距離情報および第２の距離センサの距離情報を用いて、車両の前後左右方向の２次元座標において探査波が反射した反射点の位置を算出し、反射点の分布に基づいて第１の距離センサの反射波および第２の距離センサの反射波が同一の障害物で反射した直接波であることを判定する。
高さ判定部は、同一の障害物について、第１の距離センサの距離情報と第２の距離センサの距離情報との差分値が予め定められた閾値以下である場合に第１の距離センサまたは第２の距離センサの少なくとも一方により受信された直接波の強度を補正し、補正した強度を用いて高さ判定を行う。 The obstacle detection device according to the present invention includes a first distance sensor installed in a vehicle, a second distance sensor installed at a position lower than the installation height of the first distance sensor, and a first distance sensor. A transmission / reception unit that transmits a search wave from the second distance sensor and receives a reflected wave that is a search wave reflected by an obstacle to acquire distance information and the intensity of the reflected wave; distance information of the first distance sensor; An identity determination unit that determines that the reflected wave of the first distance sensor and the reflected wave of the second distance sensor are direct waves reflected by the same obstacle based on the distance information of the second distance sensor; Based on the intensity ratio between the direct wave of the first distance sensor and the direct wave of the second distance sensor identified as direct waves reflected by the same obstacle by the identity determination unit, the height of the same obstacle is determined. With a height judging section for judging the thickness A.
The identity determination unit uses the distance information of the first distance sensor and the distance information of the second distance sensor to calculate the position of the reflection point where the exploration wave is reflected in the two-dimensional coordinates in the front-rear and left-right directions of the vehicle, Based on the distribution of the reflection points, it is determined that the reflected wave of the first distance sensor and the reflected wave of the second distance sensor are direct waves reflected by the same obstacle.
When the difference value between the distance information of the first distance sensor and the distance information of the second distance sensor is equal to or less than a predetermined threshold for the same obstacle, the height determination unit The intensity of the direct wave received by at least one of the second distance sensors is corrected, and the height is determined using the corrected intensity.

この発明によれば、異なる高さに設置された第１の距離センサと第２の距離センサにより受信された直接波の強度比を用いるようにしたので、車両が走行している場合だけでなく停止している場合にも、障害物の高さを判定することができる。   According to the present invention, since the direct wave intensity ratio received by the first distance sensor and the second distance sensor installed at different heights is used, not only when the vehicle is traveling, Even when the vehicle is stopped, the height of the obstacle can be determined.

実施の形態１に係る障害物検出装置の構成例を示すブロック図である。1 is a block diagram illustrating a configuration example of an obstacle detection apparatus according to Embodiment 1. FIG. 図２Ａおよび図２Ｂは、実施の形態１に係る障害物検出装置の構成例を示すハードウェア構成図である。2A and 2B are hardware configuration diagrams illustrating a configuration example of the obstacle detection apparatus according to Embodiment 1. FIG. 実施の形態１における第１の距離センサおよび第２の距離センサの車両設置例を示す図である。It is a figure which shows the vehicle installation example of the 1st distance sensor in Embodiment 1, and a 2nd distance sensor. 実施の形態１における直接波と間接波を説明する図である。3 is a diagram illustrating a direct wave and an indirect wave in the first embodiment. FIG. 実施の形態１の同一性判定部による２円交点処理を説明する図であり、直接波の２円交点処理の例である。It is a figure explaining the 2-circle intersection process by the identity determination part of Embodiment 1, and is an example of the 2-circle intersection process of a direct wave. 実施の形態１の同一性判定部による２円交点処理を説明する図であり、直接波と間接波の２円交点処理の例である。It is a figure explaining the 2-circle intersection process by the identity determination part of Embodiment 1, and is an example of the 2-circle intersection process of a direct wave and an indirect wave. 実施の形態１の同一性判定部によるグルーピング処理結果を説明する図であり、障害物が壁または縁石等である場合を示す。It is a figure explaining the grouping process result by the identity determination part of Embodiment 1, and shows the case where an obstruction is a wall or a curb. 実施の形態１の同一性判定部によるグルーピング処理結果を説明する図であり、障害物が車止めである場合を示す。It is a figure explaining the grouping process result by the identity determination part of Embodiment 1, and shows the case where an obstruction is a car stop. 実施の形態１の同一性判定部によるグルーピング処理結果を説明する図であり、障害物がポールである場合を示す。It is a figure explaining the grouping process result by the identity determination part of Embodiment 1, and shows the case where an obstruction is a pole. 図１０Ａおよび図１０Ｂは、実施の形態１における直接波の強度の特性を示すグラフである。10A and 10B are graphs showing the characteristics of the intensity of the direct wave in the first embodiment. 実施の形態１に係る障害物検出装置の動作例を示すフローチャートである。4 is a flowchart illustrating an operation example of the obstacle detection apparatus according to the first embodiment.

以下、この発明をより詳細に説明するために、この発明を実施するための形態について、添付の図面に従って説明する。
実施の形態１．
図１は、実施の形態１に係る障害物検出装置１０の構成例を示すブロック図である。障害物検出装置１０は、第１の距離センサ１−１〜１−ｉ（ｉ≧２）と、第２の距離センサ２−１〜２−ｉと、送受信部１１と、同一性判定部１２と、高さ判定部１３とを備え、車両周辺に存在する障害物の高さを判定する。Hereinafter, in order to explain the present invention in more detail, modes for carrying out the present invention will be described with reference to the accompanying drawings.
Embodiment 1 FIG.
FIG. 1 is a block diagram illustrating a configuration example of an obstacle detection apparatus 10 according to the first embodiment. The obstacle detection device 10 includes a first distance sensor 1-1 to 1-i (i ≧ 2), a second distance sensor 2-1 to 2-i, a transmission / reception unit 11, and an identity determination unit 12. And a height determination unit 13 for determining the height of an obstacle existing around the vehicle.

なお、実施の形態１に係る障害物検出装置１０は、複数の第１の距離センサ１−１〜１−ｉおよび複数の第２の距離センサ２−１〜２−ｉを備える構成であるが、１つ以上の第１の距離センサ１−ｉ（ｉ≧１）および１つ以上の第２の距離センサ２−ｉ（ｉ≧１）を備える構成であればよい。また、第１の距離センサ１−ｉの個数と第２の距離センサ２−ｉの個数は、同一でもよいし異なってもよい。   The obstacle detection device 10 according to the first embodiment is configured to include a plurality of first distance sensors 1-1 to 1-i and a plurality of second distance sensors 2-1 to 2-i. What is necessary is just a structure provided with 1 or more 1st distance sensor 1-i (i> = 1) and 1 or more 2nd distance sensor 2-i (i> = 1). Further, the number of first distance sensors 1-i and the number of second distance sensors 2-i may be the same or different.

図２Ａおよび図２Ｂは、実施の形態１に係る障害物検出装置１０の構成例を示すハードウェア構成図である。障害物検出装置１０における送受信部１１、同一性判定部１２、および高さ判定部１３の各機能は、処理回路により実現される。即ち、障害物検出装置１０は、上記各機能を実現するための処理回路を備える。処理回路は、専用のハードウェアとしての処理回路２０であってもよいし、メモリ２２に格納されるプログラムを実行するプロセッサ２１であってもよい。処理回路２０、または、プロセッサ２１とメモリ２２は、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉに接続される。   2A and 2B are hardware configuration diagrams illustrating a configuration example of the obstacle detection apparatus 10 according to the first embodiment. The functions of the transmission / reception unit 11, the identity determination unit 12, and the height determination unit 13 in the obstacle detection device 10 are realized by a processing circuit. That is, the obstacle detection apparatus 10 includes a processing circuit for realizing the above functions. The processing circuit may be the processing circuit 20 as dedicated hardware or the processor 21 that executes a program stored in the memory 22. The processing circuit 20 or the processor 21 and the memory 22 are connected to the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i.

図２Ａに示すように、処理回路が専用のハードウェアである場合、処理回路２０は、例えば、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ＡＳＩＣ（Ａｐｐｌｉｃａｔｉｏｎ Ｓｐｅｃｉｆｉｃ Ｉｎｔｅｇｒａｔｅｄ Ｃｉｒｃｕｉｔ）、ＦＰＧＡ（Ｆｉｅｌｄ Ｐｒｏｇｒａｍｍａｂｌｅ Ｇａｔｅ Ａｒｒａｙ）、またはこれらを組み合わせたものが該当する。送受信部１１、同一性判定部１２、および高さ判定部１３の機能を複数の処理回路２０で実現してもよいし、各部の機能をまとめて１つの処理回路２０で実現してもよい。   As shown in FIG. 2A, when the processing circuit is dedicated hardware, the processing circuit 20 includes, for example, a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, and an ASIC (Application Specific Integrated Circuit). , FPGA (Field Programmable Gate Array), or a combination thereof. The functions of the transmission / reception unit 11, the identity determination unit 12, and the height determination unit 13 may be realized by a plurality of processing circuits 20, or the functions of the respective units may be realized by a single processing circuit 20.

図２Ｂに示すように、処理回路がプロセッサ２１である場合、送受信部１１、同一性判定部１２、および高さ判定部１３の各機能は、ソフトウェア、ファームウェア、またはソフトウェアとファームウェアとの組み合わせにより実現される。ソフトウェアまたはファームウェアはプログラムとして記述され、メモリ２２に格納される。プロセッサ２１は、メモリ２２に格納されたプログラムを読みだして実行することにより、各部の機能を実現する。即ち、障害物検出装置１０は、プロセッサ２１により実行されるときに、後述する図１５のフローチャートで示されるステップが結果的に実行されることになるプログラムを格納するためのメモリ２２を備える。また、このプログラムは、送受信部１１、同一性判定部１２、および高さ判定部１３の手順または方法をコンピュータに実行させるものであるとも言える。   As shown in FIG. 2B, when the processing circuit is a processor 21, the functions of the transmission / reception unit 11, the identity determination unit 12, and the height determination unit 13 are realized by software, firmware, or a combination of software and firmware. Is done. Software or firmware is described as a program and stored in the memory 22. The processor 21 reads out and executes the program stored in the memory 22, thereby realizing the functions of the respective units. That is, the obstacle detection apparatus 10 includes a memory 22 for storing a program that, when executed by the processor 21, results in the steps shown in the flowchart of FIG. It can also be said that this program causes a computer to execute the procedures or methods of the transmission / reception unit 11, the identity determination unit 12, and the height determination unit 13.

ここで、プロセッサ２１とは、ＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）、処理装置、演算装置、マイクロプロセッサ、またはマイクロコンピュータ等のことである。
メモリ２２は、ＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）、ＥＰＲＯＭ（Ｅｒａｓａｂｌｅ Ｐｒｏｇｒａｍｍａｂｌｅ ＲＯＭ）、またはフラッシュメモリ等の不揮発性もしくは揮発性の半導体メモリであってもよいし、ハードディスクまたはフレキシブルディスク等の磁気ディスクであってもよいし、ＣＤ（Ｃｏｍｐａｃｔ Ｄｉｓｃ）またはＤＶＤ（Ｄｉｇｉｔａｌ Ｖｅｒｓａｔｉｌｅ Ｄｉｓｃ）等の光ディスクであってもよい。Here, the processor 21 is a CPU (Central Processing Unit), a processing device, an arithmetic device, a microprocessor, a microcomputer, or the like.
The memory 22 may be a RAM (Random Access Memory), a ROM (Read Only Memory), an EPROM (Erasable Programmable ROM), or a nonvolatile or volatile semiconductor memory such as a flash memory, a hard disk, a flexible disk, or the like. The magnetic disk may be an optical disk such as a CD (Compact Disc) or a DVD (Digital Versatile Disc).

なお、送受信部１１、同一性判定部１２、および高さ判定部１３の各機能について、一部を専用のハードウェアで実現し、一部をソフトウェアまたはファームウェアで実現するようにしてもよい。このように、障害物検出装置１０における処理回路は、ハードウェア、ソフトウェア、ファームウェア、またはこれらの組み合わせによって、上述の各機能を実現することができる。   In addition, about each function of the transmission / reception part 11, the identity determination part 12, and the height determination part 13, a part may be implement | achieved by exclusive hardware and a part may be implement | achieved by software or firmware. As described above, the processing circuit in the obstacle detection apparatus 10 can realize the above-described functions by hardware, software, firmware, or a combination thereof.

図３は、実施の形態１における第１の距離センサ１−１，１−２および第２の距離センサ２−１，２−２の車両設置例を示す図である。車両の左右方向をＸ軸、上下方向をＹ軸、前後方向をＺ軸とする。
第２の距離センサ２−１，２−２は、車両の前面または後面等に、横一列に並べて設置される。第２の距離センサ２−１，２−２は、縁石および車止め等の低い障害物を検出可能な高さに設置される。第１の距離センサ１−１，１−２は、第２の距離センサ２−１，２−２より高い位置に、横一列に並べて設置される。図３では、Ｘ軸方向において第１の距離センサ１−１，第２の距離センサ２−１、第２の距離センサ２−２、および第１の距離センサ１−２の順に並べて設置されているが、並び順は任意でよい。第１の距離センサ１−１，１−２および第２の距離センサ２−１，２−２は、探査波として超音波または電波等を送信し、車両周辺の障害物で反射した探査波である反射波を受信する。以下では、これらの距離センサが超音波センサであるものとする。FIG. 3 is a diagram illustrating a vehicle installation example of the first distance sensors 1-1 and 1-2 and the second distance sensors 2-1 and 2-2 in the first embodiment. The left-right direction of the vehicle is the X axis, the up-down direction is the Y-axis, and the front-rear direction is the Z-axis.
The second distance sensors 2-1 and 2-2 are installed side by side on the front or rear surface of the vehicle. The second distance sensors 2-1 and 2-2 are installed at a height at which low obstacles such as curbs and car stops can be detected. The first distance sensors 1-1 and 1-2 are installed side by side in a position higher than the second distance sensors 2-1 and 2-2. In FIG. 3, the first distance sensor 1-1, the second distance sensor 2-1, the second distance sensor 2-2, and the first distance sensor 1-2 are arranged in this order in the X-axis direction. However, the arrangement order may be arbitrary. The first distance sensors 1-1 and 1-2 and the second distance sensors 2-1 and 2-2 transmit ultrasonic waves or radio waves as exploration waves, and are exploration waves reflected by obstacles around the vehicle. Receive a reflected wave. Hereinafter, it is assumed that these distance sensors are ultrasonic sensors.

図４は、実施の形態１における直接波と間接波を説明する図である。ここでは、第１の距離センサ１−１と第２の距離センサ２−１の２個を例示する。
第１の距離センサ１−１が送信した超音波の反射波をこの第１の距離センサ１−１が受信する場合、第１の距離センサ１−１が受信した反射波を「直接波」と呼ぶ。一方、第１の距離センサ１−１と第２の距離センサ２−１のうち、第１の距離センサ１−１を送信用、第２の距離センサ２−１を受信用とする場合、第２の距離センサ２−１が受信した反射波を「間接波」と呼ぶ。なお、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉのうち、送信用および受信用となる距離センサの組み合わせは自由である。例えば、時間の経過とともに、送信用および受信用となる距離センサの組み合わせが変更される。FIG. 4 is a diagram illustrating a direct wave and an indirect wave in the first embodiment. Here, two of the first distance sensor 1-1 and the second distance sensor 2-1 are illustrated.
When the first distance sensor 1-1 receives an ultrasonic reflected wave transmitted by the first distance sensor 1-1, the reflected wave received by the first distance sensor 1-1 is referred to as a “direct wave”. Call. On the other hand, of the first distance sensor 1-1 and the second distance sensor 2-1, when the first distance sensor 1-1 is for transmission and the second distance sensor 2-1 is for reception, The reflected wave received by the second distance sensor 2-1 is referred to as an “indirect wave”. Of the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i, combinations of distance sensors for transmission and reception are free. For example, with the passage of time, the combination of distance sensors for transmission and reception is changed.

送受信部１１は、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉの少なくとも１つから探査波を送信させ、この探査波が障害物で反射した反射波を第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉの少なくとも１つに受信させる。そして、送受信部１１は、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉから、超音波の送信から反射波の受信までの時間に基づく距離情報、および反射波の受信強度を取得し、同一性判定部１２へ出力する。   The transmission / reception unit 11 transmits an exploration wave from at least one of the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i, and the exploration wave is reflected by an obstacle. The reflected wave is received by at least one of the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i. And the transmission / reception part 11 is distance information based on the time from transmission of an ultrasonic wave to reception of a reflected wave from the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i. , And the received intensity of the reflected wave are acquired and output to the identity determination unit 12.

図５は、実施の形態１の同一性判定部１２による２円交点処理を説明する図であり、直接波の２円交点処理の例である。２円交点処理は、開口合成処理とも言う。
同一性判定部１２は、送受信部１１から受け取る直接波の距離情報を用いて２円交点処理を行い、超音波が反射した反射点のＸ−Ｚ平面上の位置、つまり車両の前後左右方向の２次元座標上の位置を算出する。なお、Ｘ−Ｚ平面が設定されるＹ軸位置は、例えば、第１の距離センサ１−１の高さと第２の距離センサ２−１の高さの中間の位置である。図５の例では、同一性判定部１２は、第１の距離センサ１−１と第２の距離センサ２−１の各直接波の距離情報に基づいて、第１の距離センサ１−１を中心とする円Ａ１と第２の距離センサ２−２を中心とする円Ａ２との交点を求めて反射点Ａ３とする。FIG. 5 is a diagram for explaining the two-circle intersection process by the identity determination unit 12 of the first embodiment, and is an example of the two-wave intersection process for a direct wave. The two-circle intersection process is also referred to as an aperture synthesis process.
The identity determination unit 12 performs two-circle intersection processing using the direct wave distance information received from the transmission / reception unit 11, and the position of the reflection point on which the ultrasonic wave is reflected on the XZ plane, that is, in the front-rear and left-right directions of the vehicle. A position on a two-dimensional coordinate is calculated. Note that the Y-axis position where the XZ plane is set is, for example, an intermediate position between the height of the first distance sensor 1-1 and the height of the second distance sensor 2-1. In the example of FIG. 5, the identity determination unit 12 determines the first distance sensor 1-1 based on the distance information of each direct wave of the first distance sensor 1-1 and the second distance sensor 2-1. An intersection point between the circle A1 having the center and the circle A2 having the second distance sensor 2-2 as the center is obtained and set as a reflection point A3.

図６は、実施の形態１の同一性判定部１２による２円交点処理を説明する図であり、直接波と間接波の２円交点処理の例である。
同一性判定部１２は、送受信部１１から受け取る直接波と間接波の距離情報を用いて２円交点処理を行い、Ｘ−Ｚ平面上の反射点の位置を算出する。図６の例では、送受信部１１は、第１の距離センサ１−１の直接波の距離情報と第１の距離センサ１−１および第２の距離センサ２−１間の間接波の距離情報とに基づいて、第１の距離センサ１−１を中心とする円Ａ１と第１の距離センサ１−１および第２の距離センサ２−１を焦点とする楕円Ｂ１との交点を求めて反射点Ｂ２とする。また、同一性判定部１２は、第２の距離センサ２−１の直接波の距離情報と第１の距離センサ１−１および第２の距離センサ２−１間の間接波の距離情報とに基づいて、第２の距離センサ２−１を中心とする円Ａ２と第１の距離センサ１−１および第２の距離センサ２−１を焦点とする楕円Ｂ１との交点を求めて反射点Ｂ３とする。FIG. 6 is a diagram for explaining the two-circle intersection process by the identity determination unit 12 of the first embodiment, and is an example of the two-circle intersection process of a direct wave and an indirect wave.
The identity determination unit 12 performs a two-circle intersection process using the distance information of the direct wave and the indirect wave received from the transmission / reception unit 11 and calculates the position of the reflection point on the XZ plane. In the example of FIG. 6, the transmission / reception unit 11 includes the distance information of the direct wave of the first distance sensor 1-1 and the distance information of the indirect wave between the first distance sensor 1-1 and the second distance sensor 2-1. And the intersection of the circle A1 centered on the first distance sensor 1-1 and the ellipse B1 focused on the first distance sensor 1-1 and the second distance sensor 2-1, is reflected. Let it be point B2. Further, the identity determination unit 12 uses the direct wave distance information of the second distance sensor 2-1 and the indirect wave distance information between the first distance sensor 1-1 and the second distance sensor 2-1. Based on this, the intersection point of the circle A2 centered on the second distance sensor 2-1 and the ellipse B1 focusing on the first distance sensor 1-1 and the second distance sensor 2-1 is obtained, and the reflection point B3. And

同一性判定部１２は、隣り合う反射点Ａ３から反射点Ｂ２までの反射点間距離Ｌ１が予め定められた距離以下である場合、反射点Ａ３，Ｂ２は同一の障害物で反射したことを特定し、反射点Ａ３，Ｂ２を同じグループに分類する。また、同一性判定部１２は、隣り合う反射点Ａ３から反射点Ｂ３までの反射点間距離Ｌ２が予め定められた距離以下である場合、反射点Ａ３，Ｂ３は同一の障害物で反射したことを特定し、反射点Ａ３，Ｂ３を同じグループに分類する。なお、予め定められた距離は、隣接する距離センサ間の距離などに基づいて設定された値である。   The identity determination unit 12 specifies that the reflection points A3 and B2 are reflected by the same obstacle when the distance L1 between the reflection points from the adjacent reflection point A3 to the reflection point B2 is equal to or less than a predetermined distance. Then, the reflection points A3 and B2 are classified into the same group. In addition, the identity determination unit 12 indicates that the reflection points A3 and B3 are reflected by the same obstacle when the distance L2 between the reflection points from the adjacent reflection point A3 to the reflection point B3 is equal to or less than a predetermined distance. And the reflection points A3 and B3 are classified into the same group. The predetermined distance is a value set based on the distance between adjacent distance sensors.

図７〜図９は、実施の形態１の同一性判定部１２によるグルーピング処理結果を説明する図である。図７に示されるように障害物が壁または縁石等である場合、反射点が直線状に分布したグループＣ１が得られる。図８に示されるように障害物が車止めである場合、反射点が直線状に分布した２つのグループＣ２，Ｃ３が得られる。図９に示されるように障害物がポールである場合、反射点が１か所に集中したグループＣ４が得られる。なお、図７〜図９においてグループＣ１〜Ｃ４に分類されなかった反射点は図示されていない。   7 to 9 are diagrams for explaining the grouping processing results by the identity determination unit 12 of the first embodiment. As shown in FIG. 7, when the obstacle is a wall or a curb or the like, a group C1 in which reflection points are linearly distributed is obtained. As shown in FIG. 8, when the obstacle is a car stop, two groups C2 and C3 in which reflection points are linearly distributed are obtained. As shown in FIG. 9, when the obstacle is a pole, a group C4 in which reflection points are concentrated in one place is obtained. In addition, the reflective points which were not classified into groups C1-C4 in FIGS. 7-9 are not shown in figure.

以上のように、同一性判定部１２は、直接波と間接波とを用いたグルーピング処理を行うことにより、障害物を検出する。
これ以降の処理では、同一性判定部１２は、直接波のみを使用する。As described above, the identity determination unit 12 detects an obstacle by performing a grouping process using a direct wave and an indirect wave.
In subsequent processing, the identity determination unit 12 uses only direct waves.

同一性判定部１２は、第１の距離センサ１−１〜１−ｉの直接波と第２の距離センサ２−１〜２−ｉの直接波が同一の障害物で反射した直接波であるかどうかを判定する。同一性判定部１２は、判定結果と直接波の強度とを高さ判定部１３へ出力する。   The identity determination unit 12 is a direct wave in which the direct wave of the first distance sensors 1-1 to 1-i and the direct wave of the second distance sensors 2-1 to 2-i are reflected by the same obstacle. Determine whether or not. The identity determination unit 12 outputs the determination result and the intensity of the direct wave to the height determination unit 13.

例えば、図７に示されるグループＣ１には、直接波同士の２円交点処理によって算出された反射点と、直接波と間接波との２円交点処理によって算出された反射点とが混在している。同一性判定部１２は、グループＣ１に含まれる反射点の中から直接波同士の２円交点処理によって算出された反射点を抽出し、抽出した反射点の算出に用いられた直接波をグループＣ１の障害物で反射した直接波であると判定する。   For example, the group C1 shown in FIG. 7 includes a mixture of reflection points calculated by the two-circle intersection process between direct waves and reflection points calculated by the two-circle intersection process of the direct wave and the indirect wave. Yes. The identity determination unit 12 extracts the reflection points calculated by the two-circle intersection process between the direct waves from the reflection points included in the group C1, and the direct waves used for calculating the extracted reflection points are extracted from the group C1. It is determined that the wave is a direct wave reflected by the obstacle.

また、例えば図８に示されるグループＣ２，Ｃ３の場合、同一性判定部１２は、グループＣ２の障害物で反射した直接波と、グループＣ３の障害物で反射した直接波とを、互いに異なる障害物で反射した直接波であるものとして区別する。   Further, for example, in the case of the groups C2 and C3 shown in FIG. 8, the identity determination unit 12 determines that the direct wave reflected by the obstacle of the group C2 and the direct wave reflected by the obstacle of the group C3 are different from each other. Distinguish as a direct wave reflected by an object.

さらに、例えば図９に示されるグループＣ４の場合、グループＣ４の障害物から離れた位置にある第１の距離センサ１−１の直接波の距離情報と、グループＣ４の障害物の正面にある第２の距離センサ２−２の直接波の距離情報とには差がある。しかしながら、第１の距離センサ１−１の直接波も第２の距離センサ２−２の直接波も反射点としてはグループＣ４に分類されているため、同一性判定部１２は、いずれの直接波もグループＣ４の障害物で反射した直接波であると判定する。   Further, for example, in the case of the group C4 shown in FIG. 9, the distance information of the direct wave of the first distance sensor 1-1 located away from the obstacle of the group C4 and the first information in front of the obstacle of the group C4. There is a difference between the distance information of the direct wave of the distance sensor 2-2 of No. 2. However, since the direct wave of the first distance sensor 1-1 and the direct wave of the second distance sensor 2-2 are classified as the reflection points in the group C4, the identity determination unit 12 does not recognize any direct wave. Is also determined to be a direct wave reflected by an obstacle of group C4.

このように、同一性判定部１２によれば、第１の距離センサ１−１〜１−ｉの直接波の距離情報と第２の距離センサ２−１〜２−ｉの直接波の距離情報との差が大きくなる場合でも、同一の障害物で反射した直接波であることを判定できる。これにより、障害物検出装置１０は、後述する高さ判定部１３による直接波を用いた障害物の高さ判定の精度を向上させることができる。距離センサ間での距離情報の差が大きくなる障害物の例としては、ポールのような幅が狭い障害物、ならびに、縁石および車止め等のような低い障害物等がある。   Thus, according to the identity determination unit 12, the direct wave distance information of the first distance sensors 1-1 to 1-i and the direct wave distance information of the second distance sensors 2-1 to 2-i. It can be determined that the wave is a direct wave reflected by the same obstacle. Thereby, the obstacle detection apparatus 10 can improve the accuracy of the height determination of the obstacle using the direct wave by the height determination unit 13 described later. Examples of obstacles that increase the difference in distance information between distance sensors include narrow obstacles such as poles, and low obstacles such as curbs and car stops.

図１０は、実施の形態１における直接波の強度の特性を示すグラフである。図１０Ａは、第１の距離センサ１−１〜１−ｉの直接波の強度の波形と第２の距離センサ２−１〜２−ｉの直接波の強度の波形を示すグラフである。グラフの縦軸は、距離センサが受信した直接波の強度であり、横軸は、距離センサから障害物までの距離ｄである。図１０Ｂは、第１の距離センサ１−１〜１−ｉの直接波と第２の距離センサ２−１〜２−ｉの直接波との強度比の波形を示すグラフである。   FIG. 10 is a graph showing the characteristics of the direct wave intensity in the first embodiment. FIG. 10A is a graph showing the waveform of the direct wave intensity of the first distance sensors 1-1 to 1-i and the waveform of the direct wave intensity of the second distance sensors 2-1 to 2-i. The vertical axis of the graph is the intensity of the direct wave received by the distance sensor, and the horizontal axis is the distance d from the distance sensor to the obstacle. FIG. 10B is a graph showing a waveform of an intensity ratio between the direct waves of the first distance sensors 1-1 to 1-i and the direct waves of the second distance sensors 2-1 to 2-i.

図１０Ａに示されるように、ポールおよび壁等の高い障害物で反射した直接波は、距離ｄが大きくなる従って強度が小さくなる傾向があり、減衰係数は約１２ｄＢ／ｍである。また、第１の距離センサ１−１〜１−ｉの直接波の強度と第２の距離センサ２−１〜２−ｉの直接波の強度は同等レベルになる。参考までに、第１の距離センサ１−１〜１−ｉと第２の距離センサ２−１〜２−ｉとは設置高さが異なるため、第１の距離センサ１−１〜１−ｉの直接波に比べて、第２の距離センサ２−１〜２−ｉの直接波のほうが、若干強度が大きい。
一方、縁石および車止め等の低い障害物で反射した直接波は、距離ｄに対して極大値をもつカーブを描き、距離ｄが小さくなると第１の距離センサ１−１〜１−ｉの直接波の強度と第２の距離センサ２−１〜２−ｉの直接波の強度とに差異が生じる。この差異の大きさは、距離センサの検出範囲の違い、つまり距離センサの設置位置および設置角度等により異なる。As shown in FIG. 10A, a direct wave reflected by a high obstacle such as a pole and a wall tends to decrease in intensity as the distance d increases, and the attenuation coefficient is about 12 dB / m. In addition, the direct wave intensity of the first distance sensors 1-1 to 1-i and the direct wave intensity of the second distance sensors 2-1 to 2-i are at the same level. For reference, the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i have different installation heights. Compared with the direct wave, the direct wave of the second distance sensors 2-1 to 2-i has a slightly higher intensity.
On the other hand, a direct wave reflected by a low obstacle such as a curb or a car stop draws a curve having a maximum value with respect to the distance d, and when the distance d decreases, the direct wave of the first distance sensors 1-1 to 1-i. And the intensity of the direct waves of the second distance sensors 2-1 to 2-i are different. The magnitude of this difference varies depending on the difference in the detection range of the distance sensor, that is, the installation position and installation angle of the distance sensor.

直接波の強度には上述したような特性があるため、第１の距離センサ１−１〜１−ｉの直接波の強度を第２の距離センサ２−１〜２−ｉの直接波の強度で除算した強度比は、図１０Ｂに示されるように、高い障害物については距離ｄによらず約１となる。
一方、低い障害物については、距離ｄが大きいときは強度比が約１となり、距離ｄが小さいときは強度比が大幅に小さい値となる。Since the intensity of the direct wave has the characteristics as described above, the intensity of the direct wave of the first distance sensors 1-1 to 1-i is changed to the intensity of the direct wave of the second distance sensors 2-1 to 2-i. As shown in FIG. 10B, the intensity ratio divided by is about 1 for a high obstacle regardless of the distance d.
On the other hand, for a low obstacle, the intensity ratio is about 1 when the distance d is large, and the intensity ratio is a significantly small value when the distance d is small.

高さ判定部１３は、強度比が約１である場合に、直接波を反射した障害物が高い障害物であると判定し、強度比が１未満である場合に、直接波を反射した障害物が低い障害物であると判定する。図１０Ｂの例では、高さ判定部１３は、距離ｄが判定距離内である場合に、予め定められた閾値ＴＨ１（例えば、０．８）と強度比とを比較し、強度比が閾値ＴＨ１以上である場合に直接波を反射した障害物が高い障害物であると判定し、強度比が閾値ＴＨ１未満である場合に直接波を反射した障害物が低い障害物であると判定する。閾値ＴＨ１は、距離センサの設置位置および設置角度等に基づいて予め設定される。   The height determination unit 13 determines that the obstacle that directly reflected the wave is a high obstacle when the intensity ratio is about 1, and the obstacle that reflected the direct wave when the intensity ratio is less than 1. It is determined that the object is a low obstacle. In the example of FIG. 10B, when the distance d is within the determination distance, the height determination unit 13 compares a predetermined threshold TH1 (for example, 0.8) with an intensity ratio, and the intensity ratio is the threshold TH1. When the above is true, it is determined that the obstacle that directly reflects the wave is a high obstacle, and when the intensity ratio is less than the threshold value TH1, the obstacle that directly reflects the wave is determined to be a low obstacle. The threshold value TH1 is set in advance based on the installation position and installation angle of the distance sensor.

なお、高さ判定部１３は、平均化処理した直接波の強度を用いて高さ判定を行ってもよい。
例えば、高さ判定部１３は、第１の距離センサ１−１および第２の距離センサ２−１の直接波の強度比と、第１の距離センサ１−２と第２の距離センサ２−２の直接波の強度比とを用いて平均強度比を算出し、平均強度比を閾値ＴＨ１と比較してもよい。
あるいは、高さ判定部１３は、第１の距離センサ１−１と第２の距離センサ２−２の直接波の強度比と、第１の距離センサ１−２と第２の距離センサ２−１の直接波の強度比とを用いて平均強度比を算出し、平均強度比を閾値ＴＨ１と比較してもよい。The height determination unit 13 may perform the height determination using the intensity of the direct wave that has been subjected to the averaging process.
For example, the height determination unit 13 determines the intensity ratio of the direct waves of the first distance sensor 1-1 and the second distance sensor 2-1, and the first distance sensor 1-2 and the second distance sensor 2-. The average intensity ratio may be calculated using the intensity ratio of the direct wave of 2, and the average intensity ratio may be compared with the threshold value TH1.
Alternatively, the height determination unit 13 is configured so that the direct wave intensity ratio between the first distance sensor 1-1 and the second distance sensor 2-2, and the first distance sensor 1-2 and the second distance sensor 2- The average intensity ratio may be calculated using the direct wave intensity ratio of 1, and the average intensity ratio may be compared with the threshold value TH1.

また、高さ判定部１３は、同一性判定部１２により算出された直接波の反射点が、車両左右方向に分布している場合、つまり障害物が壁、縁石または車止め等である場合、障害物の高さ判定を行い、直接波の反射点が一点に集中している場合、つまり障害物がポール等である場合、直接波の強度を補正し、補正した強度を用いて障害物の高さ判定を行ってもよい。   In addition, the height determination unit 13 determines whether the direct wave reflection points calculated by the identity determination unit 12 are distributed in the left-right direction of the vehicle, that is, if the obstacle is a wall, a curb, a car stop, etc. When the height of the object is judged and the reflection points of the direct wave are concentrated at one point, that is, when the obstacle is a pole, etc., the intensity of the direct wave is corrected and the height of the obstacle is corrected using the corrected intensity. The determination may be made.

具体的には、高さ判定部１３は、第１の距離センサ１−１〜１−ｉの直接波の距離情報から第２の距離センサ２−１〜２−ｉの直接波の距離情報を減算し、距離差分値を算出する。高さ判定部１３は、算出した距離差分値と予め定められた閾値ＴＨ２とを比較し、距離差分値が閾値ＴＨ２より大きい場合は強度を補正せず、距離差分値が閾値ＴＨ２以下の場合は強度を補正する。閾値ＴＨ２は、直接波の距離情報に基づいてポールのような幅の狭い障害物を判定するための値であり、高さ判定部１３に対して予め与えられている。高さ判定部１３は、第１の距離センサ１−ｉまたは第２の距離センサ２−ｉの少なくとも一方の直接波の強度に対して、第１の距離センサ１−ｉまたは第２の距離センサ２−ｉの少なくとも一方の直接波の距離情報に応じた減衰係数１２ｄＢ／ｍの重み付け処理を行うことにより、強度を補正する。この補正により、高さ判定の信頼性を向上させることができる。   Specifically, the height determination unit 13 obtains the direct wave distance information of the second distance sensors 2-1 to 2-i from the direct wave distance information of the first distance sensors 1-1 to 1-i. Subtract and calculate the distance difference value. The height determination unit 13 compares the calculated distance difference value with a predetermined threshold value TH2. If the distance difference value is greater than the threshold value TH2, the height is not corrected. If the distance difference value is equal to or less than the threshold value TH2, Correct the intensity. The threshold value TH2 is a value for determining a narrow obstacle such as a pole based on the distance information of the direct wave, and is given to the height determination unit 13 in advance. The height determination unit 13 uses the first distance sensor 1-i or the second distance sensor for the intensity of the direct wave of at least one of the first distance sensor 1-i or the second distance sensor 2-i. The intensity is corrected by performing a weighting process with an attenuation coefficient of 12 dB / m according to distance information of at least one direct wave of 2-i. This correction can improve the reliability of height determination.

なお、高さ判定部１３は、平均化処理した距離差分値を用いて閾値との比較を行ってもよい。
例えば、高さ判定部１３は、第１の距離センサ１−１および第２の距離センサ２−１の直接波の距離差分値と、第１の距離センサ１−２と第２の距離センサ２−２の直接波の距離差分値とを用いて平均距離差分値を算出し、平均距離差分値を閾値ＴＨ２と比較してもよい。
あるいは、高さ判定部１３は、第１の距離センサ１−１と第２の距離センサ２−２の直接波の距離差分値と、第１の距離センサ１−２と第２の距離センサ２−１の直接波の距離差分値とを用いて平均距離差分値を算出し、平均距離差分値を閾値ＴＨ２と比較してもよい。The height determination unit 13 may perform comparison with a threshold value using the averaged distance difference value.
For example, the height determination unit 13 includes the direct wave distance difference value between the first distance sensor 1-1 and the second distance sensor 2-1, and the first distance sensor 1-2 and the second distance sensor 2. The average distance difference value may be calculated using the direct wave distance difference value of -2, and the average distance difference value may be compared with the threshold value TH2.
Alternatively, the height determination unit 13 may detect the distance difference value of the direct wave between the first distance sensor 1-1 and the second distance sensor 2-2, and the first distance sensor 1-2 and the second distance sensor 2. The average distance difference value may be calculated using the -1 direct wave distance difference value, and the average distance difference value may be compared with the threshold value TH2.

図１１は、実施の形態１に係る障害物検出装置１０の動作例を示すフローチャートである。障害物検出装置１０は、車両の走行中および停止中にかかわらず図１１のフローチャートに示される動作を繰り返し行う。   FIG. 11 is a flowchart illustrating an operation example of the obstacle detection apparatus 10 according to the first embodiment. The obstacle detection device 10 repeatedly performs the operation shown in the flowchart of FIG. 11 regardless of whether the vehicle is traveling or stopped.

ステップＳＴ１において、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉは、送受信部１１からの指示に従って超音波を送受信する。
ステップＳＴ２において、送受信部１１は、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉが受信した反射波を収集し、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉのどれが送信用でどれが受信用として使用されたかを示す情報を用いて、収集した反射波を直接波と間接波とに分別する。
ステップＳＴ３において、送受信部１１は、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉから反射波を収集できた場合（ステップＳＴ３“ＹＥＳ”）、車両周辺に障害物があると判定してステップＳＴ４へ進む。一方、送受信部１１は、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉから反射波を収集できなかった場合（ステップＳＴ３“ＮＯ”）、車両周辺に障害物が存在しないと判定して、図１１のフローチャートに示される動作を終了する。In step ST <b> 1, the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i transmit and receive ultrasonic waves according to instructions from the transmission / reception unit 11.
In step ST2, the transmission / reception unit 11 collects the reflected waves received by the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i, and the first distance sensor 1- 1-1-i and the second distance sensors 2-1 to 2-i are used to transmit and the collected reflected waves are classified into direct waves and indirect waves using information indicating which is used for transmission and which is used for reception. Sort into.
In step ST3, the transmission / reception unit 11 can collect reflected waves from the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i (step ST3 “YES”). It is determined that there are obstacles around the vehicle, and the process proceeds to step ST4. On the other hand, when the transmission / reception unit 11 cannot collect the reflected waves from the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i (step ST3 “NO”), the vehicle It is determined that there are no obstacles in the vicinity, and the operation shown in the flowchart of FIG. 11 is terminated.

ステップＳＴ４において、同一性判定部１２は、送受信部１１により分別された直接波と間接波の距離情報を用いて２円交点処理を行い、反射点の位置を算出する。
ステップＳＴ５において、同一性判定部１２は、算出した反射点の位置に基づいて反射点のグルーピング処理を行い、反射点を障害物ごとに分類する。
ステップＳＴ６において、同一性判定部１２は、第１の距離センサ１−１〜１−ｉの直接波および第２の距離センサ２−１〜２−ｉの直接波を、同一の障害物で反射した直接波ごとに分別する。In step ST <b> 4, the identity determination unit 12 performs a 2-circle intersection process using the distance information of the direct wave and the indirect wave separated by the transmission / reception unit 11, and calculates the position of the reflection point.
In step ST5, the identity determination unit 12 performs a reflection point grouping process based on the calculated position of the reflection point, and classifies the reflection point for each obstacle.
In step ST6, the identity determination unit 12 reflects the direct waves of the first distance sensors 1-1 to 1-i and the direct waves of the second distance sensors 2-1 to 2-i with the same obstacle. Sort each direct wave.

高さ判定部１３は、以下に説明するステップＳＴ７〜ＳＴ１５の処理を、同一性判定部１２により分類された障害物の数だけ、繰り返し行う。   The height determination unit 13 repeatedly performs the processes of steps ST7 to ST15 described below for the number of obstacles classified by the identity determination unit 12.

ステップＳＴ７において、高さ判定部１３は、同一性判定部１２により分類された同一の障害物について、距離センサからその障害物までの距離が図１０Ｂに示される判定距離未満であるか否かを判定する。高さ判定部１３は、その障害物までの距離が判定距離未満である場合（ステップＳＴ７“ＹＥＳ”）、ステップＳＴ８へ進み、判定距離以上である場合（ステップＳＴ７“ＮＯ”）、その障害物について図１１のフローチャートに示される動作を終了する。   In step ST7, the height determination unit 13 determines whether the distance from the distance sensor to the obstacle is less than the determination distance shown in FIG. 10B for the same obstacles classified by the identity determination unit 12. judge. If the distance to the obstacle is less than the determination distance (step ST7 “YES”), the height determination unit 13 proceeds to step ST8. If the distance is greater than the determination distance (step ST7 “NO”), the obstacle The operation shown in the flowchart of FIG.

ステップＳＴ８において、高さ判定部１３は、同一性判定部１２が直接波の距離情報を用いて算出した反射点の分布に基づいて、以降の処理方法を判定する。高さ判定部１３は、反射点が車両左右方向に分布している場合、つまり障害物が壁、縁石または車止め等である場合、ステップＳＴ９へ進み、反射点が一点に集中している場合、つまり障害物がポール等である場合、ステップＳＴ１３へ進む。   In step ST8, the height determination unit 13 determines the subsequent processing method based on the distribution of reflection points calculated by the identity determination unit 12 using the direct wave distance information. When the reflection points are distributed in the left-right direction of the vehicle, that is, when the obstacle is a wall, a curb or a car stop, the height determination unit 13 proceeds to step ST9, and when the reflection points are concentrated on one point, That is, when the obstacle is a pole or the like, the process proceeds to step ST13.

ステップＳＴ９において、高さ判定部１３は、上記障害物について、第１の距離センサ１−１〜１−ｉの直接波と第２の距離センサ２−１〜２−ｉの直接波との強度比を算出する。
ステップＳＴ１０において、高さ判定部１３は、算出した強度比が閾値ＴＨ１未満である場合（ステップＳＴ１０“ＹＥＳ”）、ステップＳＴ１１へ進み、強度比が閾値ＴＨ１以上である場合（ステップＳＴ１０“ＮＯ”）、ステップＳＴ１２へ進む。
ステップＳＴ１１において、高さ判定部１３は、上記障害物を、縁石等の低い障害物であると判定する。
ステップＳＴ１２において、高さ判定部１３は、上記障害物を、壁等の高い障害物であると判定する。In step ST9, the height determination unit 13 intensifies the direct wave of the first distance sensors 1-1 to 1-i and the direct wave of the second distance sensors 2-1 to 2-i for the obstacle. Calculate the ratio.
In step ST10, when the calculated intensity ratio is less than the threshold value TH1 (step ST10 “YES”), the height determination unit 13 proceeds to step ST11, and when the intensity ratio is equal to or greater than the threshold value TH1 (step ST10 “NO”). ), Go to step ST12.
In step ST11, the height determination unit 13 determines that the obstacle is a low obstacle such as a curb.
In step ST12, the height determination unit 13 determines that the obstacle is a high obstacle such as a wall.

ステップＳＴ１３において、高さ判定部１３は、上記障害物について、第１の距離センサ１−１〜１−ｉの直接波と第２の距離センサ２−１〜２−ｉの直接波との距離差分値を算出する。
ステップＳＴ１４において、高さ判定部１３は、算出した距離差分値が閾値ＴＨ２より大きい場合（ステップＳＴ１４“ＹＥＳ”）、ステップＳＴ９へ進み、距離差分値が閾値ＴＨ２以下である場合（ステップＳＴ１４“ＮＯ”）、つまり上記障害物がポール等の幅の狭い障害物である場合にステップＳＴ１５へ進む。In step ST13, the height determination unit 13 determines the distance between the direct wave of the first distance sensors 1-1 to 1-i and the direct wave of the second distance sensors 2-1 to 2-i for the obstacle. The difference value is calculated.
In step ST14, the height determination unit 13 proceeds to step ST9 when the calculated distance difference value is larger than the threshold value TH2 (step ST14 “YES”), and when the distance difference value is equal to or less than the threshold value TH2 (step ST14 “NO”). ”), That is, when the obstacle is a narrow obstacle such as a pole, the process proceeds to step ST15.

ステップＳＴ１５において、高さ判定部１３は、上記障害物について、第１の距離センサ１−１〜１−ｉが受信した直接波の強度または第２の距離センサ２−１〜２−ｉが受信した直接波の強度の少なくとも一方を補正し、ステップＳＴ９へ進む。   In step ST15, the height determination unit 13 receives the intensity of the direct wave received by the first distance sensors 1-1 to 1-i or the second distance sensors 2-1 to 2-i for the obstacle. At least one of the direct wave intensities is corrected, and the process proceeds to step ST9.

なお、ステップＳＴ８，ＳＴ１３〜ＳＴ１５の処理は必須ではない。   Note that the processing of steps ST8 and ST13 to ST15 is not essential.

以上のように、実施の形態１に係る障害物検出装置１０は、第１の距離センサ１−１〜１−ｉと、第２の距離センサ２−１〜２−ｉと、送受信部１１と、同一性判定部１２と、高さ判定部１３とを備える。第１の距離センサ１−１〜１−ｉは、車両に設置される。第２の距離センサ２−１〜２−ｉは、第１の距離センサ１−１〜１−ｉの設置高さよりも低い位置に設置される。送受信部１１は、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉから探査波を送信させ障害物で反射した探査波である反射波を受信させて距離情報および反射波の強度を取得する。同一性判定部１２は、第１の距離センサ１−１〜１−ｉの距離情報および第２の距離センサ２−１〜２−ｉの距離情報に基づき、第１の距離センサ１−１〜１−ｉの反射波および第２の距離センサ２−１〜２−ｉの反射波が同一の障害物で反射した直接波であることを判定する。高さ判定部１３は、同一性判定部１２により同一の障害物で反射した直接波であると特定された第１の距離センサ１−１〜１−ｉの直接波と第２の距離センサ２−１〜２−ｉの直接波との強度比に基づき、同一の障害物の高さを判定する。異なる高さに設置された第１の距離センサ１−１〜１−ｉと第２の距離センサ２−１〜２−ｉにより受信された直接波の強度比を用いるようにしたので、車両が走行している場合だけでなく停止している場合にも、障害物の高さを判定することができる。また、同一の障害物で反射した直接波の強度を用いることにより、複数の障害物が存在する場合に障害物ごとに高さ判定を行うことができるため、高さの判定精度を上げることができる。さらに、強度比を用いるため、反射率のばらつき等の障害物の性状によって生じる反射波の強度のばらつきを抑制できる。そのため、強度を用いるよりも強度比を用いるほうが障害物の性状の影響を受けずに高さ判定を行うことができる。また、障害物の性状によって生じる強度のばらつきよりも強度比のばらつきのほうが小さいので、高さの誤判定を回避できる。   As described above, the obstacle detection apparatus 10 according to Embodiment 1 includes the first distance sensors 1-1 to 1-i, the second distance sensors 2-1 to 2-i, and the transmission / reception unit 11. The identity determination unit 12 and the height determination unit 13 are provided. The first distance sensors 1-1 to 1-i are installed in the vehicle. The second distance sensors 2-1 to 2-i are installed at positions lower than the installation heights of the first distance sensors 1-1 to 1-i. The transmission / reception unit 11 transmits the exploration wave from the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i and receives the reflected wave that is the exploration wave reflected by the obstacle. To obtain distance information and reflected wave intensity. The identity determination unit 12 uses the first distance sensors 1-1 to 1-1 based on the distance information of the first distance sensors 1-1 to 1-i and the distance information of the second distance sensors 2-1 to 2-i. It is determined that the reflected wave of 1-i and the reflected wave of the second distance sensors 2-1 to 2-i are direct waves reflected by the same obstacle. The height determination unit 13 includes the direct wave of the first distance sensors 1-1 to 1-i identified as the direct wave reflected by the same obstacle by the identity determination unit 12, and the second distance sensor 2. The height of the same obstacle is determined based on the intensity ratio with the direct waves of −1 to 2-i. Since the intensity ratio of the direct waves received by the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i installed at different heights is used, the vehicle The height of the obstacle can be determined not only when the vehicle is traveling but also when the vehicle is stopped. Also, by using the intensity of the direct wave reflected by the same obstacle, it is possible to perform height determination for each obstacle when there are a plurality of obstacles, so that the accuracy of height determination can be increased. it can. Furthermore, since the intensity ratio is used, it is possible to suppress variations in the intensity of the reflected wave caused by the properties of the obstacle such as variations in reflectance. Therefore, it is possible to perform the height determination without using the influence of the property of the obstacle by using the intensity ratio rather than using the intensity. In addition, since the variation in the intensity ratio is smaller than the variation in the intensity caused by the properties of the obstacle, it is possible to avoid an erroneous determination of the height.

また、実施の形態１の同一性判定部１２は、第１の距離センサ１−１〜１−ｉの距離情報および第２の距離センサ２−１〜２−ｉの距離情報を用いて、車両の前後左右方向の２次元座標において探査波が反射した反射点の位置を算出し、反射点の分布に基づいて第１の距離センサ１−１〜１−ｉの反射波および第２の距離センサ２−１〜２−ｉの反射波が同一の障害物で反射した直接波であることを判定する。第１の距離センサ１−１〜１−ｉと第２の距離センサ２−１〜２−ｉは異なる高さに設置されるため、１個の低い障害物であっても第１の距離センサ１−１〜１−ｉの距離情報と第２の距離センサ２−１〜２−ｉの距離情報とが異なるが、障害物の同一性を精度よく判定できる。そのため、高さの誤判定を回避できる。   In addition, the identity determination unit 12 according to the first embodiment uses the distance information of the first distance sensors 1-1 to 1-i and the distance information of the second distance sensors 2-1 to 2-i to The position of the reflection point reflected by the exploration wave in the two-dimensional coordinates in the front-rear and left-right directions is calculated, and the reflected wave of the first distance sensors 1-1 to 1-i and the second distance sensor are calculated based on the distribution of the reflection points. It is determined that the reflected waves 2-1 to 2-i are direct waves reflected by the same obstacle. Since the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i are installed at different heights, even if one obstacle is low, the first distance sensor Although the distance information of 1-1 to 1-i is different from the distance information of the second distance sensors 2-1 to 2-i, the identity of the obstacle can be accurately determined. Therefore, it is possible to avoid erroneous height determination.

また、実施の形態１の高さ判定部１３は、同一の障害物について、第１の距離センサ１−１〜１−ｉの距離情報と第２の距離センサ２−１〜２−ｉの距離情報との差分値が予め定められた閾値ＴＨ２以下である場合に第１の距離センサ１−１〜１−ｉまたは第２の距離センサ２−１〜２−ｉの少なくとも一方により受信された直接波の強度を補正し、補正した強度を用いて高さ判定を行う。ポール等の幅が狭い障害物の場合、第１の距離センサ１−１〜１−ｉおよび第２の距離センサ２−１〜２−ｉの距離情報のばらつきが大きいが、反射点は特定領域に分布するので、この特徴を用いて反射点が集中する場合にその反射点は同一の障害物であるものとみなして強度を補正する。これにより、高さの判定精度を向上させることができる。   In addition, the height determination unit 13 according to the first embodiment has the same obstacle information about the distance information of the first distance sensors 1-1 to 1-i and the distances of the second distance sensors 2-1 to 2-i. Directly received by at least one of the first distance sensors 1-1 to 1-i or the second distance sensors 2-1 to 2-i when the difference value from the information is equal to or less than a predetermined threshold TH2. The wave intensity is corrected, and the height is determined using the corrected intensity. In the case of a narrow obstacle such as a pole, the distance information of the first distance sensors 1-1 to 1-i and the second distance sensors 2-1 to 2-i varies greatly, but the reflection point is a specific region. Therefore, when reflection points are concentrated using this feature, the reflection points are regarded as the same obstacle and the intensity is corrected. Thereby, the accuracy of height determination can be improved.

また、実施の形態１の高さ判定部１３は、平均化処理した直接波の強度を用いて高さ判定を行う。これにより、ロバスト性を向上させることができる。   The height determination unit 13 according to the first embodiment performs height determination using the intensity of the direct wave that has been subjected to the averaging process. Thereby, robustness can be improved.

また、実施の形態１の高さ判定部１３は、平均化処理した距離差分値を用いて閾値ＴＨ２との比較を行う。これにより、ロバスト性を向上させることができる。   In addition, the height determination unit 13 according to the first embodiment performs comparison with the threshold value TH2 using the averaged distance difference value. Thereby, robustness can be improved.

なお、本発明はその発明の範囲内において、実施の形態の任意の構成要素の変形、または実施の形態の任意の構成要素の省略が可能である。   In the present invention, any component of the embodiment can be modified or any component of the embodiment can be omitted within the scope of the invention.

この発明に係る障害物検出装置は、車両が走行中および停止中に障害物の高さを判定するようにしたので、運転支援システムなどに用いるのに適している。   The obstacle detection device according to the present invention is suitable for use in a driving support system or the like because the height of the obstacle is determined while the vehicle is running and stopped.

１−１〜１−ｉ 第１の距離センサ、２−１〜２−ｉ 第２の距離センサ、１０ 障害物検出装置、１１ 送受信部、１２ 同一性判定部、１３ 高さ判定部、２０ 処理回路、２１ プロセッサ、２２ メモリ、Ａ１，Ａ２ 円、Ａ３，Ｂ２，Ｂ３ 反射点、Ｂ１ 楕円、Ｃ１〜Ｃ４ グループ、Ｌ１，Ｌ２ 反射点間距離。   1-1 to 1-i first distance sensor, 2-1 to 2-i second distance sensor, 10 obstacle detection device, 11 transmission / reception unit, 12 identity determination unit, 13 height determination unit, 20 processing Circuit, 21 processor, 22 memory, A1, A2 circle, A3, B2, B3 reflection point, B1 ellipse, C1-C4 group, L1, L2 distance between reflection points.

Claims (3)

車両に設置された第１の距離センサと、
前記第１の距離センサの設置高さよりも低い位置に設置された第２の距離センサと、
前記第１の距離センサおよび前記第２の距離センサから探査波を送信させ障害物で反射した前記探査波である反射波を受信させて距離情報および前記反射波の強度を取得する送受信部と、
前記第１の距離センサの距離情報および前記第２の距離センサの距離情報に基づき、前記第１の距離センサの反射波および前記第２の距離センサの反射波が同一の障害物で反射した直接波であることを判定する同一性判定部と、
前記同一性判定部により同一の障害物で反射した直接波であると特定された前記第１の距離センサの直接波と前記第２の距離センサの直接波との強度比に基づき、前記同一の障害物の高さを判定する高さ判定部とを備え、
前記同一性判定部は、前記第１の距離センサの距離情報および前記第２の距離センサの距離情報を用いて、前記車両の前後左右方向の２次元座標において探査波が反射した反射点の位置を算出し、反射点の分布に基づいて前記第１の距離センサの反射波および前記第２の距離センサの反射波が同一の障害物で反射した直接波であることを判定し、
前記高さ判定部は、前記同一の障害物について、前記第１の距離センサの距離情報と前記第２の距離センサの距離情報との差分値が予め定められた閾値以下である場合に前記第１の距離センサまたは前記第２の距離センサの少なくとも一方により受信された直接波の強度を補正し、補正した強度を用いて高さ判定を行うことを特徴とする障害物検出装置。 A first distance sensor installed in the vehicle;
A second distance sensor installed at a position lower than an installation height of the first distance sensor;
A transmission / reception unit that transmits a search wave from the first distance sensor and the second distance sensor and receives a reflected wave that is the search wave reflected by an obstacle to acquire distance information and the intensity of the reflected wave;
Based on the distance information of the first distance sensor and the distance information of the second distance sensor, the reflected wave of the first distance sensor and the reflected wave of the second distance sensor are directly reflected by the same obstacle. An identity determination unit that determines that the wave is a wave,
Based on the intensity ratio between the direct wave of the first distance sensor and the direct wave of the second distance sensor identified as the direct wave reflected by the same obstacle by the identity determination unit, the same A height determination unit for determining the height of the obstacle ,
The identity determination unit uses the distance information of the first distance sensor and the distance information of the second distance sensor to determine the position of the reflection point reflected by the exploration wave in the two-dimensional coordinates in the front-rear and left-right directions of the vehicle. And determining that the reflected wave of the first distance sensor and the reflected wave of the second distance sensor are direct waves reflected by the same obstacle based on the distribution of reflection points,
The height determining unit, when the difference value between the distance information of the first distance sensor and the distance information of the second distance sensor is equal to or less than a predetermined threshold for the same obstacle, An obstacle detection apparatus comprising: correcting an intensity of a direct wave received by at least one of the first distance sensor and the second distance sensor, and performing height determination using the corrected intensity . 前記高さ判定部は、平均化処理した直接波の強度を用いて高さ判定を行うことを特徴とする請求項１記載の障害物検出装置。   The obstacle detection device according to claim 1, wherein the height determination unit performs height determination using the intensity of the direct wave subjected to the averaging process. 前記高さ判定部は、平均化処理した差分値を用いて閾値との比較を行うことを特徴とする請求項１記載の障害物検出装置。 Said height determination unit, an obstacle detection device according to claim 1, characterized in that for comparing the threshold with the difference value by averaging.
JP2019541811A 2017-09-22 2017-09-22 Obstacle detection device Expired - Fee Related JP6599075B2 (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/034313 WO2019058507A1 (en) 2017-09-22 2017-09-22 Obstacle detection device and obstacle detection method

Publications (2)

Publication Number Publication Date
JP6599075B2 true JP6599075B2 (en) 2019-10-30
JPWO2019058507A1 JPWO2019058507A1 (en) 2019-12-12

Family

ID=65810198

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019541811A Expired - Fee Related JP6599075B2 (en) 2017-09-22 2017-09-22 Obstacle detection device

Country Status (2)

Country Link
JP (1) JP6599075B2 (en)
WO (1) WO2019058507A1 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7506551B2 (en) 2020-08-04 2024-06-26 パナソニックオートモーティブシステムズ株式会社 Obstacle determination device, vehicle, and obstacle determination method
KR102356497B1 (en) * 2020-09-16 2022-02-07 현대모비스 주식회사 Position detection system and method using sensor
CN116400362B (en) * 2023-06-08 2023-08-08 广汽埃安新能源汽车股份有限公司 Driving boundary detection method, device, storage medium and equipment

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4293865B2 (en) * 2003-09-02 2009-07-08 富士通テン株式会社 Object detection device
CN103348259B (en) * 2011-03-04 2015-06-03 三菱电机株式会社 Object detection device and navigation device
JP6021755B2 (en) * 2013-07-16 2016-11-09 三菱電機株式会社 Obstacle detection device
DE102014114999A1 (en) * 2014-10-15 2016-04-21 Valeo Schalter Und Sensoren Gmbh Method for detecting at least one object in an environmental region of a motor vehicle, driver assistance system and motor vehicle
JP6289338B2 (en) * 2014-10-22 2018-03-07 株式会社デンソー Object detection device, vehicle control device
WO2016103464A1 (en) * 2014-12-26 2016-06-30 三菱電機株式会社 Obstacle detection device and obstacle detection method

Also Published As

Publication number Publication date
WO2019058507A1 (en) 2019-03-28
JPWO2019058507A1 (en) 2019-12-12

Similar Documents

Publication Publication Date Title
US11161547B2 (en) Parking assistance device
US10247825B2 (en) Object detection device
JP4883246B2 (en) Object detection apparatus and object detection method
JP6430777B2 (en) Object detection device
JP6599075B2 (en) Obstacle detection device
JP6788388B2 (en) Radar device and control method of radar device
US20180015923A1 (en) Vehicle control device and vehicle control method
WO2017104503A1 (en) Traveling-body control device and traveling-body control method
JP6577767B2 (en) Object detection apparatus and object detection method
JP6217349B2 (en) Braking device
JP6442225B2 (en) Object detection device
JP6811913B2 (en) Obstacle detector
JP7127969B2 (en) Radar device and signal processing method
WO2019053812A1 (en) Obstacle detection device and obstacle detection method
JP4683910B2 (en) Collision prevention support device
JP2019158787A (en) Radar device and signal processing method
CN114556146A (en) Method and device for classifying objects, in particular in the context of a motor vehicle
JP6992439B2 (en) Object detector
JP7186925B2 (en) Road shape estimation device, road shape estimation method and road shape estimation program
JP7064400B2 (en) Object detection device
JP6818902B6 (en) Vehicle detection system
WO2018150577A1 (en) Parking assist device and parking assist method
JP6808113B2 (en) Obstacle detector
JP6743665B2 (en) Curve estimation device
WO2020008535A1 (en) Obstacle detection device

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190801

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190801

A871 Explanation of circumstances concerning accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A871

Effective date: 20190801

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190809

TRDD Decision of grant or rejection written
A975 Report on accelerated examination

Free format text: JAPANESE INTERMEDIATE CODE: A971005

Effective date: 20190821

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20190903

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20191001

R150 Certificate of patent or registration of utility model

Ref document number: 6599075

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees