JP2006292681A - Object detection apparatus - Google Patents

Object detection apparatus Download PDF

Info

Publication number
JP2006292681A
JP2006292681A JP2005117286A JP2005117286A JP2006292681A JP 2006292681 A JP2006292681 A JP 2006292681A JP 2005117286 A JP2005117286 A JP 2005117286A JP 2005117286 A JP2005117286 A JP 2005117286A JP 2006292681 A JP2006292681 A JP 2006292681A
Authority
JP
Japan
Prior art keywords
target
radar
stereo image
ecu
vehicle
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2005117286A
Other languages
Japanese (ja)
Other versions
JP4670449B2 (en
Inventor
Michihiro Miyashita
亨裕 宮下
Setsuo Tokoro
節夫 所
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.)
Toyota Motor Corp
Original Assignee
Toyota Motor 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 Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2005117286A priority Critical patent/JP4670449B2/en
Publication of JP2006292681A publication Critical patent/JP2006292681A/en
Application granted granted Critical
Publication of JP4670449B2 publication Critical patent/JP4670449B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Geophysics And Detection Of Objects (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide an object detection apparatus capable of highly accurately detecting objects. <P>SOLUTION: The object detection apparatus 1 for detecting objects on the basis of both information by a radar and information by images is provided with a radar detection means 2 for detecting objects by the radar; an image detection means 3 for detecting objects by images; and a determination means 10 for determining whether an object detected by the radar detection means 2 and an object detected by the image detection means 3 are one and the same object or not on the basis of both position information of the object detected by the radar detection means 2 and the position information of the object detected by the image detection means 3. In the case that a plurality of objects detected by the radar detection means 2 correspond to an object detected by the image detection means 3, the determination means 10 determines that an object close to an estimated track of travel of the center of a vehicle among the plurality of objects is one and the same object. <P>COPYRIGHT: (C)2007,JPO&INPIT

Description

本発明は、レーダによる情報と画像による情報に基づいて物体を検出する物体検出装置に関する。   The present invention relates to an object detection apparatus that detects an object based on information from a radar and information from an image.

近年、衝突低減装置、車間距離制御装置、追従走行装置などの運転支援装置が開発されている。これら運転支援装置では、自車両の前方を走行する車両を検出することが重要となる。物体検出装置には、検出精度を向上させるために、ミリ波レーダなどのレーダによる検出手段及びステレオカメラなどの画像による検出手段の2つの検出手段を備える装置がある。この2つの検出手段を備える物体検出装置では、レーダによる情報に基づいて検出されたレーダ検出物と画像による情報に基づいて検出した画像検出物とを照合し、レーダ検出物と画像検出物とが同一の物体か否かを判断し、同一と判断した物体を前方車両などの検出対象の物体として設定する(特許文献1参照)。
特開2004−117071号公報
In recent years, driving support devices such as a collision reducing device, an inter-vehicle distance control device, and a following traveling device have been developed. In these driving assistance devices, it is important to detect a vehicle traveling in front of the host vehicle. In order to improve the detection accuracy, the object detection apparatus includes an apparatus including two detection means, that is, a detection means using a radar such as a millimeter wave radar and a detection means using an image such as a stereo camera. In the object detection apparatus including these two detection means, the radar detection object detected based on the information from the radar and the image detection object detected based on the information from the image are collated, and the radar detection object and the image detection object are detected. It is determined whether or not they are the same object, and the object determined to be the same is set as an object to be detected such as a preceding vehicle (see Patent Document 1).
JP 2004-117071 A

従来の照合方法では、照合の結果、1個の画像検出物と類似性を持つレーダ検出物が複数個存在するときには類似度の最も高いレーダ検出物を同一の物体と判断するので、画像検出物との位置が最も近いレーダ検出物を同一の物体と判断する場合がある。そのため、レーダ検出物と画像検出物とが異なる物体であっても、同一の物体と判断してしまう可能性がある。   In the conventional collation method, if there are multiple radar detection objects similar to one image detection object as a result of the collation, the radar detection object having the highest similarity is determined as the same object. May be determined as the same object. Therefore, even if the radar detection object and the image detection object are different objects, there is a possibility that they are determined to be the same object.

例えば、検出対象が前方車両の場合、画像情報に基づく物体検出では、前方車両の一部が影になっていると、前方車両を分割して検出し、前方車両の路側(左側)の端部を画像検出物とする場合がある。その場合、レーダ情報に基づく物体検出によって前方車両の他に前方車両に並走する自動二輪車あるいは路側のポール(標識など)をレーダ検出物として検出していると、その各レーダ検出物と前方車両の路側端部の画像検出物との照合において、前方車両の路側端部の画像検出物と位置が近い自動二輪車あるいは路側のポールのレーダ検出物を同一物体と判断する可能性がある。   For example, when the object to be detected is a front vehicle, in object detection based on image information, if a part of the front vehicle is shaded, the front vehicle is divided and detected, and the road side (left side) end of the front vehicle is detected. May be used as an image detection object. In this case, if an object detection based on radar information detects a motorcycle or a roadside pole (a sign, etc.) running parallel to the preceding vehicle as a radar detection object in addition to the preceding vehicle, each radar detection object and the preceding vehicle are detected. In comparison with the image detection object at the road side end, there is a possibility that the motorcycle or the radar detection object of the road side pole close to the image detection object at the road side end of the preceding vehicle is determined as the same object.

そこで、本発明は、物体を高精度に検出する物体検出装置を提供することを課題とする。   Therefore, an object of the present invention is to provide an object detection device that detects an object with high accuracy.

本発明に係る物体検出装置は、レーダによって物体を検出するレーダ検出手段と、画像によって物体を検出する画像検出手段と、レーダ検出手段によって検出した物体の位置情報と画像検出手段によって検出した物体の位置情報に基づいて、レーダ検出手段によって検出した物体と画像検出手段によって検出した物体が同一物体か否かを判断する判断手段とを備え、判断手段は、画像検出手段によって検出した物体に対してレーダ検出手段によって検出した物体が複数個対応している場合、当該複数個の物体のうち車両中心の推測走行軌跡に近い物体を同一物体と判断することを特徴とする。   An object detection apparatus according to the present invention includes a radar detection means for detecting an object by radar, an image detection means for detecting an object by an image, position information of the object detected by the radar detection means, and an object detected by the image detection means. And determining means for determining whether or not the object detected by the radar detecting means and the object detected by the image detecting means are the same object based on the position information, the determining means for the object detected by the image detecting means When a plurality of objects detected by the radar detection means correspond to each other, an object close to the estimated traveling locus at the center of the vehicle among the plurality of objects is determined as the same object.

この物体検出装置では、レーダ検出手段によるレーダ情報に基づいて物体を検出し、検出した物体についてレーダ情報から得られる位置情報を取得する。また、物体検出装置では、画像検出手段による画像情報に基づいて物体を検出し、検出した物体について画像情報から得られる位置情報を取得する。そして、物体検出装置では、判断手段によりレーダ検出手段による検出物体の位置情報と画像検出手段による検出物体の位置情報とに基づいて各検出手段による検出物体が同一物体か否かを判断する。この際、画像検出手段による検出物体に対してレーダ検出手段による複数個の検出物体が対応している場合(つまり、画像検出物体と類似性を持つレーダ検出物体が複数個存在する場合)、判断手段では、その複数個の検出物体について車両中心の推測走行軌跡からの距離を比較し、その推測走行軌跡に最も近いレーダ検出物体が画像検出物体と同一物体と判断する。このように、物体検出手段では、各検出物体の位置情報だけでなく、レーダ検出手段による検出物体の車両中心の走行軌跡からの距離を考慮している。そのため、物体検出手段では、画像検出手段による検出物体と類似性のあるレーダ検出手段による検出物体が複数個存在する場合には路側に位置する物体より自車両中心の走行軌跡に近い物体(例えば、車両)を同一物体と判断することができる。その結果、物体検出装置では、自車両中心の走行軌跡により近い物体を高精度に検出することができる。例えば、画像検出手段による検出物体として車線内を走行している前方車両の路側の一部を検出しており、レーダ検出手段による検出物体として前方車両(車幅方向の位置情報が車線の中心付近)とその前方車両に並走する自動二輪車(車幅方向の位置情報が車線の左端部付近)を検出している場合、そのレーダ検出手段による2個の検出物体のうち車線の中心線に近い前方車両の検出物体(自車両中心の走行軌跡に近い方の検出物体)を画像検出手段による検出物体と同一物体と判断することできる。   In this object detection apparatus, an object is detected based on radar information from the radar detection means, and position information obtained from the radar information is acquired for the detected object. Further, the object detection device detects an object based on image information obtained by the image detection means, and acquires position information obtained from the image information for the detected object. In the object detection apparatus, the determination unit determines whether the detection objects detected by the detection units are the same object based on the position information of the detection object detected by the radar detection unit and the position information of the detection object detected by the image detection unit. At this time, if a plurality of detection objects by the radar detection means correspond to a detection object by the image detection means (that is, if there are a plurality of radar detection objects having similarity to the image detection object) The means compares the distances of the plurality of detected objects from the estimated traveling locus at the center of the vehicle, and determines that the radar detected object closest to the estimated traveling locus is the same object as the image detected object. As described above, the object detection means considers not only the position information of each detection object but also the distance from the traveling locus of the vehicle center of the detection object detected by the radar detection means. Therefore, in the object detection means, when there are a plurality of detection objects by the radar detection means similar to the detection object by the image detection means, an object (for example, an object closer to the traveling locus of the host vehicle than the object located on the road side) Vehicle) can be determined as the same object. As a result, the object detection apparatus can detect an object closer to the traveling locus at the center of the host vehicle with high accuracy. For example, a roadside part of a forward vehicle traveling in the lane is detected as a detection object by the image detection means, and the forward vehicle (position information in the vehicle width direction is near the center of the lane as a detection object by the radar detection means. ) And a motorcycle running in parallel with the vehicle ahead of it (position information in the vehicle width direction is near the left end of the lane), it is close to the center line of the lane of the two detected objects by the radar detection means It is possible to determine that the detection object of the preceding vehicle (the detection object closer to the traveling locus at the center of the host vehicle) is the same object as the detection object by the image detection means.

本発明の上記物体検出装置では、車両中心の走行軌跡を推測する推測手段を備える構成としてもよい。   The object detection apparatus according to the present invention may be configured to include estimation means for estimating a traveling locus at the center of the vehicle.

この物体検出装置では、推測手段により車両中心の走行軌跡を推測する。そして、画像検出手段による検出物体に対してレーダ検出手段による複数個の検出物体が対応している場合、判断手段では、その推測した走行軌跡とレーダ検出手段による各検出物体の位置情報から複数個の検出物体について車両中心の推測走行軌跡からの距離をそれぞれ求め、その各距離に基づいて画像検出手段による検出物体と同一物体か否かを判断する。このように、物体検出装置では、実際に求めた精度の高い車両中心の走行軌跡を用いることにより、物体をより高精度に検出することができる。   In this object detection apparatus, the traveling locus at the center of the vehicle is estimated by the estimating means. Then, when a plurality of detection objects by the radar detection means correspond to the detection objects by the image detection means, the determination means uses a plurality of information based on the estimated traveling locus and position information of each detection object by the radar detection means. For each detected object, the distance from the estimated traveling locus at the center of the vehicle is obtained, and based on each distance, it is determined whether or not the object detected by the image detecting means is the same object. As described above, the object detection apparatus can detect the object with higher accuracy by using the traveling locus of the vehicle center with high accuracy actually obtained.

本発明によれば、車両中心の走行軌跡により近い物体を高精度に検出することができる。   According to the present invention, it is possible to detect an object closer to the traveling locus of the vehicle center with high accuracy.

以下、図面を参照して、本発明に係る物体検出装置の実施の形態を説明する。   Hereinafter, an embodiment of an object detection device according to the present invention will be described with reference to the drawings.

本実施の形態では、本発明に係る物体検出装置を、車両に搭載される衝突軽減装置に適用する。本実施の形態に係る衝突軽減装置は、検出対象として前方車両を検出し、前方車両との衝突を防止/軽減するために各種制御を行う。特に、本実施の形態に係る衝突軽減装置では、前方車両を検出するためにミリ波レーダとステレオカメラの2つのセンサを備え、ミリ波レーダによる検出物体とステレオカメラによる検出物体とを照合することによって前方車両を検出する。本実施の形態には、照合処理の違いにより2つの形態があり、第1の実施の形態が各センサについて検出物体に対する追跡処理を行わない形態であり、第2の実施の形態が各センサについて検出物体に対する追跡処理を行う形態である。   In the present embodiment, the object detection device according to the present invention is applied to a collision mitigation device mounted on a vehicle. The collision mitigation apparatus according to the present embodiment detects a forward vehicle as a detection target and performs various controls to prevent / reduce a collision with the forward vehicle. In particular, the collision mitigation apparatus according to the present embodiment includes two sensors, a millimeter wave radar and a stereo camera, for detecting a vehicle ahead, and collates a detection object by the millimeter wave radar with a detection object by the stereo camera. To detect the vehicle ahead. In this embodiment, there are two forms depending on the difference in the collation processing. The first embodiment is a form in which the tracking process for the detected object is not performed for each sensor, and the second embodiment is for each sensor. This is a form for performing tracking processing on a detected object.

図1〜図7を参照して、第1の実施の形態に係る衝突軽減装置1について説明する。図1は、本実施の形態に係る衝突軽減装置の構成図である。図2は、本実施の形態に係るレーダ物標、ステレオ画像物標及びフュージョン物標の説明図である。図3は、第1の実施の形態に係る前回フュージョン物標とレーダ物標との照合方法の説明図である。図4は、第1の実施の形態に係る前回フュージョン物標とステレオ画像物標との照合方法の説明図である。図5は、本実施の形態に係るレーダ物標とステレオ画像物標との照合方法の説明図である。図6は、本実施の形態に係るステレオ画像物標と類似性を持つレーダ物標が2個存在する場合のレーダ物標とステレオ画像物標との照合方法の説明図である。図7は、本実施の形態に係るレーダ物標と車線の中心線との距離の演算方法の説明図であり、(a)が道路のカーブR>0の場合であり、(b)が道路のカーブR<0の場合である。   With reference to FIGS. 1-7, the collision mitigation apparatus 1 which concerns on 1st Embodiment is demonstrated. FIG. 1 is a configuration diagram of a collision mitigation device according to the present embodiment. FIG. 2 is an explanatory diagram of a radar target, a stereo image target, and a fusion target according to the present embodiment. FIG. 3 is an explanatory diagram of a collation method between the previous fusion target and the radar target according to the first embodiment. FIG. 4 is an explanatory diagram of a collation method between the previous fusion target and the stereo image target according to the first embodiment. FIG. 5 is an explanatory diagram of a method for collating a radar target and a stereo image target according to the present embodiment. FIG. 6 is an explanatory diagram of a collation method between a radar target and a stereo image target when there are two radar targets similar to the stereo image target according to the present embodiment. FIG. 7 is an explanatory diagram of a method for calculating the distance between the radar target and the center line of the lane according to this embodiment, where (a) is a case where the road curve R> 0, and (b) is the road. This is the case of the curve R <0.

衝突軽減装置1は、前方車両を検出し、前方物体を検出した場合には衝突の可能性に応じてブレーキ制御、サスペンション制御、シートベルト制御及び警報制御を行う。衝突軽減装置1は、前方車両を検出するために、ミリ波レーダによる情報に基づいてレーダ物標を設定するとともにステレオカメラによるステレオ画像に基づいてステレオ画像物標を設定し、レーダ物標とステレオ画像物標との照合によってフュージョン物標(前方車両)を設定する。この際、衝突軽減装置1では、レーダ物標、ステレオ画像物標それぞれについて追跡を行わずに、レーダ物標またはステレオ画像物標と前回フュージョン物標との照合を行う。特に、衝突軽減装置1では、1個のステレオ物標に対して類似性があるレーダ物標が複数個存在する場合、各レーダ物標の車線の中心線(なお、車線の中心線を自車両の車幅方向の中心における走行軌跡とみなしている)からの距離を用いて照合を行う。衝突軽減装置1は、ミリ波レーダ2、ステレオカメラ3、車速センサ4、ヨーレートセンサ5、ブレーキECU[Electronic Control Unit]6、サスペンション制御アクチュエータ7、シートベルトアクチュエータ8、ブザー9及び衝突軽減ECU10などを備え、これらがCAN[Controller Area Network](車内LANの標準インターフェース規格)通信で各種信号を送受信する。   The collision mitigation device 1 detects a vehicle ahead and performs brake control, suspension control, seat belt control, and alarm control according to the possibility of collision when a front object is detected. The collision mitigation apparatus 1 sets a radar target based on information from a millimeter wave radar and sets a stereo image target based on a stereo image from a stereo camera in order to detect a vehicle ahead. A fusion target (vehicle ahead) is set by collating with the image target. At this time, the collision mitigation apparatus 1 collates the radar target or stereo image target with the previous fusion target without tracking each of the radar target and the stereo image target. In particular, in the collision mitigation apparatus 1, when there are a plurality of radar targets that are similar to a single stereo target, the lane center line of each radar target (the center line of the lane is defined as the own vehicle). The distance from the center of the vehicle width direction is regarded as a travel locus). The collision mitigation apparatus 1 includes a millimeter wave radar 2, a stereo camera 3, a vehicle speed sensor 4, a yaw rate sensor 5, a brake ECU [Electronic Control Unit] 6, a suspension control actuator 7, a seat belt actuator 8, a buzzer 9, a collision mitigation ECU 10, and the like. These devices transmit and receive various signals by CAN [Controller Area Network] (standard interface standard for in-vehicle LAN) communication.

なお、本実施の形態では、ミリ波レーダ2が特許請求の範囲に記載するレーダ検出手段に相当し、ステレオカメラ3が特許請求の範囲に記載する画像検出手段に相当し、衝突軽減ECU10が特許請求の範囲に記載する判断手段に相当する。   In this embodiment, the millimeter wave radar 2 corresponds to the radar detection means described in the claims, the stereo camera 3 corresponds to the image detection means described in the claims, and the collision reduction ECU 10 is patented. This corresponds to the determination means described in the claims.

まず、図2を参照して各物標について説明しておく。レーダ物標は、ミリ波レーダ2による情報に基づいて検出された物体である。レーダ物標には、レーダ情報から取得できる物体までの距離、物体の横位置、物体との相対速度が設定される。ステレオ画像物標は、ステレオカメラ3によるステレオ画像に基づいて検出された物体である。ステレオ画像物標には、ステレオ画像から取得できる物体の前端面までの距離、物体の前端面中央の横位置、物体との相対速度、物体の横幅(自車両に対して左右方向の長さ)、物体の奥行き(自車両から遠ざかる方向の長さ)、物体の高さ、物体の高さ位置が設定される。フュージョン物標は、レーダ物標とステレオ画像物標との照合において類似度が高く、そのレーダ物標とステレオ画像物標とが同一物体であると判断できる物体である。フュージョン物標には、レーダ物標からの距離及び相対速度とステレオ画像物標からの横位置、横幅、奥行き、高さ、高さ位置が設定される。このフュージョン物標の情報が、前方車両についての情報となる。   First, each target will be described with reference to FIG. The radar target is an object detected based on information from the millimeter wave radar 2. In the radar target, the distance to the object that can be acquired from the radar information, the lateral position of the object, and the relative speed with the object are set. The stereo image target is an object detected based on a stereo image obtained by the stereo camera 3. For stereo image targets, the distance to the front end surface of the object that can be acquired from the stereo image, the horizontal position of the center of the front end surface of the object, the relative speed with the object, the width of the object (the length in the left-right direction with respect to the host vehicle) The depth of the object (the length in the direction away from the host vehicle), the height of the object, and the height position of the object are set. The fusion target is an object that has a high similarity in the collation between the radar target and the stereo image target, and can determine that the radar target and the stereo image target are the same object. In the fusion target, the distance and relative speed from the radar target and the horizontal position, width, depth, height, and height position from the stereo image target are set. Information on this fusion target is information about the vehicle ahead.

ミリ波レーダ2は、ミリ波を利用して物体を検出するためのレーダである。ミリ波レーダ2は、自車両の前側の中央に取り付けられる。ミリ波レーダ2では、ミリ波を水平面内でスキャンしながら自車両から前方に向けて送信し、反射してきたミリ波を受信する。そして、ミリ波レーダ2では、そのミリ波の送受信データをレーダ信号として衝突軽減ECU10に送信する。   The millimeter wave radar 2 is a radar for detecting an object using millimeter waves. The millimeter wave radar 2 is attached to the front center of the host vehicle. The millimeter wave radar 2 transmits the millimeter wave forward while scanning the millimeter wave in a horizontal plane, and receives the reflected millimeter wave. The millimeter wave radar 2 transmits the millimeter wave transmission / reception data to the collision mitigation ECU 10 as a radar signal.

ステレオカメラ3は、2台のCCDカメラからなり、2台のCCDカメラが水平方向に所定間隔離間されて配置されている。ステレオカメラ3も、自車両の前側の中央に取り付けられる。ステレオカメラ3では、2つのCCDカメラで撮像した左右のステレオ画像のデータを各画像信号として衝突軽減ECU10に送信する。   The stereo camera 3 is composed of two CCD cameras, and the two CCD cameras are arranged at a predetermined interval in the horizontal direction. The stereo camera 3 is also attached to the front center of the host vehicle. The stereo camera 3 transmits left and right stereo image data captured by the two CCD cameras to the collision reduction ECU 10 as image signals.

車速センサ4は、車両の速度を検出するセンサである。車速センサ4では、検出値を車速信号として衝突軽減ECU10に送信する。また、ヨーレートセンサ5は、車両のヨーレートを検出するセンサである。ヨーレートセンサ5では、検出値をヨーレート信号として衝突軽減ECU10に送信する。   The vehicle speed sensor 4 is a sensor that detects the speed of the vehicle. The vehicle speed sensor 4 transmits the detected value to the collision reduction ECU 10 as a vehicle speed signal. The yaw rate sensor 5 is a sensor that detects the yaw rate of the vehicle. The yaw rate sensor 5 transmits the detected value to the collision reduction ECU 10 as a yaw rate signal.

ブレーキECU6は、4輪の各ホイールシリンダの油圧を調節し、4輪のブレーキ力を制御するECUである。ブレーキECU6では、各輪の目標ブレーキ力に基づいて油圧制御信号をそれぞれ設定し、その各油圧制御信号を各ホイールシリンダの油圧を変化させるブレーキ制御アクチュエータに対してそれぞれ送信する。特に、ブレーキECU6では、衝突軽減ECU10から各輪に対する目標ブレーキ力信号を受信すると、その目標ブレーキ力信号に示される目標ブレーキ力に基づいて油圧制御信号をそれぞれ設定する。ちなみに、ブレーキ制御アクチュエータでは、油圧制御信号を受信すると、油圧制御信号に示される目標油圧に基づいてホイールシリンダの油圧を変化させる。   The brake ECU 6 is an ECU that adjusts the hydraulic pressure of each wheel cylinder of the four wheels and controls the braking force of the four wheels. The brake ECU 6 sets a hydraulic control signal based on the target brake force of each wheel, and transmits each hydraulic control signal to a brake control actuator that changes the hydraulic pressure of each wheel cylinder. In particular, when the brake ECU 6 receives a target brake force signal for each wheel from the collision reduction ECU 10, the brake ECU 6 sets a hydraulic control signal based on the target brake force indicated by the target brake force signal. Incidentally, when receiving the hydraulic control signal, the brake control actuator changes the hydraulic pressure of the wheel cylinder based on the target hydraulic pressure indicated by the hydraulic control signal.

サスペンション制御アクチュエータ7は、4輪の各油圧式アクティブサスペンションの油圧を変化させるアクチュエータである。サスペンション制御アクチュエータ7では、衝突軽減ECU10から各輪に対する目標減衰力信号を受信すると、各目標減衰力信号に示される目標減衰力に基づいて目標油圧を設定し、目標油圧に基づいて油圧式アクティブサスペンションの油圧を変化させる。なお、図1には、サスペンション制御アクチュエータ7は1個しか描いていないが、4輪のサスペンション毎にそれぞれ設けられる。   The suspension control actuator 7 is an actuator that changes the hydraulic pressure of each hydraulic active suspension of the four wheels. When the suspension control actuator 7 receives the target damping force signal for each wheel from the collision reduction ECU 10, the suspension control actuator 7 sets the target hydraulic pressure based on the target damping force indicated by each target damping force signal, and the hydraulic active suspension based on the target hydraulic pressure. Change the oil pressure. Although only one suspension control actuator 7 is shown in FIG. 1, it is provided for each of the four wheel suspensions.

シートベルトアクチュエータ8は、各シートベルトを引き込み、シートベルトによる拘束力を変化させるアクチュエータである。シートベルトアクチュエータ8では、衝突軽減ECU10から各シートベルトに対する目標引込量信号を受信すると、各目標引込量信号に示される目標引込量に応じてシートベルトを引き込む。なお、図1には、シートベルトアクチュエータ8は1個しか描いていないが、シートベルト毎にそれぞれ設けられる。   The seat belt actuator 8 is an actuator that pulls in each seat belt and changes the restraining force by the seat belt. When the seat belt actuator 8 receives the target pull-in amount signal for each seat belt from the collision reduction ECU 10, the seat belt actuator 8 pulls in the seat belt according to the target pull-in amount indicated by each target pull-in amount signal. In FIG. 1, only one seat belt actuator 8 is illustrated, but each seat belt actuator 8 is provided for each seat belt.

ブザー9は、衝突軽減ECU10から警報信号を受信すると、ブザー音を出力する。   When the buzzer 9 receives an alarm signal from the collision mitigation ECU 10, it outputs a buzzer sound.

衝突軽減ECU10は、CPU[Central Processing Unit]、ROM[ReadOnly Memory]、RAM[Random Access Memory]などからなる電子制御ユニットであり、衝突軽減装置1を統括制御する。衝突軽減ECU10は、CPUのマスタクロックに基づく一定時間毎に、ミリ波レーダ2からのレーダ信号、ステレオカメラ3からの各画像信号、車速センサ4からの車速信号及びヨーレートセンサ5からのヨーレート信号を取り入れる。そして、衝突軽減ECU10では、一定時間毎に、レーダ情報に基づくレーダ物標設定処理及びステレオ画像に基づくステレオ画像物標設定処理を行い、前回フュージョン物標と今回のレーダ物標及びステレオ画像物標に基づく照合処理を行い、今回フュージョン物標を設定する。さらに、衝突軽減ECU10では、今回フュージョン物標(前方車両)と自車両との関係に基づいて衝突軽減処理を行う。   The collision mitigation ECU 10 is an electronic control unit including a CPU [Central Processing Unit], a ROM [Read Only Memory], a RAM [Random Access Memory], and the like, and comprehensively controls the collision mitigation apparatus 1. The collision mitigation ECU 10 receives a radar signal from the millimeter wave radar 2, each image signal from the stereo camera 3, a vehicle speed signal from the vehicle speed sensor 4, and a yaw rate signal from the yaw rate sensor 5 at regular intervals based on the master clock of the CPU. Incorporate. Then, the collision mitigation ECU 10 performs a radar target setting process based on radar information and a stereo image target setting process based on the stereo image at regular intervals, and the previous fusion target, the current radar target, and the stereo image target. The collation process based on is performed, and the fusion target is set this time. Further, the collision mitigation ECU 10 performs a collision mitigation process based on the relationship between the current fusion target (front vehicle) and the host vehicle.

レーダ物標設定処理について説明する。衝突軽減ECU10では、ミリ波が出射から受信までの時間に基づいて前方の物体までの距離を演算する。また、衝突軽減ECU10では、前方の物体との相対速度を演算する。また、衝突軽減ECU10では、反射してきたミリ波の中で最も強く反射してきたミリ波の方向を検出し、その方向から自車両の進行方向と物体の方向とのなす角度を求め、その角度から横位置を演算する。ミリ波レーダ2による物体検出では、反射したミリ波を受信できた場合に物体を検出したことになるので、反射したミリ波を受信する毎に1個のレーダ物標が得られる。また、ミリ波レーダ2による物体検出では、物体までの距離を正確に検出できるので、距離及び相対速度の精度が特に高い。   The radar target setting process will be described. The collision reduction ECU 10 calculates the distance to the object ahead based on the time from when the millimeter wave is emitted to when it is received. Further, the collision reduction ECU 10 calculates a relative speed with respect to a front object. Further, the collision mitigation ECU 10 detects the direction of the millimeter wave that has been reflected most strongly among the reflected millimeter waves, and obtains the angle formed by the traveling direction of the host vehicle and the direction of the object from that direction, and from that angle Calculate the horizontal position. In the object detection by the millimeter wave radar 2, since the object is detected when the reflected millimeter wave is received, one radar target is obtained every time the reflected millimeter wave is received. Further, in the object detection by the millimeter wave radar 2, the distance to the object can be accurately detected, and thus the accuracy of the distance and the relative speed is particularly high.

ステレオ画像物標設定処理について説明する。衝突軽減ECU10では、左右のステレオ画像における物体の見え方のずれを利用して三角測量的に前方の物体を立体的に特定し、ステレオカメラ3から物体までの位置(物体の前端面までの距離、物体の前端面中央の横位置、物体の高さ位置)を演算するとともに、物体の立体的な大きさ(横幅、奥行き、高さ)を演算する。また、衝突軽減ECU10では、前方の物体との相対速度を演算する。ステレオカメラ3による物体検出では、左右のステレオ画像から物体を特定できた場合に物体を検出したことになるので、物体を特定する毎に1個のステレオ画像物標が得られる。また、ステレオカメラ3による物体検出では、物体を立体的に検出できるので、物体の大きさの情報を取得できる。   The stereo image target setting process will be described. The collision mitigation ECU 10 triangulateally identifies a front object by using the difference in the appearance of the object in the left and right stereo images, and determines the position from the stereo camera 3 to the object (distance to the front end surface of the object). The horizontal position of the front end surface of the object, the height position of the object) are calculated, and the three-dimensional size (horizontal width, depth, height) of the object is calculated. Further, the collision reduction ECU 10 calculates a relative speed with respect to a front object. In the object detection by the stereo camera 3, the object is detected when the object can be specified from the left and right stereo images, so that one stereo image target is obtained each time the object is specified. Further, in the object detection by the stereo camera 3, since the object can be detected three-dimensionally, information on the size of the object can be acquired.

照合処理について説明する。まず、衝突軽減ECU10では、一定時間毎に、前回フュージョン物標と今回レーダ物標との照合を行う。具体的には、衝突軽減ECU10では、図3に示すように、前回フュージョン物標LFの位置(距離、横位置)を中心として距離の閾値と横位置の閾値を設定し(図3の破線で示す平面領域参照)、前回フュージョン物標LFの相対速度を中央値として相対速度の閾値を設定する。そして、衝突軽減ECU10では、今回レーダ物標TLの位置(距離、横位置)が前回フュージョン物標LFの位置を中心とした距離の閾値内かつ横位置の閾値内に入っているか否かを判定するとともに、今回レーダ物標TLの相対速度が相対速度の閾値内に入っているか否かを判定する。そして、衝突軽減ECU10では、この判定において全ての閾値内に入っている場合に今回レーダ物標TLが前回フュージョン物標LFと類似性があると判定し、1つでも閾値内に入っていない場合に類似性がないと判定する。この照合では、精度の高い情報がそれぞれ設定されている前回フュージョン物標を中心とし、レーダ物標が持っている位置情報を考慮して照合を行う。   The verification process will be described. First, the collision reduction ECU 10 collates the previous fusion target and the current radar target at regular time intervals. Specifically, as shown in FIG. 3, the collision mitigation ECU 10 sets a distance threshold and a lateral position threshold around the position (distance, lateral position) of the previous fusion target LF (as indicated by the broken line in FIG. 3). The relative velocity threshold is set with the relative velocity of the previous fusion target LF as the median value. Then, the collision mitigation ECU 10 determines whether or not the position (distance, lateral position) of the current radar target TL is within the distance threshold and the lateral position threshold with the position of the previous fusion target LF as the center. At the same time, it is determined whether or not the relative speed of the radar target TL is within the relative speed threshold value. The collision mitigation ECU 10 determines that the current radar target TL is similar to the previous fusion target LF when it is within all the thresholds in this determination, and if even one is not within the threshold. It is determined that there is no similarity. In this collation, collation is performed in consideration of position information held by the radar target with the previous fusion target in which highly accurate information is set as the center.

また、衝突軽減ECU10では、一定時間毎に、前回フュージョン物標と今回ステレオ画像物標との照合を行う。具体的には、衝突軽減ECU10では、図4に示すように、前回フュージョン物標LFの位置(距離、横位置、高さ位置)を中心として距離の閾値、横位置の閾値、高さ位置の閾値を設定するとともに物体の奥行きの閾値、物体の横幅の閾値、物体の高さの閾値を設定し(図4の破線で示す立体領域参照)、前回フュージョン物標LFの相対速度を中央値として相対速度の閾値を設定する。そして、衝突軽減ECU10では、今回ステレオ画像物標TIの位置(距離、横位置、高さ)が前回フュージョン物標LFの位置を中心とした距離の閾値内かつ横位置の閾値内かつ高さ位置の閾値内に入っているか否か及び今回ステレオ画像物標TIの大きさ(奥行き、横幅、高さ)が奥行きの閾値内かつ横幅の閾値内かつ高さの閾値内に入っているか否かを判定するとともに、今回ステレオ画像物標TIの相対速度が相対速度の閾値内に入っているか否かを判定する。そして、衝突軽減ECU10では、この判定において全ての閾値内に入っている場合に今回ステレオ画像物標TIが前回フュージョン物標LFと類似性があると判定し、1つでも閾値内に入っていない場合に類似性がないと判定する。この照合では、精度の高い情報がそれぞれ設定されている前回フュージョン物標を中心とし、ステレオ画像物標が持っている位置情報に立体物の大きさ情報を考慮して照合を行う。   In addition, the collision reduction ECU 10 collates the previous fusion target with the current stereo image target at regular time intervals. Specifically, as shown in FIG. 4, the collision mitigation ECU 10 sets the distance threshold value, the horizontal position threshold value, and the height position value around the position (distance, horizontal position, height position) of the previous fusion target LF. In addition to setting a threshold value, a threshold value for the depth of the object, a threshold value for the width of the object, and a threshold value for the height of the object (see the three-dimensional area indicated by the broken line in FIG. 4), and the relative speed of the previous fusion target LF as the median value Set the relative speed threshold. In the collision mitigation ECU 10, the position (distance, lateral position, height) of the current stereo image target TI is within the threshold of the distance centered on the position of the previous fusion target LF, and within the threshold of the lateral position and the height position. Whether or not the size (depth, width, height) of the current stereo image target TI is within the depth threshold, the width threshold, and the height threshold. At the same time, it is determined whether or not the relative speed of the stereo image target TI is within the relative speed threshold value. Then, the collision reduction ECU 10 determines that the current stereo image target TI is similar to the previous fusion target LF when it is within all the thresholds in this determination, and even one of them is not within the threshold. It is determined that there is no similarity in the case. In this collation, collation is performed in consideration of the size information of the three-dimensional object with respect to the position information held by the stereo image target with the previous fusion target in which highly accurate information is set as the center.

前回フュージョン物標に対して類似性のある今回レーダ物標と今回ステレオ画像物標がそれぞれ存在する場合、衝突軽減ECU10では、その今回レーダ物標と今回ステレオ画像物標との照合を行う。具体的には、衝突軽減ECU10では、図5に示すように、今回レーダ物標TLの位置(距離、横位置)を中心として距離の閾値、横位置の閾値を設定するとともに物体の奥行きの閾値、物体の横幅の閾値を設定し(図5の破線で示す平面領域参照)、今回レーダ物標TLの相対速度を中央値として相対速度の閾値を設定する。そして、衝突軽減ECU10では、今回ステレオ画像物標TIの位置(距離、横位置)が今回レーダ物標TLの位置を中心とした距離の閾値内かつ横位置の閾値内に入っているか否か及び今回ステレオ画像物標TIの大きさ(奥行き、横幅)が奥行きの閾値内かつ横幅の閾値内に入っているか否かを判定するとともに、今回ステレオ画像物標TIの相対速度が相対速度の閾値内に入っているか否かを判定する。そして、衝突軽減ECU10では、この判定において全ての閾値内に入っている場合に今回レーダ物標TLと今回ステレオ画像物標TIとが類似性があると判定し、1つでも閾値内に入っていない場合に類似性がないと判定する。類似性があると判定した場合、衝突軽減ECU10では、その今回レーダ物標TLと今回ステレオ画像物標TIとの組み合せを記憶する。一方、類似性がないと判定した場合、衝突軽減ECU10では、前回フュージョン物標を削除する。この照合では、距離の精度が高く、物体のほぼ中央を横位置とする今回レーダ物標を中心とし、レーダ物標とステレオ画像物標が持っている位置情報にステレオ画像物標の持っている大きさ情報を考慮して照合を行う。   When there are a current radar target and a current stereo image target similar to the previous fusion target, the collision reduction ECU 10 compares the current radar target with the current stereo image target. Specifically, as shown in FIG. 5, the collision mitigation ECU 10 sets a distance threshold value and a horizontal position threshold value around the position (distance, horizontal position) of the current radar target TL, and also sets a depth threshold value of the object. Then, the threshold value of the horizontal width of the object is set (see the plane area indicated by the broken line in FIG. 5), and the relative speed threshold value is set with the relative speed of the current radar target TL as the median value. Then, the collision reduction ECU 10 determines whether or not the position (distance, lateral position) of the current stereo image target TI is within the distance threshold and the lateral position threshold with the position of the current radar target TL as the center. It is determined whether or not the size (depth, width) of the stereo image target TI is within the depth threshold and the width threshold, and the relative speed of the stereo image target TI is within the relative speed threshold. It is determined whether or not. Then, the collision mitigation ECU 10 determines that the current radar target TL and the current stereo image target TI are similar if they are within all the thresholds in this determination, and even one of them is within the threshold. If not, it is determined that there is no similarity. When it is determined that there is similarity, the collision reduction ECU 10 stores the combination of the current radar target TL and the current stereo image target TI. On the other hand, if it is determined that there is no similarity, the collision reduction ECU 10 deletes the previous fusion target. In this collation, the distance accuracy is high, the current radar target with the horizontal position at the center of the object is the center, and the stereo image target has the position information held by the radar target and the stereo image target. Matches in consideration of size information.

レーダ物標が複数個存在する場合、1個のステレオ画像物標と複数個のレーダ物標とがそれぞれ類似性を持つことがある。特に、前方車両の一部が影になっていることなどを要因としてステレオ画像物標として前方車両の一部しか検出していない場合(ステレオ画像物標の大きさ情報が車両の大きさより小さい場合)、その前方車両の一部からなるステレオ画像物標がその複数個の各レーダ物標を中心とした各閾値条件をそれぞれ満たしてしまう可能性である。例えば、図6に示すように、ステレオ画像物標TIとして前方車両の左端部を検出している場合、そのステレオ画像物標TIの大きさ情報は小さいので、車線内の左端部に位置する物体を検出したレーダ物標TL1を中心とした各閾値条件をステレオ画像物標TIが全ての満たし、また、車線内の中心付近に位置する物体を検出したレーダ物標TL2を中心とした各閾値条件をステレオ画像物標TIが全て満たし、1個のステレオ画像物標TIが2個のレーダ物標TL1,TL2とそれぞれ類似性があると判定される。この場合、この複数個のレーダ物標TL1,TL2から、ステレオ画像物標TIと同一物体であると判断できるレーダ物標を1個に絞る必要がある。   When there are a plurality of radar targets, one stereo image target and a plurality of radar targets may have similarities. In particular, when only a part of the front vehicle is detected as a stereo image target due to a part of the front vehicle being shaded or the like (when the size information of the stereo image target is smaller than the size of the vehicle) ), There is a possibility that a stereo image target composed of a part of the preceding vehicle will satisfy each threshold condition centered on each of the plurality of radar targets. For example, as shown in FIG. 6, when the left end portion of the preceding vehicle is detected as the stereo image target TI, the size information of the stereo image target TI is small, so the object located at the left end portion in the lane The stereo image target TI satisfies all the threshold conditions centered on the radar target TL1 that detected the object, and each threshold condition centered on the radar target TL2 detected the object located near the center in the lane Are satisfied by the stereo image target TI, and one stereo image target TI is determined to be similar to the two radar targets TL1 and TL2. In this case, the radar target that can be determined to be the same object as the stereo image target TI needs to be narrowed down to one from the plurality of radar targets TL1 and TL2.

自車両が走行しているときの検出対象が前方車両である場合、前方車両は自車両の車幅方向の中心における推測走行軌跡に近いところを走行している可能性が高い。そこで、複数個のレーダ物標が存在する場合、複数個のレーダ物標から自車両の車幅方向の中心の推測走行軌跡に近いレーダ物標を選択する。この場合、通常、車両は車線の中心部を走行する可能性が高いので、自車両の車幅方向の中心の推定走行軌跡は自車両が走行している車線の中心とみなして処理することができる。   When the subject of detection when the host vehicle is traveling is a forward vehicle, it is highly likely that the forward vehicle is traveling near the estimated traveling locus at the center of the host vehicle in the vehicle width direction. Therefore, when there are a plurality of radar targets, a radar target that is close to the estimated traveling locus in the center in the vehicle width direction of the host vehicle is selected from the plurality of radar targets. In this case, since the vehicle is likely to travel in the center of the lane, the estimated travel locus at the center in the vehicle width direction of the host vehicle can be regarded as the center of the lane in which the host vehicle is traveling. it can.

検出対象が前方車両であり、車両は車線の端部付近より中央付近を走行している確率が高いので、車両の車幅方向の中心は車線の端部より中心に近いと推測できる。また、ミリ波レーダ2による物体検出では横位置として物体の中央付近を検出する可能性が高い。したがって、車線の中心に近いレーダ物標ほど、車両である可能性が高い。そこで、複数個のレーダ物標から1個のレーダ物標に絞るために、各レーダ物標について横位置と車線の中心線との距離をそれぞれ求め、その距離が最も短いレーダ物標を選択する。図6に示す例の場合、車線の中心線LCにレーダ物標TL2の方が近いので、レーダ物標TL2が選択され、レーダ物標TL2とステレオ画像物標TIとが同一物体と判断される。   Since the detection target is a forward vehicle and the vehicle is more likely to travel near the center than near the end of the lane, it can be estimated that the center in the vehicle width direction of the vehicle is closer to the center than the end of the lane. In the object detection by the millimeter wave radar 2, there is a high possibility of detecting the vicinity of the center of the object as a lateral position. Therefore, the radar target closer to the center of the lane is more likely to be a vehicle. Therefore, in order to narrow down a plurality of radar targets to one radar target, the distance between the lateral position and the center line of the lane is obtained for each radar target, and the radar target having the shortest distance is selected. . In the case of the example shown in FIG. 6, since the radar target TL2 is closer to the center line LC of the lane, the radar target TL2 is selected, and the radar target TL2 and the stereo image target TI are determined to be the same object. .

任意のフュージョン物標について類似性のある全ての今回レーダ物標と全ての今回ステレオ画像物標との全ての組み合せについての照合が終了すると、衝突軽減ECU10では、今回レーダ物標と今回ステレオ画像物標とで類似性があると判定されて記憶されている組み合せから、1個のステレオ画像物標に対して類似性があると判定された今回レーダ物標が1個または複数個かを判定する。類似性がある今回レーダ物標が1個と判定した場合、衝突軽減ECU10では、その任意のフュージョン物標を今回フュージョン物標として更新し、今回フュージョン物標の情報として今回レーダ物標の距離及び相対速度を設定するとともに今回ステレオ画像物標の横位置、横幅、奥行き、高さ、高さ位置を設定する。   When collation for all combinations of all current radar targets and all current stereo image targets that are similar for any fusion target is completed, the collision mitigation ECU 10 causes the current radar target and the current stereo image object to be collated. It is determined whether there is one or a plurality of current radar targets that are determined to be similar to one stereo image target from a combination that is determined to be similar to the target and stored. . When it is determined that there is one similar radar target this time, the collision mitigation ECU 10 updates the arbitrary fusion target as the current fusion target, and uses the distance of the current radar target and the current fusion target as information. In addition to setting the relative speed, the horizontal position, width, depth, height, and height position of the current stereo image target are set.

一方、類似性がある今回レーダ物標が複数個と判定した場合、衝突軽減ECU10では、複数個の今回レーダ物標の中から今回ステレオ画像物標と同一物体と判断できる今回レーダ物標を選択する。具体的には、衝突軽減ECU10では、今回レーダ物標毎に、今回レーダ物標の横位置を用いて、今回レーダ物標と車線の中心線との距離を演算する。そして、衝突軽減ECU10では、複数個の今回レーダ物標について車線の中心線からの各距離を比較し、最も短い距離の今回レーダ物標を選択する。さらに、衝突軽減ECU10では、その選択した今回レーダ物標によってその任意のフュージョン物標を今回フュージョン物標として更新し、今回フュージョン物標の情報としてその選択した今回レーダ物標の距離及び相対速度を設定するとともに今回ステレオ画像物標の横位置、横幅、奥行き、高さ、高さ位置を設定する。   On the other hand, when it is determined that there are a plurality of similar radar targets this time, the collision reduction ECU 10 selects a current radar target that can be determined as the same object as the current stereo image target from the plurality of current radar targets. To do. Specifically, the collision reduction ECU 10 calculates the distance between the current radar target and the center line of the lane using the lateral position of the current radar target for each current radar target. Then, the collision reduction ECU 10 compares the distances from the center line of the lane for a plurality of current radar targets, and selects the current radar target having the shortest distance. Further, the collision mitigation ECU 10 updates the arbitrary fusion target as the current fusion target with the selected current radar target, and determines the distance and relative velocity of the selected current radar target as information on the current fusion target. At the same time, the horizontal position, width, depth, height, and height position of the stereo image target are set.

図7を参照して、レーダ物標TLと車線の中心線LCとの距離X’の演算方法について説明する。衝突軽減ECU10では、自車両の車幅方向の中心の推測走行軌跡が車線の中心と一致していると仮定してレーダ物標と車線の中心線との距離を演算する。まず、衝突軽減ECU10では、ヨーレート信号に基づくヨーレートYが0か否かを判定する。ヨーレートYが0の場合(すなわち、自車両が直進している場合)、衝突軽減ECU10では、レーダ物標の横位置Xの絶対値をレーダ物標TLと車線の中心線LCとの距離X’として設定する。   With reference to FIG. 7, a method of calculating the distance X ′ between the radar target TL and the center line LC of the lane will be described. The collision mitigation ECU 10 calculates the distance between the radar target and the center line of the lane on the assumption that the estimated traveling locus of the center of the host vehicle in the vehicle width direction coincides with the center of the lane. First, the collision reduction ECU 10 determines whether or not the yaw rate Y based on the yaw rate signal is zero. When the yaw rate Y is 0 (that is, when the host vehicle is traveling straight), the collision reduction ECU 10 uses the absolute value of the lateral position X of the radar target as the distance X ′ between the radar target TL and the center line LC of the lane. Set as.

一方、ヨーレートYが0でない場合(すなわち、自車両が道路に沿って旋回している場合)、衝突軽減ECU10では、現在走行している道路のカーブRを推定するために、式(1)により、車速信号に基づく自車速VとヨーレートYを用いてカーブRを演算する。カーブRが0より大きい場合、衝突軽減ECU10では、式(2)により、カーブRとレーダ物標TLに設定されている自車両からレーダ物標TLまでの距離Zを用いて、自車両の現在位置とレーダ物標の前方位置における車幅方向の距離XRを演算する。そして、衝突軽減ECU10では、式(3)により、車幅方向の距離XRとレーダ物標TLに設定されている横位置Xを用いて、レーダ物標TLと車線の中心線LCとの距離X’を演算する。一方、カーブRが0より小さい場合、衝突軽減ECU10では、式(4)により、カーブRとレーダ物標TLまでの距離Zを用いて、自車両の現在位置とレーダ物標TLの前方位置における車幅方向の距離XRを演算する。そして、衝突軽減ECU10では、式(5)により、車幅方向の距離XRと横位置Xを用いて、レーダ物標TLと車線の中心線LCとの距離X’を演算する。このように、車線の中心線LCを自車両の車幅方向の中心の推測走行軌跡として処理することになる。   On the other hand, when the yaw rate Y is not 0 (that is, when the host vehicle is turning along the road), the collision reduction ECU 10 uses Equation (1) to estimate the curve R of the currently traveling road. Then, the curve R is calculated using the vehicle speed V and the yaw rate Y based on the vehicle speed signal. When the curve R is larger than 0, the collision reduction ECU 10 uses the distance Z from the vehicle R to the radar target TL set to the curve R and the radar target TL according to the equation (2) to A distance XR in the vehicle width direction between the position and the front position of the radar target is calculated. Then, the collision mitigation ECU 10 uses the distance XR in the vehicle width direction and the lateral position X set in the radar target TL according to Equation (3) to calculate the distance X between the radar target TL and the center line LC of the lane. 'Is calculated. On the other hand, when the curve R is smaller than 0, the collision reduction ECU 10 uses the distance Z between the curve R and the radar target TL according to the equation (4), at the current position of the host vehicle and the position ahead of the radar target TL. The distance XR in the vehicle width direction is calculated. Then, the collision reduction ECU 10 calculates the distance X ′ between the radar target TL and the center line LC of the lane by using the distance XR in the vehicle width direction and the lateral position X according to the equation (5). Thus, the center line LC of the lane is processed as the estimated travel locus of the center of the host vehicle in the vehicle width direction.

Figure 2006292681
Figure 2006292681

但し、ヨーレートYは、車両の右旋回をときにはプラス値であり、左旋回のときにはマイナス値に設定されている。したがって、カーブRも、車両の右旋回をときにはプラス値となり、左旋回のときにはマイナス値になる。また、横位置Xは、自車両の横位置を0として右側がプラス値であり、左側がマイナス値である。また、カーブRの絶対値が自車両からレーダ物標までの距離Zよりも大きいことを条件としている。   However, the yaw rate Y is set to a positive value when the vehicle turns right, and set to a negative value when the vehicle turns left. Accordingly, the curve R also has a positive value when the vehicle turns right and a negative value when the vehicle turns left. Further, the lateral position X is a positive value on the right side and a negative value on the left side when the lateral position of the host vehicle is 0. The absolute value of the curve R is required to be larger than the distance Z from the own vehicle to the radar target.

更新された今回フュージョン物標と類似性がなかった今回レーダ物標と今回ステレオ画像とがそれぞれ残っている場合、衝突軽減ECU10では、その残っている今回レーダ物標と今回ステレオ画像物標との照合を行う。この照合方法は、上記した今回レーダ物標と今回ステレオ画像と同様の照合方法である。衝突軽減ECU10では、類似性があると判定した今回レーダ物標と今回ステレオ画像とがある場合には今回フュージョン物標として新たに設定し、上記と同様に今回フュージョン物標の各情報を設定する。この場合も、1個のステレオ画像物標と類似性を持つレーダ物標が複数個存在する場合、上記と同様の方法により、複数個のレーダ物標から1個のレーダ物標を選択し、その選択したレーダ物標を用いて今回フュージョン物標の各情報を設定する。   When the current radar target and the current stereo image that are not similar to the updated current fusion target remain, the collision reduction ECU 10 determines whether the remaining current radar target and the current stereo image target are the same. Perform verification. This collation method is a collation method similar to the above-described current radar target and the current stereo image. In the collision mitigation ECU 10, if there is a current radar target and a current stereo image determined to be similar, a new fusion target is newly set, and each information of the current fusion target is set in the same manner as described above. . Also in this case, when there are a plurality of radar targets similar to one stereo image target, one radar target is selected from the plurality of radar targets by the same method as described above. Each information of the fusion target this time is set using the selected radar target.

なお、各照合において照合対象の物標が複数ある場合(例えば、今回レーダ物標が複数ある場合)、全ての組み合せについてそれぞれ照合を行う。また、各閾値は、ミリ波レーダ2やステレオカメラ3による検出精度などを考慮して予め設定され、衝突軽減ECU10に格納されている。距離の閾値や相対速度の閾値については、自車両の車速を考慮して可変としてもよい。奥行き、横幅、高さは物体の大きさを表し、検出対象が車両なので、奥行き、横幅、高さの各閾値については一般的な車両の大きさに基づいて設定される。   When there are a plurality of targets to be collated in each collation (for example, when there are a plurality of radar targets this time), collation is performed for all combinations. Each threshold value is set in advance in consideration of detection accuracy by the millimeter wave radar 2 and the stereo camera 3 and stored in the collision mitigation ECU 10. The distance threshold and the relative speed threshold may be variable in consideration of the vehicle speed of the host vehicle. Depth, width, and height represent the size of the object. Since the detection target is a vehicle, the threshold values of depth, width, and height are set based on the size of a general vehicle.

図8には、路側付近を走行中の自動二輪車がレーダ物標TL1として検出され、車線の中央を走行中の前方車両がレーダ物標TL2として検出され、前方車両の左端部がステレオ画像物標TIとして検出されている場合の照合結果の一例を示している。ステレオ画像物標TIは、その位置が2個のレーダ物標TL1,TL2とそれぞれ近くかつ横幅情報が狭いので、2個のレーダ物標TL1,TL2とそれぞれ類似性があると判断される。この際、レーダ物標TL1の車線の中心線からの距離とレーダ物標TL2の車線の中心線からの距離とを比較すると、レーダ物標TL2の車線の中心線からの距離が短いので、レーダ物標TL2がステレオ画像物標TIと同一物体と判断される。また、図9には、路側に立っているポールがレーダ物標TL1として検出され、車線の中央を走行中の前方車両がレーダ物標TL2として検出され、前方車両の左端部がステレオ画像物標TIとして検出されている場合の照合結果の一例を示している。この場合も、図8の例と同様に、レーダ物標TL2がステレオ画像物標TIと同一物体と判断される。このように、ステレオ画像物標が複数個のレーダ物標と類似性がある場合でも、各レーダ物標の車線の中心線からの距離を用いることにより、前方車両を検出対象の物体として検出し、路側付近の自動二輪車やポールなどの車線の中心線から離れている物体を検出しない。ちなみに、前方車両の全体がステレオ画像物標TIとして検出されている場合、ステレオ画像物標TIの横幅情報は広くなるので、レーダ物標TL1を中心とした各閾値条件を満たさなくなり、レーダ物標TL1とは類似性がないと判断される。   In FIG. 8, a motorcycle traveling near the roadside is detected as a radar target TL1, a forward vehicle traveling in the center of the lane is detected as a radar target TL2, and the left end of the forward vehicle is a stereo image target. An example of a collation result when it is detected as TI is shown. Since the stereo image target TI is close to the two radar targets TL1 and TL2 and has narrow width information, it is determined that the stereo image target TI is similar to the two radar targets TL1 and TL2. At this time, when the distance from the center line of the radar target TL1 to the center line of the radar target TL2 is compared with the distance from the center line of the radar target TL2, the distance from the center line of the radar target TL2 is short. It is determined that the target TL2 is the same object as the stereo image target TI. Further, in FIG. 9, the pole standing on the road side is detected as the radar target TL1, the front vehicle traveling in the center of the lane is detected as the radar target TL2, and the left end of the front vehicle is the stereo image target. An example of a collation result when it is detected as TI is shown. Also in this case, as in the example of FIG. 8, the radar target TL2 is determined to be the same object as the stereo image target TI. Thus, even when a stereo image target is similar to a plurality of radar targets, the vehicle ahead is detected as an object to be detected by using the distance from the center line of the lane of each radar target. Does not detect objects that are far from the center line of the lane such as motorcycles and poles near the roadside. Incidentally, when the entire preceding vehicle is detected as the stereo image target TI, the width information of the stereo image target TI becomes wide, so that each threshold condition centering on the radar target TL1 is not satisfied, and the radar target is not satisfied. It is determined that there is no similarity with TL1.

衝突軽減処理について説明する。今回フュージョン物標がある場合(つまり、前方車両が存在する場合)、衝突軽減ECU10では、車速を考慮して、今回フュージョン物標に設定されている距離情報に基づいて衝突する可能性の段階(例えば、可能性が高い、低い、無しの3段階)を設定する。そして、衝突軽減ECU10では、衝突する可能性の段階に応じて、ブレーキECU6、サスペンション制御アクチュエータ7,・・・、シートベルトアクチュエータ8,・・・、ブザー9を制御する。   The collision mitigation process will be described. When there is a fusion target this time (that is, when there is a forward vehicle), the collision reduction ECU 10 considers the vehicle speed and is a stage of a possibility of a collision based on the distance information set for the fusion target this time ( For example, three stages of high possibility, low possibility, and none are set. The collision mitigation ECU 10 controls the brake ECU 6, the suspension control actuators 7,..., The seat belt actuators 8,.

この制御を衝突する可能性の段階が3段階の場合を例に挙げて説明する。衝突の可能性が無い段階では、衝突軽減ECU10では、ブレーキECU6、サスペンション制御アクチュエータ7,・・・、シートベルトアクチュエータ8,・・・、ブザー9に対する制御を行わない。   The case where there is a three-stage possibility of collision of this control will be described as an example. In a stage where there is no possibility of collision, the collision reduction ECU 10 does not control the brake ECU 6, the suspension control actuators 7,..., The seat belt actuators 8,.

衝突の可能性が低い段階では、衝突軽減ECU10では、ブレーキECU6、サスペンション制御アクチュエータ7,・・・に対する制御を行わず、シートベルトアクチュエータ8,・・・、ブザー9に対する制御を行う。具体的には、衝突軽減ECU10では、前方に車両が接近していることを知らせるためにシートベルトを少し引き込むための目標引込量信号を設定し、その目標引込量信号をシートベルトアクチュエータ8,・・・にそれぞれ送信する(運転席のシートベルトアクチュエータ8にのみ送信するようにしてもよい)。また、衝突軽減ECU10では、前方に車両が接近していることを知らせるために警報信号を設定し、その警報信号をブザー9に送信する。   At the stage where the possibility of collision is low, the collision reduction ECU 10 does not control the brake ECU 6, the suspension control actuators 7,..., But controls the seat belt actuators 8,. Specifically, the collision reduction ECU 10 sets a target pull-in amount signal for slightly retracting the seat belt in order to notify that the vehicle is approaching ahead, and the target pull-in amount signal is set as the seat belt actuator 8. .. (To be transmitted only to the seat belt actuator 8 in the driver's seat). Further, the collision mitigation ECU 10 sets an alarm signal to notify that the vehicle is approaching ahead, and transmits the alarm signal to the buzzer 9.

衝突の可能性が高い段階では、衝突軽減ECU10では、ブレーキECU6、サスペンション制御アクチュエータ7,・・・、シートベルトアクチュエータ8,・・・、ブザー9全てに対する制御を行う。具体的には、衝突軽減ECU10では、車両を減速させるための目標ブレーキ力信号を設定し、その目標ブレーキ力信号をブレーキECU6に送信する。また、衝突軽減ECU10では、車両が傾かないように(前部が沈みこまないように)するための目標減衰力信号を設定し、その目標減衰力信号をサスペンション制御アクチュエータ7,・・・にそれぞれ送信する。また、衝突軽減ECU10では、乗員を強く拘束するための目標引込量信号を設定し、その目標引込量信号をシートベルトアクチュエータ8,・・・にそれぞれ送信する。また、衝突軽減ECU10では、前方に車両が接近していることを知らせるために警報信号を設定し、その警報信号をブザー9に送信する。   At a stage where the possibility of a collision is high, the collision reduction ECU 10 controls the brake ECU 6, the suspension control actuators 7,..., The seat belt actuators 8,. Specifically, the collision reduction ECU 10 sets a target brake force signal for decelerating the vehicle, and transmits the target brake force signal to the brake ECU 6. Further, the collision mitigation ECU 10 sets a target damping force signal for preventing the vehicle from tilting (so that the front portion does not sink), and sends the target damping force signal to the suspension control actuators 7. Send. Further, the collision reduction ECU 10 sets a target pull-in amount signal for strongly restraining the occupant, and transmits the target pull-in amount signal to the seat belt actuators 8. Further, the collision mitigation ECU 10 sets an alarm signal to notify that the vehicle is approaching ahead, and transmits the alarm signal to the buzzer 9.

なお、衝突する可能性だけでなく、前方車両とのオーバラップ量なども求め、これら他の情報も考慮してブレーキECU6、サスペンション制御アクチュエータ7,・・・、シートベルトアクチュエータ8,・・・、ブザー9を制御するようにしてもよい。   In addition to the possibility of a collision, the amount of overlap with the vehicle ahead is also determined, and the brake ECU 6, suspension control actuator 7,..., Seat belt actuator 8,. The buzzer 9 may be controlled.

図1〜図7を参照して、衝突軽減装置1における動作について説明する。特に、衝突軽減ECU10における照合処理の流れについては図10のフローチャートに沿って説明する。図10は、第1の実施の形態に係る照合処理の流れを示すフローチャートである。   With reference to FIGS. 1-7, the operation | movement in the collision mitigation apparatus 1 is demonstrated. In particular, the flow of collation processing in the collision mitigation ECU 10 will be described with reference to the flowchart of FIG. FIG. 10 is a flowchart showing a flow of collation processing according to the first embodiment.

ミリ波レーダ2では、前方にミリ波を送信するとともに反射してきたミリ波を受信し、その送受信データをレーダ信号として衝突軽減ECU10に送信する。ステレオカメラ3では、前方をそれぞれ撮像し、その撮像した左右のステレオ画像を各画像信号として衝突軽減ECU10にそれぞれ送信する。車速センサ4では、自車両の車速を検出し、その検出値を車速信号として衝突軽減ECU10に送信する。ヨーレートセンサ5では、自車両のヨーレートを検出し、その検出値をヨーレート信号として衝突軽減ECU10に送信する。   The millimeter wave radar 2 transmits the millimeter wave forward and receives the reflected millimeter wave, and transmits the transmission / reception data as a radar signal to the collision mitigation ECU 10. The stereo camera 3 images the front and transmits the captured left and right stereo images to the collision reduction ECU 10 as image signals. The vehicle speed sensor 4 detects the vehicle speed of the host vehicle, and transmits the detected value to the collision reduction ECU 10 as a vehicle speed signal. The yaw rate sensor 5 detects the yaw rate of the host vehicle, and transmits the detected value to the collision reduction ECU 10 as a yaw rate signal.

衝突軽減ECU10では、ミリ波レーダ2からのレーダ信号を受信するとともに、ステレオカメラ3からの各画像信号をそれぞれ受信する。そして、衝突軽減ECU10では、一定時間毎に、レーダ信号によるレーダ情報に基づいてレーダ物標を設定する。また。衝突軽減ECU10では、一定時間毎に、各画像信号による左右のステレオ画像に基づいてステレオ画像物標を設定する。   The collision mitigation ECU 10 receives a radar signal from the millimeter wave radar 2 and receives each image signal from the stereo camera 3. Then, the collision mitigation ECU 10 sets a radar target based on radar information based on radar signals at regular time intervals. Also. The collision reduction ECU 10 sets a stereo image target based on the left and right stereo images of each image signal at regular intervals.

そして、衝突軽減ECU10では、一定時間毎に、以下の照合処理を行う。衝突軽減ECU10では、距離、横位置の位置情報及び相対速度により、前回フュージョン物標とレーダ物標との照合を行う(S10)。また、衝突軽減ECU10では、距離、横位置、高さ位置の位置情報、奥行き、横幅、高さの大きさ情報及び相対速度により、前回フュージョン物標とステレオ画像物標との照合を行う(S11)。そして、前回フュージョン物標と類似性のあるレーダ物標とステレオ画像物標がそれぞれ存在する場合、衝突軽減ECU10では、距離、横位置の位置情報、奥行き、横幅の大きさ情報及び相対速度により、そのレーダ物標とステレオ画像物標との照合を行う(S12)。   Then, the collision reduction ECU 10 performs the following verification process at regular intervals. The collision mitigation ECU 10 collates the previous fusion target and the radar target based on the distance, the position information of the lateral position, and the relative speed (S10). Further, the collision mitigation ECU 10 collates the previous fusion target with the stereo image target based on the position information of the distance, the horizontal position, the height position, the depth, the width, the height information, and the relative speed (S11). ). Then, when there are a radar target and a stereo image target similar to the previous fusion target, the collision reduction ECU 10 uses the distance, the position information of the lateral position, the depth, the size information of the lateral width, and the relative speed, The radar target is compared with the stereo image target (S12).

衝突軽減ECU10では、S12での照合において類似性があるか否かを判定する(S13)。S13にて類似性があると判定した場合、衝突軽減ECU10では、ステレオ画像物標と類似性を持つレーダ物標が2個以上存在するか否かを判定する(S14)。S14にて2個以上存在すると判定した場合、衝突軽減ECU10では、レーダ物標毎に車線の中心線からレーダ物標までの距離をそれぞれ演算し、2個以上のレーダ物標についての車線の中心線からの各距離を比較する。そして、衝突軽減ECU10では、距離が最も短いレーダ物標を選択し、その選択したレーダ物標と類似性のあったステレオ画像物標とにより前回フュージョン物標を今回フュージョン物標に更新し、その今回フュージョン物標の情報としてその選択したレーダ物標の距離及び相対速度を設定するとともにステレオ画像物標の横位置、横幅、奥行き、高さ、高さ位置を設定する(S15)。この際、類似性のあったレーダ物標とステレオ画像物標を削除する。一方、S14にて1個存在すると判定した場合、衝突軽減ECU10では、その1対1で類似性のあったレーダ物標とステレオ画像物標とにより前回フュージョン物標を今回フュージョン物標に更新し、その今回フュージョン物標の情報としてそのレーダ物標の距離及び相対速度を設定するとともにステレオ画像物標の横位置、横幅、奥行き、高さ、高さ位置を設定する(S16)。この際、類似性のあったレーダ物標とステレオ画像物標を削除する。一方、S13にて類似性がないと判定した場合、衝突軽減ECU10では、照合を行った前回フュージョン物標を削除する(S17)。このS10〜S17までの処理を、全ての前回フュージョン物標と全てのレーダ物標及び全てのステレオ画像物標との全ての組み合せについて行う。ここまでの処理によって、前回フュージョン物標に対する追跡が終了する。   The collision reduction ECU 10 determines whether there is similarity in the collation in S12 (S13). If it is determined that there is similarity in S13, the collision reduction ECU 10 determines whether there are two or more radar targets that are similar to the stereo image target (S14). If it is determined in S14 that there are two or more, the collision reduction ECU 10 calculates the distance from the center line of the lane to the radar target for each radar target, and the center of the lane for two or more radar targets. Compare each distance from the line. The collision mitigation ECU 10 selects the radar target with the shortest distance, updates the previous fusion target to the current fusion target with the stereo image target similar to the selected radar target, and At this time, the distance and relative speed of the selected radar target are set as fusion target information, and the horizontal position, width, depth, height, and height position of the stereo image target are set (S15). At this time, the similar radar target and stereo image target are deleted. On the other hand, if it is determined in S14 that there is one, the collision reduction ECU 10 updates the previous fusion target to the current fusion target using the radar target and the stereo image target that are similar one-to-one. Then, the distance and relative speed of the radar target are set as information on the fusion target this time, and the horizontal position, width, depth, height, and height position of the stereo image target are set (S16). At this time, the similar radar target and stereo image target are deleted. On the other hand, if it is determined in S13 that there is no similarity, the collision reduction ECU 10 deletes the previous fusion target that has been collated (S17). The processing from S10 to S17 is performed for all combinations of all previous fusion targets, all radar targets, and all stereo image targets. By the processing so far, the tracking for the previous fusion target is completed.

レーダ物標とステレオ画像物標が残っている場合、衝突軽減ECU10では、距離、横位置の位置情報、奥行き、横幅の大きさ情報及び相対速度により、レーダ物標とステレオ画像物標との照合を行う(S18)。   When the radar target and the stereo image target remain, the collision reduction ECU 10 compares the radar target with the stereo image target based on the distance, the position information of the lateral position, the depth, the size information of the width, and the relative speed. (S18).

衝突軽減ECU10では、S18での照合において類似性があるか否かを判定する(S19)。S19にて類似性があると判定した場合、衝突軽減ECU10では、ステレオ画像物標と類似性を持つレーダ物標が2個以上存在するか否かを判定する(S20)。S20にて2個以上存在すると判定した場合、衝突軽減ECU10では、レーダ物標毎に車線の中心線からレーダ物標までの距離をそれぞれ演算し、2個以上のレーダ物標についての車線の中心線からの各距離を比較する。そして、衝突軽減ECU10では、距離が最も短いレーダ物標を選択し、その選択したレーダ物標と類似性のあったステレオ画像物標とにより今回フュージョン物標を設定し、その今回フュージョン物標の情報としてその選択したレーダ物標の距離及び相対速度を設定するとともにステレオ画像物標の横位置、横幅、奥行き、高さ、高さ位置を設定する(S21)。一方、S20にて1個存在すると判定した場合、衝突軽減ECU10では、その1対1で類似性のあったレーダ物標とステレオ画像物標とにより今回のフュージョン物標を設定し、その今回フュージョン物標の情報としてそのレーダ物標の距離及び相対速度を設定するとともにステレオ画像物標の横位置、横幅、奥行き、高さ、高さ位置を設定する(S22)。このS18〜S22までの処理を、残っていた全てのレーダ物標と全てのステレオ画像物標との全ての組み合せについて行う。ここまでの処理によって、全てのレーダ物標と全てのステレオ画像物標との照合処理が終了する。   The collision reduction ECU 10 determines whether there is similarity in the collation in S18 (S19). If it is determined in S19 that there is similarity, the collision reduction ECU 10 determines whether there are two or more radar targets that are similar to the stereo image target (S20). When it is determined that there are two or more in S20, the collision reduction ECU 10 calculates the distance from the center line of the lane to the radar target for each radar target, and the center of the lane for two or more radar targets. Compare each distance from the line. Then, the collision mitigation ECU 10 selects the radar target having the shortest distance, sets the current fusion target with the stereo image target similar to the selected radar target, and sets the current fusion target. The distance and relative speed of the selected radar target are set as information, and the horizontal position, width, depth, height, and height position of the stereo image target are set (S21). On the other hand, if it is determined in S20 that there is one, the collision mitigation ECU 10 sets the current fusion target by using the radar target and the stereo image target that are similar one-to-one, and the current fusion. The distance and relative speed of the radar target are set as target information, and the horizontal position, width, depth, height, and height position of the stereo image target are set (S22). The processing from S18 to S22 is performed for all combinations of all remaining radar targets and all stereo image targets. By the processing so far, the collation processing of all radar targets and all stereo image targets is completed.

なお、前回フュージョン物標が設定されていない場合、衝突軽減ECU10では、S10〜S17の処理を行わずに、S18の処理から照合処理を行う。また、今回フュージョン物標を更新後にレーダ物標、ステレオ画像物標が残らなかった場合、衝突軽減ECU10では、S18〜S22の処理を行わずに、今回の照合処理を終了する。また、レーダ物標、ステレオ画像物標の少なくとも一方の物標が設定されていない場合、今回の照合処理を行わない。   When the previous fusion target has not been set, the collision reduction ECU 10 performs the matching process from the process of S18 without performing the processes of S10 to S17. If no radar target or stereo image target remains after the current fusion target is updated, the collision reduction ECU 10 ends the current collation process without performing the processes of S18 to S22. In addition, when at least one of the radar target and the stereo image target is not set, the current matching process is not performed.

照合処理によって今回のフュージョン物標が設定された場合、衝突軽減ECU10では、そのフュージョン物標に設定されている情報に基づいて衝突する可能性の段階を設定し、衝突する可能性の段階に応じて、ブレーキECU6、サスペンション制御アクチュエータ7,・・・、シートベルトアクチュエータ8,・・・、ブザー9を制御する。この制御によって、前方車両との衝突の可能性が低い段階では、シートベルトアクチュエータ8,・・・によるシートベルトの引き込みとブザー9によるブザー音の出力によって前方車両の接近を運転者に認識させる。さらに、前方車両との衝突の可能性が高くなると、ブレーキECU6による自動ブレーキ力による減速とサスペンション制御アクチュエータ7,・・・によるサスペンションの硬さ調節を行い、シートベルトアクチュエータ8,・・・によるシートベルトの更なる引き込みによって乗員を強く拘束し、ブザー9によるブザー音の出力によって前方車両の更なる接近を運転者に認識させる。一方、照合処理によって今回のフュージョン物標が設定されなかった場合、衝突軽減ECU10では、今回の衝突軽減処理を行わない。   When the current fusion target is set by the collation process, the collision reduction ECU 10 sets the stage of possibility of collision based on the information set in the fusion target, and according to the stage of possibility of collision The brake ECU 6, the suspension control actuator 7,..., The seat belt actuator 8,. With this control, when the possibility of a collision with the preceding vehicle is low, the driver recognizes the approach of the preceding vehicle by the seat belt retracting by the seat belt actuators 8... And the buzzer 9 outputting the buzzer sound. Furthermore, when the possibility of a collision with the vehicle ahead increases, the brake ECU 6 decelerates by automatic braking force and the suspension hardness is adjusted by the suspension control actuators 7..., And the seat belt actuators 8. The occupant is strongly restrained by further retracting the belt, and the driver is made to recognize further approach of the vehicle ahead by the output of the buzzer sound by the buzzer 9. On the other hand, when the current fusion target is not set by the collation process, the collision reduction ECU 10 does not perform the current collision reduction process.

この衝突軽減装置1によれば、ステレオ画像物標と類似性を持つレーダ物標が複数個存在する場合、その複数個のレーダ物標の車線の中心線からの距離を比較することにより、そのステレオ画像物標と同一物体と判断できるレーダ物標を選択でき、前方車両を高精度に検出することができる。特に、衝突軽減装置1では、レーダ物標の車線の中心線からの距離を演算する際に車線の中心と自車両の車幅方向の中心の走行軌跡とが一致していると仮定して演算を行うので、車線の中心線を推測する手段を必要とせず、構成を簡単化できる。   According to this collision mitigation apparatus 1, when there are a plurality of radar targets having similarity to a stereo image target, the distances from the center line of the lane of the plurality of radar targets are compared, A radar target that can be determined to be the same object as the stereo image target can be selected, and the vehicle ahead can be detected with high accuracy. In particular, in the collision mitigation apparatus 1, when calculating the distance from the center line of the lane of the radar target, it is calculated on the assumption that the traveling track of the center of the lane coincides with the center of the vehicle in the vehicle width direction. Therefore, no means for estimating the center line of the lane is required, and the configuration can be simplified.

さらに、この衝突軽減装置1によれば、位置情報に加えて大きさの情報を用いて照合を行うので、検出対象の車両の大きさを考慮して照合を行うことができ、車両を高精度に検出することができる。さらに、衝突軽減装置1によれば、相対速度も用いて照合を行うので、移動体である車両をより高精度に検出することができる。   Furthermore, according to this collision mitigation apparatus 1, since collation is performed using size information in addition to position information, collation can be performed in consideration of the size of the vehicle to be detected. Can be detected. Furthermore, according to the collision mitigation apparatus 1, since the collation is performed using the relative speed, the vehicle that is a moving body can be detected with higher accuracy.

図1、図2及び図5〜図7を参照して、第2の実施の形態に係る衝突軽減装置21について説明する。なお、衝突軽減装置21では、第1の実施の形態に係る衝突軽減装置1と同様の構成については同一の符号を付し、その説明を省略する。   A collision mitigation device 21 according to a second embodiment will be described with reference to FIGS. 1, 2, and 5 to 7. In the collision mitigation device 21, the same components as those in the collision mitigation device 1 according to the first embodiment are denoted by the same reference numerals, and the description thereof is omitted.

衝突軽減装置21は、衝突軽減装置1と比較すると、レーダ物標設定処理、ステレオ画像物標設定処理、照合処理が異なる。つまり、衝突軽減装置21では、レーダ物標、ステレオ画像物標それぞれについて追跡を行い、レーダ物標またはステレオ画像物標と前回フュージョン物標との照合を行わない。したがって、衝突軽減装置21は、衝突軽減装置1とは衝突軽減ECUにおける処理のみが異なり、第1の実施の形態に係る衝突軽減ECU10の代わりに衝突軽減ECU30を備えている。なお、第2の実施の形態では、衝突軽減ECU30が特許請求の範囲に記載する判断手段に相当する。   The collision mitigation device 21 differs from the collision mitigation device 1 in radar target setting processing, stereo image target setting processing, and collation processing. That is, the collision mitigation apparatus 21 tracks each of the radar target and the stereo image target, and does not collate the radar target or the stereo image target with the previous fusion target. Therefore, the collision mitigation device 21 differs from the collision mitigation device 1 only in the process of the collision mitigation ECU, and includes a collision mitigation ECU 30 instead of the collision mitigation ECU 10 according to the first embodiment. In the second embodiment, the collision reduction ECU 30 corresponds to a determination unit described in the claims.

衝突軽減ECU30も、第1の実施の形態に係る衝突軽減ECU10と同様に、衝突軽減装置21を統括制御する電子制御ユニットである。衝突軽減ECU30は、衝突軽減ECU10とレーダ物標設定処理、ステレオ画像物標設定処理、照合処理が異なる。そこで、その各処理についてのみ説明する。   The collision mitigation ECU 30 is also an electronic control unit that performs overall control of the collision mitigation device 21 in the same manner as the collision mitigation ECU 10 according to the first embodiment. The collision reduction ECU 30 is different from the collision reduction ECU 10 in radar target setting processing, stereo image target setting processing, and collation processing. Therefore, only each process will be described.

レーダ物標設定処理について説明する。衝突軽減ECU30では、第1の実施の形態と同様に、一定時間毎に、レーダ情報からレーダ物標を得る。さらに、衝突軽減ECU30では、一定時間毎に、前回レーダ物標とその得たレーダ物標との照合を行う。この照合は、第1の実施の形態における前回フュージョン物標と今回レーダ物標との照合方法と同様の照合方法であり、距離、横位置、相対速度により照合を行う。この際、前回フュージョン物標の代わりに前回レーダ物標を中心にして各閾値を設定し、その各閾値内にレーダ物標が入っているか否かを判定する。衝突軽減ECU30では、照合において類似性があると判定した場合には前回レーダ物標を今回レーダ物標として更新し、今回の情報を設定する。一方、衝突軽減ECU30では、照合において類似性がないと判定した場合には前回レーダ物標を削除する。また、衝突軽減ECU30では、前回レーダ物標と類似性のなかったレーダ物標を今回レーダ物標として新たに設定する。   The radar target setting process will be described. Similar to the first embodiment, the collision reduction ECU 30 obtains a radar target from the radar information at regular intervals. Further, the collision mitigation ECU 30 collates the previous radar target and the obtained radar target at regular time intervals. This collation is a collation method similar to the collation method between the previous fusion target and the current radar target in the first embodiment, and collation is performed based on distance, lateral position, and relative speed. At this time, each threshold value is set around the previous radar target instead of the previous fusion target, and it is determined whether or not the radar target is within the threshold value. When the collision reduction ECU 30 determines that there is similarity in the collation, the previous radar target is updated as the current radar target, and the current information is set. On the other hand, when the collision reduction ECU 30 determines that there is no similarity in the collation, the previous radar target is deleted. The collision reduction ECU 30 newly sets a radar target that has no similarity to the previous radar target as the current radar target.

ステレオ画像物標設定処理について説明する。衝突軽減ECU30では、第1の実施の形態と同様に、一定時間毎に、ステレオ画像からステレオ画像物標を得る。さらに、衝突軽減ECU30では、一定時間毎に、前回ステレオ画像とその得たステレオ画像物標との照合を行う。この照合は、第1の実施の形態における前回フュージョン物標と今回ステレオ画像物標との照合方法と同様の照合方法であり、距離、横位置、高さ位置、奥行き、横幅、高さ、相対速度により照合を行う。この際、前回フュージョン物標の代わりに前回ステレオ画像物標を中心にして各閾値を設定し、その各閾値内にステレオ画像物標が入っているか否かを判定する。衝突軽減ECU30では、照合において類似性があると判定した場合には前回ステレオ画像物標を今回ステレオ画像物標として更新し、今回の情報を設定する。一方、衝突軽減ECU30では、照合において類似性がないと判定した場合には前回ステレオ画像物標を削除する。また、衝突軽減ECU30では、前回ステレオ画像物標と類似性のなかったステレオ画像物標を今回ステレオ画像物標として新たに設定する。   The stereo image target setting process will be described. Similar to the first embodiment, the collision reduction ECU 30 obtains a stereo image target from a stereo image at regular intervals. Further, the collision reduction ECU 30 collates the previous stereo image with the obtained stereo image target at regular time intervals. This collation is a collation method similar to the collation method of the previous fusion target and the current stereo image target in the first embodiment, and the distance, horizontal position, height position, depth, width, height, relative Check by speed. At this time, each threshold value is set around the previous stereo image target instead of the previous fusion target, and it is determined whether or not the stereo image target is included in each threshold value. When the collision reduction ECU 30 determines that there is similarity in the collation, the previous stereo image target is updated as the current stereo image target, and the current information is set. On the other hand, when the collision reduction ECU 30 determines that there is no similarity in the collation, the previous stereo image target is deleted. Further, the collision reduction ECU 30 newly sets a stereo image target that has no similarity to the previous stereo image target as the current stereo image target.

なお、衝突軽減ECU30では、各センサによる検出によって物標として認識したものについてそれぞれ認識番号を付与し、その認識番号を用いて追跡が行われているか否かを判定する。   The collision reduction ECU 30 assigns a recognition number to each object recognized as a target by detection by each sensor, and determines whether tracking is performed using the recognition number.

照合処理について説明する。衝突軽減ECU30では、一定時間毎に、今回レーダ物標と今回ステレオ画像物標との照合を行う。この照合は、第1の実施の形態における残った今回レーダ物標と今回ステレオ画像物標との照合方法と同様の照合方法であり、距離、横位置、奥行き、横幅、相対速度により照合を行う。なお、照合において照合対象の物標が複数ある場合(例えば、今回レーダ物標が複数ある場合)、全ての組み合せについてそれぞれ照合を行う。   The verification process will be described. The collision reduction ECU 30 collates the current radar target with the current stereo image target at regular time intervals. This collation is a collation method similar to the collation method of the remaining current radar target and the current stereo image target in the first embodiment, and collation is performed by distance, lateral position, depth, lateral width, and relative speed. . When there are a plurality of targets to be collated in the collation (for example, when there are a plurality of radar targets this time), collation is performed for all combinations.

図1、図2及び図5〜図7を参照して、衝突軽減装置21における動作について説明する。特に、衝突軽減ECU30における照合処理の流れについては図11のフローチャートに沿って説明する。図11は、第2の実施の形態に係る照合処理の流れを示すフローチャートである。ここでは、衝突軽減装置1における動作と異なる衝突軽減ECU30におけるレーダ物標設定処理、ステレオ画像物標設定処理、照合処理についてのみ説明する。   The operation of the collision mitigation device 21 will be described with reference to FIGS. 1, 2, and 5 to 7. In particular, the flow of collation processing in the collision reduction ECU 30 will be described with reference to the flowchart of FIG. FIG. 11 is a flowchart showing the flow of the collation process according to the second embodiment. Here, only the radar target setting process, the stereo image target setting process, and the collation process in the collision reduction ECU 30 different from the operation in the collision reduction apparatus 1 will be described.

衝突軽減ECU30では、ミリ波レーダ2からのレーダ信号を受信するとともに、ステレオカメラ3からの各画像信号をそれぞれ受信する。   The collision reduction ECU 30 receives a radar signal from the millimeter wave radar 2 and receives each image signal from the stereo camera 3.

そして、衝突軽減ECU30では、一定時間毎に、レーダ信号によるレーダ情報に基づいてレーダ物標を取得する。そして、衝突軽減ECU30では、一定時間毎に、前回レーダ物標を追跡するために、その取得したレーダ物標と前回レーダ物標との照合を行う。照合の結果、衝突軽減ECU30では、類似性のあった前回レーダ物標を今回のレーダ物標として更新して今回の情報を設定し、類似性のなかった前回レーダ物標を削除する。さらに、衝突軽減ECU30では、取得したレーダ物標のうち類似性のなかったレーダ物標を今回レーダ物標として新たに設定する。なお、前回レーダ物標が設定されていなかった場合、衝突軽減ECU30では、取得したレーダ物標を全て今回のレーダ物標として設定する。   Then, the collision reduction ECU 30 acquires a radar target based on the radar information based on the radar signal at regular time intervals. Then, the collision reduction ECU 30 collates the acquired radar target with the previous radar target in order to track the previous radar target at regular intervals. As a result of the collation, the collision reduction ECU 30 updates the previous radar target having similarity as the current radar target, sets the current information, and deletes the previous radar target having no similarity. Further, the collision reduction ECU 30 newly sets a radar target that has no similarity among the acquired radar targets as the current radar target. When the radar target has not been set last time, the collision reduction ECU 30 sets all the acquired radar targets as the current radar target.

また、衝突軽減ECU30では、一定時間毎に、各画像信号による左右のステレオ画像に基づいてステレオ画像物標を取得する。そして、衝突軽減ECU30では、一定時間毎に、前回ステレオ画像物標を追跡するために、その取得したステレオ画像物標と前回ステレオ画像物標との照合を行う。照合の結果、衝突軽減ECU30では、類似性のあった前回ステレオ画像物標を今回のステレオ画像物標として更新して今回の情報を設定し、類似性のなかった前回ステレオ画像物標を削除する。さらに、衝突軽減ECU30では、取得したステレオ画像物標のうち類似性のなかったステレオ画像物標を今回のステレオ画像物標として新たに設定する。なお、前回ステレオ画像物標が設定されていなかった場合、衝突軽減ECU30では、取得したステレオ画像物標を全て今回のステレオ画像物標として設定する。   In addition, the collision reduction ECU 30 acquires a stereo image target based on the left and right stereo images of each image signal at regular time intervals. Then, the collision reduction ECU 30 collates the acquired stereo image target with the previous stereo image target in order to track the previous stereo image target at regular intervals. As a result of the collation, the collision reduction ECU 30 updates the previous stereo image target having similarity as the current stereo image target, sets the current information, and deletes the previous stereo image target having no similarity. . Further, the collision reduction ECU 30 newly sets a stereo image target having no similarity among the acquired stereo image targets as the current stereo image target. If the previous stereo image target has not been set, the collision reduction ECU 30 sets all the acquired stereo image targets as the current stereo image target.

そして、衝突軽減ECU30では、一定時間毎に、以下の照合処理を行う。衝突軽減ECU30では、距離、横位置の位置情報、奥行き、横幅の大きさ情報及び相対速度により、レーダ物標とステレオ画像物標との照合を行う(S30)。   Then, the collision reduction ECU 30 performs the following verification process at regular intervals. The collision reduction ECU 30 collates the radar target with the stereo image target based on the distance, the position information of the lateral position, the depth, the width information, and the relative speed (S30).

衝突軽減ECU30では、S30での照合において類似性があるか否かを判定する(S31)。S31にて類似性があると判定した場合、衝突軽減ECU30では、ステレオ画像物標と類似性を持つレーダ物標が2個以上存在するか否かを判定する(S32)。S32にて2個以上存在すると判定した場合、衝突軽減ECU30では、レーダ物標毎に車線の中心線からレーダ物標までの距離をそれぞれ演算し、2個以上のレーダ物標についての車線の中心線からの各距離を比較する。そして、衝突軽減ECU30では、距離が最も短いレーダ物標を選択し、その選択したレーダ物標と類似性のあったステレオ画像物標とにより今回フュージョン物標を設定し、その今回フュージョン物標の情報としてその選択したレーダ物標の距離及び相対速度を設定するとともにステレオ画像物標の横位置、横幅、奥行き、高さ、高さ位置を設定する(S33)。一方、S32にて1個存在すると判定した場合、衝突軽減ECU30では、その1対1で類似性のあったレーダ物標とステレオ画像物標とにより今回のフュージョン物標を設定し、その今回フュージョン物標の情報としてレーダ物標の距離及び相対速度を設定するとともにステレオ画像物標の横位置、横幅、奥行き、高さ、高さ位置を設定する(S34)。このS30〜S34の処理を、全てのレーダ物標と全てのステレオ画像物標との全ての組み合せについて行う。ここまでの処理によって、全てのレーダ物標と全てのステレオ画像物標との照合処理が終了する。なお、レーダ物標、ステレオ画像物標の少なくとも一方の物標が設定されていない場合、今回の照合処理を行わない。   The collision reduction ECU 30 determines whether there is similarity in the collation in S30 (S31). If it is determined that there is similarity in S31, the collision reduction ECU 30 determines whether there are two or more radar targets having similarity to the stereo image target (S32). When it is determined in S32 that there are two or more, the collision reduction ECU 30 calculates the distance from the center line of the lane to the radar target for each radar target, and the center of the lane for two or more radar targets. Compare each distance from the line. Then, the collision reduction ECU 30 selects the radar target with the shortest distance, sets the current fusion target with the stereo image target similar to the selected radar target, and sets the current fusion target. The distance and relative speed of the selected radar target are set as information, and the horizontal position, width, depth, height, and height position of the stereo image target are set (S33). On the other hand, if it is determined in S32 that there is one, the collision mitigation ECU 30 sets the current fusion target by using the radar target and the stereo image target that have a one-to-one similarity, and the current fusion. The distance and relative speed of the radar target are set as target information, and the horizontal position, width, depth, height, and height position of the stereo image target are set (S34). The processes of S30 to S34 are performed for all combinations of all radar targets and all stereo image targets. By the processing so far, the collation processing of all radar targets and all stereo image targets is completed. If at least one of the radar target and the stereo image target is not set, the current matching process is not performed.

この衝突軽減装置21でも、第1の実施の形態に係る衝突軽減装置1と同様の効果を奏する。   This collision mitigation device 21 also has the same effect as the collision mitigation device 1 according to the first embodiment.

以上、本発明に係る実施の形態について説明したが、本発明は上記実施の形態に限定されることなく様々な形態で実施される。   As mentioned above, although embodiment which concerns on this invention was described, this invention is implemented in various forms, without being limited to the said embodiment.

例えば、本実施の形態では車両に搭載される衝突軽減装置に適用したが、車間距離制御装置、追従走行装置などの他の運転支援装置にも適用可能であり、車線上の物体を検出する物体検出装置単体としても活用可能である。また、検出対象としては、前方の車両以外にも、車線上に存在する自動二輪車や障害物などの他の物体を検出することも可能である。   For example, in the present embodiment, the present invention is applied to a collision mitigation device mounted on a vehicle. It can also be used as a single detection device. Further, as a detection target, it is also possible to detect other objects such as motorcycles and obstacles existing on the lane other than the vehicle ahead.

また、本実施の形態ではレーダ検出手段としてミリ波レーダを用いる構成としたが、レーザレーダなどの他のレーダを用いてもよい。   In this embodiment, the millimeter wave radar is used as the radar detection means, but other radars such as a laser radar may be used.

また、本実施の形態では画像検出手段としてステレオカメラを用いる構成としたが、ステレオカメラ以外のカメラを用いてもよい。   In this embodiment, a stereo camera is used as the image detection unit. However, a camera other than the stereo camera may be used.

また、本実施の形態ではミリ波レーダによる情報に基づくレーダ物標の設定及びステレオカメラによるステレオ画像に基づくステレオ画像物標の設定を衝突軽減ECUで行う構成としたが、ミリ波レーダに処理部を備え、ミリ波レーダでレーダ物標を設定する構成としてもよいし、また、ステレオカメラに画像処理部を備え、ステレオカメラでステレオ画像物標を設定する構成としてもよい。   In this embodiment, the configuration is such that the setting of the radar target based on the information by the millimeter wave radar and the setting of the stereo image target based on the stereo image by the stereo camera are performed by the collision mitigation ECU. The radar target may be set by a millimeter wave radar, or the stereo camera may be provided with an image processing unit, and the stereo image target may be set by the stereo camera.

また、本実施の形態では車線の中心と自車両中心の走行軌跡とが一致していると仮定し、各レーダ物標の車線の中心線からの距離を求める構成としたが、ステレオカメラによるステレオ画像などの情報を用いて車線(例えば、両側の白線)を検出し、その車線の中心線を演算によって推測し、その推測した中心線と各レーダ物標の位置情報に基づいて各レーダ物標の中心線からの距離を求める構成としてもよい。車線の中心線を推定する手法として、カーナビゲーションなどの道路情報を利用してもよい。   In the present embodiment, it is assumed that the center of the lane coincides with the traveling locus of the center of the host vehicle, and the distance from each lane center line of each radar target is obtained. A lane (for example, white lines on both sides) is detected using information such as an image, a center line of the lane is estimated by calculation, and each radar target is based on the estimated center line and position information of each radar target. The distance from the center line may be obtained. Road information such as car navigation may be used as a method for estimating the center line of the lane.

また、本実施の形態では車線の中心線を基準にしてレーダ物標が車線の中心に近いか否かを判断する構成としたが、車両前方の中心部に設けられたレーダからの方向を基準にしてレーダ物標が車幅方向の中心の推測走行軌跡に近いか否かを判断するようにしてもよいし、また、自車両が走行する車線の道路境界部からあるいは対向する車線との境界部からの距離に基づいてレーダ物標が車幅方向の中心の推測走行軌跡に近いか否かを判断するようにしてもよい。   In this embodiment, the radar target is determined to be close to the center of the lane with reference to the center line of the lane. However, the direction from the radar provided at the center in front of the vehicle is used as a reference. Thus, it may be determined whether or not the radar target is close to the estimated traveling locus in the center in the vehicle width direction, or from the road boundary of the lane on which the host vehicle is traveling or the boundary with the opposite lane It may be determined whether the radar target is close to the estimated traveling locus in the center in the vehicle width direction based on the distance from the section.

また、本実施の形態では横幅や奥行きなどの大きさ情報及び相対速度も用いて照合を行う構成としたが、相対速度を用いないで照合を行う構成としてもよいし、あるいは、大きさ情報の全てまたは一部を用いないで照合を行う構成としてもよい。   In this embodiment, the collation is performed using the size information such as the width and depth and the relative speed. However, the collation may be performed without using the relative speed, or the size information It is good also as a structure which collates without using all or one part.

また、本実施の形態では各照合において複数の閾値による判定で全ての閾値条件を満たしている場合に類似性があると判定する構成としたが、全ての閾値条件のうちの幾つかの閾値条件を満たしている場合に類似性があると判定する構成としてもよい。   Further, in the present embodiment, it is configured that it is determined that there is similarity when all threshold conditions are satisfied by determination by a plurality of threshold values in each collation, but some threshold conditions among all threshold conditions It is good also as a structure which determines with there being similarity, when satisfy | filling.

また、第2の実施の形態では衝突軽減ECUにおいてミリ波レーダによる情報に基づくレーダ物標の追跡判定処理とステレオカメラによるステレオ画像に基づくステレオ画像物標の追跡判定処理及びレーダ物標とステレオ画像物標との照合処理を行う構成としたが、これら全ての処理を衝突軽減ECUで行う必要はなく、ミリ波レーダによる情報に基づくレーダ物標の追跡判定処理を行うためのミリ波レーダECUとステレオカメラによるステレオ画像に基づくステレオ画像物標の追跡判定処理を行うための画像ECUを衝突軽減ECUとは別に設ける構成としてもよい。この場合、物標の追跡判定処理についてはミリ波レーダECUと画像ECUでそれぞれ行い、照合処理については衝突軽減ECUで行うことになる。このような構成とする場合、ミリ波レーダECUをミリ波レーダと衝突軽減ECUとの間に配置し、画像ECUをステレオカメラと衝突軽減ECUとの間に配置することが適している。   In the second embodiment, the collision mitigation ECU uses a radar target tracking determination process based on information from a millimeter wave radar, a stereo image target tracking determination process based on a stereo image, and a radar target and a stereo image. Although it is configured to perform a collation process with a target, it is not necessary to perform all these processes in a collision reduction ECU, and a millimeter wave radar ECU for performing a radar target tracking determination process based on information by a millimeter wave radar An image ECU for performing a tracking determination process of a stereo image target based on a stereo image by a stereo camera may be provided separately from the collision reduction ECU. In this case, the target tracking determination processing is performed by the millimeter wave radar ECU and the image ECU, and the matching processing is performed by the collision reduction ECU. In such a configuration, it is suitable that the millimeter wave radar ECU is disposed between the millimeter wave radar and the collision mitigation ECU, and the image ECU is disposed between the stereo camera and the collision mitigation ECU.

本実施の形態に係る衝突軽減装置の構成図である。It is a lineblock diagram of the collision mitigation device concerning this embodiment. 本実施の形態に係るレーダ物標、ステレオ画像物標及びフュージョン物標の説明図である。It is explanatory drawing of the radar target concerning this Embodiment, a stereo image target, and a fusion target. 第1の実施の形態に係る前回フュージョン物標とレーダ物標との照合方法の説明図である。It is explanatory drawing of the collation method with the last fusion target and radar target which concern on 1st Embodiment. 第1の実施の形態に係る前回フュージョン物標とステレオ画像物標との照合方法の説明図である。It is explanatory drawing of the collation method with the last fusion target and stereo image target which concerns on 1st Embodiment. 本実施の形態に係るレーダ物標とステレオ画像物標との照合方法の説明図である。It is explanatory drawing of the collation method of the radar target and stereo image target which concerns on this Embodiment. 本実施の形態に係るステレオ画像物標と類似性を持つレーダ物標が2個存在する場合のレーダ物標とステレオ画像物標との照合方法の説明図である。It is explanatory drawing of the collation method of a radar target and a stereo image target in case the two radar targets which have similarity with the stereo image target concerning this Embodiment exist. 本実施の形態に係るレーダ物標と車線の中心線との距離の演算方法の説明図であり、(a)が道路のカーブR>0の場合であり、(b)が道路のカーブR<0の場合である。It is explanatory drawing of the calculation method of the distance of the radar target concerning this Embodiment, and the centerline of a lane, (a) is a case where road curve R> 0, (b) is road curve R << This is the case of 0. ステレオ画像物標と類似性を持つレーダ物標が2個存在する場合の照合結果の一例である。It is an example of the collation result when there are two radar targets having similarity to the stereo image target. ステレオ画像物標と類似性を持つレーダ物標が2個存在する場合の照合結果の他の例である。It is another example of the collation result when there are two radar targets having similarity to the stereo image target. 第1の実施の形態に係る照合処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the collation process which concerns on 1st Embodiment. 第2の実施の形態に係る照合処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the collation process which concerns on 2nd Embodiment.

符号の説明Explanation of symbols

1,21…衝突軽減装置、2…ミリ波レーダ、3…ステレオカメラ、4…車速センサ、5…ヨーレートセンサ、6…ブレーキECU、7…サスペンション制御アクチュエータ、8…シートベルトアクチュエータ、9…ブザー、10,30…衝突軽減ECU   DESCRIPTION OF SYMBOLS 1,21 ... Collision mitigation device, 2 ... Millimeter wave radar, 3 ... Stereo camera, 4 ... Vehicle speed sensor, 5 ... Yaw rate sensor, 6 ... Brake ECU, 7 ... Suspension control actuator, 8 ... Seat belt actuator, 9 ... Buzzer, 10, 30 ... Collision reduction ECU

Claims (2)

レーダによって物体を検出するレーダ検出手段と、
画像によって物体を検出する画像検出手段と、
前記レーダ検出手段によって検出した物体の位置情報と前記画像検出手段によって検出した物体の位置情報に基づいて、前記レーダ検出手段によって検出した物体と前記画像検出手段によって検出した物体が同一物体か否かを判断する判断手段と
を備え、
前記判断手段は、前記画像検出手段によって検出した物体に対して前記レーダ検出手段によって検出した物体が複数個対応している場合、当該複数個の物体のうち車両中心の推測走行軌跡に近い物体を同一物体と判断することを特徴とする物体検出装置。
Radar detecting means for detecting an object by radar;
Image detection means for detecting an object from an image;
Whether the object detected by the radar detection means and the object detected by the image detection means are the same based on the position information of the object detected by the radar detection means and the position information of the object detected by the image detection means And a judging means for judging
In the case where a plurality of objects detected by the radar detection unit correspond to the object detected by the image detection unit, the determination unit selects an object close to the estimated traveling locus of the vehicle center among the plurality of objects. An object detection apparatus characterized in that it is determined as the same object.
車両中心の走行軌跡を推測する推測手段を備えることを特徴とする請求項1に記載する物体検出装置。   The object detection apparatus according to claim 1, further comprising an estimation unit that estimates a travel locus at the center of the vehicle.
JP2005117286A 2005-04-14 2005-04-14 Object detection device Expired - Fee Related JP4670449B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005117286A JP4670449B2 (en) 2005-04-14 2005-04-14 Object detection device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005117286A JP4670449B2 (en) 2005-04-14 2005-04-14 Object detection device

Publications (2)

Publication Number Publication Date
JP2006292681A true JP2006292681A (en) 2006-10-26
JP4670449B2 JP4670449B2 (en) 2011-04-13

Family

ID=37413390

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005117286A Expired - Fee Related JP4670449B2 (en) 2005-04-14 2005-04-14 Object detection device

Country Status (1)

Country Link
JP (1) JP4670449B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018179118A1 (en) * 2017-03-29 2018-10-04 本田技研工業株式会社 Vehicle control device, vehicle control method and program
CN109471096A (en) * 2018-10-31 2019-03-15 奇瑞汽车股份有限公司 Multi-Sensor Target matching process, device and automobile
WO2020158508A1 (en) * 2019-01-31 2020-08-06 株式会社デンソー Object determining device

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005084035A (en) * 2003-09-11 2005-03-31 Toyota Motor Corp Object detecting device
JP2006293835A (en) * 2005-04-13 2006-10-26 Toyota Motor Corp Object detection apparatus

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005084035A (en) * 2003-09-11 2005-03-31 Toyota Motor Corp Object detecting device
JP2006293835A (en) * 2005-04-13 2006-10-26 Toyota Motor Corp Object detection apparatus

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018179118A1 (en) * 2017-03-29 2018-10-04 本田技研工業株式会社 Vehicle control device, vehicle control method and program
JPWO2018179118A1 (en) * 2017-03-29 2019-11-07 本田技研工業株式会社 Vehicle control apparatus, vehicle control method, and program
CN110475694A (en) * 2017-03-29 2019-11-19 本田技研工业株式会社 Controller of vehicle, control method for vehicle and program
US11447084B2 (en) 2017-03-29 2022-09-20 Honda Motor Co., Ltd. Vehicle control device, vehicle control method and program
CN109471096A (en) * 2018-10-31 2019-03-15 奇瑞汽车股份有限公司 Multi-Sensor Target matching process, device and automobile
CN109471096B (en) * 2018-10-31 2023-06-27 奇瑞汽车股份有限公司 Multi-sensor target matching method and device and automobile
WO2020158508A1 (en) * 2019-01-31 2020-08-06 株式会社デンソー Object determining device
JP2020122772A (en) * 2019-01-31 2020-08-13 株式会社デンソー Object determination device
JP7069061B2 (en) 2019-01-31 2022-05-17 株式会社デンソー Object judgment device

Also Published As

Publication number Publication date
JP4670449B2 (en) 2011-04-13

Similar Documents

Publication Publication Date Title
JP4428277B2 (en) Object detection device
JP4304517B2 (en) Object detection device
KR102572784B1 (en) Driver assistance system and control method for the same
US10919525B2 (en) Advanced driver assistance system, vehicle having the same, and method of controlling the vehicle
US8200419B2 (en) Braking control system and braking control method
JP6344275B2 (en) Vehicle control device
CN111284492A (en) Apparatus and method for controlling vehicle travel
US9643617B2 (en) Friction coefficient estimation from camera and wheel speed data
US10926764B2 (en) Lane keeping assistance apparatus, vehicle having the same and method for controlling the same
CN109204311B (en) Automobile speed control method and device
JP4534846B2 (en) Object detection device
JP2006292621A (en) Object detection apparatus
CN111284493A (en) Apparatus and method for controlling vehicle travel
JP6787157B2 (en) Vehicle control device
US9102329B2 (en) Tracking control apparatus
US11003924B2 (en) System and method for detecting close cut-in vehicle based on free space signal
JP5012270B2 (en) Object detection device
JP2018200267A (en) Upper structure determination device and driving support system
US20190073540A1 (en) Vehicle control device, vehicle control method, and storage medium
JP2012089114A (en) Obstacle recognition device
KR20200115827A (en) Driver assistance system, and control method for the same
JP2015203972A (en) Driving route generation device
JP4670449B2 (en) Object detection device
JP2006266927A (en) Object detector
JP2017174016A (en) Vehicle detection device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080314

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100407

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100413

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20100519

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20101221

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

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20110103

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

Free format text: PAYMENT UNTIL: 20140128

Year of fee payment: 3

LAPS Cancellation because of no payment of annual fees