JP3949628B2 - Vehicle periphery monitoring device - Google Patents

Vehicle periphery monitoring device Download PDF

Info

Publication number
JP3949628B2
JP3949628B2 JP2003309717A JP2003309717A JP3949628B2 JP 3949628 B2 JP3949628 B2 JP 3949628B2 JP 2003309717 A JP2003309717 A JP 2003309717A JP 2003309717 A JP2003309717 A JP 2003309717A JP 3949628 B2 JP3949628 B2 JP 3949628B2
Authority
JP
Japan
Prior art keywords
image
vehicle
distance
determination
area
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP2003309717A
Other languages
Japanese (ja)
Other versions
JP2004103018A (en
Inventor
孝之 辻
伸治 長岡
正人 渡辺
弘 服部
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP2003309717A priority Critical patent/JP3949628B2/en
Publication of JP2004103018A publication Critical patent/JP2004103018A/en
Application granted granted Critical
Publication of JP3949628B2 publication Critical patent/JP3949628B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Measurement Of Optical Distance (AREA)
  • Image Processing (AREA)
  • Traffic Control Systems (AREA)
  • Image Analysis (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Description

本発明は、鹿、熊等の大型動物との衝突は車両走行に影響を与えるため、衝突を回避すべく、車両に搭載された撮像手段により得られる画像から、当該車両に衝突するおそれのある対象物を検出するために、当該車両の周辺を監視する周辺監視装置に関する。   In the present invention, a collision with a large animal such as a deer or a bear affects the vehicle traveling. Therefore, in order to avoid the collision, there is a possibility of colliding with the vehicle from an image obtained by an imaging means mounted on the vehicle. The present invention relates to a periphery monitoring device that monitors the periphery of the vehicle in order to detect an object.

車両に2つのCCDカメラを搭載し、2つのカメラから得られる画像のずれ、すなわち視差に基づいて、対象物と当該車両との距離を検出し、車両の30〜60m前方の歩行者を検出するようにした横断物の検出装置が従来より知られている(特許文献1)。
特開平9−226490号公報
Two CCD cameras are mounted on the vehicle, and the distance between the object and the vehicle is detected based on the image shift obtained from the two cameras, that is, parallax, and a pedestrian 30 to 60 meters ahead of the vehicle is detected. Such a crossing object detection device has been known (Patent Document 1).
JP-A-9-226490

しかしながら上記従来の装置は、カメラにより得られる画像に基づいて検出した対象物のオプティカルフローの方向をそのまま使用して、衝突の可能性を判定しているため、自車両と対象物との相対距離や車速によっては判定精度が低下するという問題があった。すなわち、例えば動体の速度に比べて車速が大きい場合には、実際には道路の中心に向かって移動している動体に対応する画像上のオプティカルフローが道路の外側に向かうベクトルとなってとらえられることがあり、誤判定が発生する。   However, since the conventional apparatus determines the possibility of collision using the optical flow direction of the object detected based on the image obtained by the camera as it is, the relative distance between the host vehicle and the object is determined. Depending on the vehicle speed, there is a problem that the determination accuracy is lowered. That is, for example, when the vehicle speed is higher than the speed of the moving object, the optical flow on the image corresponding to the moving object moving toward the center of the road is actually regarded as a vector toward the outside of the road. In some cases, erroneous determination occurs.

本発明はこの点に着目してなされたものであり、車両周辺に存在する対象物の動きをより正確に検出して衝突の可能性を判定し、運転者への警報をより適切に行うことができる車両の周辺監視装置を提供することを目的とする。   The present invention has been made paying attention to this point, and more accurately detects the movement of an object existing around the vehicle to determine the possibility of a collision, and more appropriately warns the driver. An object of the present invention is to provide a vehicle periphery monitoring device capable of performing the above.

上記目的を達成するため請求項に記載の発明は、車両に搭載された撮像手段により得られる画像から当該車両の周辺に存在する対象物を検出する車両の周辺監視装置において、前記撮像手段により得られる画像から前記対象物の当該車両に対する相対位置を位置データとして検出する相対位置検出手段と、該相対位置検出手段により検出される、前記対象物についての位置データに基づいてその対象物の実空間での位置を算出する実空間位置算出手段と、該実空間位置算出手段により算出された、第1サンプリング時刻における前記対象物までの第1の距離(Zv(N−1))と、前記第1サンプリング時刻から一定時間(ΔT)経過後の第2サンプリング時刻における前記対象物までの第2の距離(Zv(0))とを算出し、前記第2の距離の逆数(1/Zv(0))から前記第1の距離の逆数(1/Zv(N−1))を減算した値に所定値(α・f/2)を乗算することにより判定閾値を算出し、前記画像上での前記対象物の水平方向の移動距離(|xc(0)−xc(N−1)|)が前記判定閾値以下であるとき、前記対象物が前記車両に衝突する可能性があると判定する判定手段とを備えることを特徴とする。 In order to achieve the above object, the invention described in claim 1 is directed to a vehicle periphery monitoring device that detects an object existing around a vehicle from an image obtained by an image capturing unit mounted on the vehicle. Relative position detection means for detecting the relative position of the object with respect to the vehicle from the obtained image as position data, and actuality of the object based on position data about the object detected by the relative position detection means. A real space position calculating means for calculating a position in space; a first distance (Zv (N−1)) to the object at a first sampling time calculated by the real space position calculating means; A second distance (Zv (0)) to the object at a second sampling time after a lapse of a certain time (ΔT) from the first sampling time, and calculating the second distance A determination threshold value is obtained by multiplying a value obtained by subtracting the reciprocal of the first distance (1 / Zv (N−1)) from the reciprocal of the separation (1 / Zv (0)) by a predetermined value (α · f / 2). When the horizontal movement distance (| xc (0) -xc (N-1) |) of the object on the image is equal to or less than the determination threshold value, the object collides with the vehicle. And determining means for determining that there is a possibility of the occurrence.

前記撮像手段は、赤外線を検出可能な2つの赤外線カメラとすることが望ましい。これにより、運転者が確認し難い夜間走行時に動物や走行中の車両などを容易に抽出することができる。   The imaging means is preferably two infrared cameras capable of detecting infrared rays. As a result, it is possible to easily extract animals, traveling vehicles, and the like when traveling at night, which is difficult for the driver to check.

前記撮像手段は、赤外線または可視光線を検出する2つのテレビカメラであり、一方のカメラの出力画像に含まれる対象物像の位置に基づいて、この対象物像に対応する他方のカメラの出力画像に含まれる対象物像を探索する探索領域を設定し、探索領域内で相関演算を行って前記対応対象物像を特定し、前記対象物像と対応対象物像との視差から当該車両から前記対象物までの距離を算出する。そして、前記相関演算は、中間階調情報を含むグレースケール信号を用いて行うことが望ましい。2値化した信号ではなく、グレースケール信号を用いることにより、より正確な相関演算が可能となり、対応対象物像を誤って特定することを回避できる。   The imaging means is two television cameras that detect infrared or visible light, and based on the position of the object image included in the output image of one camera, the output image of the other camera corresponding to the object image A search area for searching for an object image included in the image, and performing a correlation operation in the search area to identify the corresponding object image, and from the vehicle from the parallax between the object image and the corresponding object image Calculate the distance to the object. The correlation calculation is preferably performed using a grayscale signal including intermediate gradation information. By using a grayscale signal instead of a binarized signal, a more accurate correlation calculation is possible, and it is possible to avoid erroneously specifying a corresponding object image.

前記グレースケール信号を2値化した信号を用いて、前記撮像手段の出力画像内を移動する対象物の追跡が行われる。この場合、追跡対象物は、ランレングス符号化したデータにより認識することが望ましい。これにより、追跡する対象物についてのデータ量を低減しメモリ容量を節約することができる。   Using the signal obtained by binarizing the gray scale signal, the object moving in the output image of the imaging means is tracked. In this case, it is desirable to recognize the tracking target object based on the run-length encoded data. As a result, the amount of data about the object to be tracked can be reduced and the memory capacity can be saved.

また、追跡対象物の同一性は、重心位置座標、面積及び外接四角形の縦横比に基づいて判定することが望ましい。これにより、対象物の同一性の判定を正確に行うことができる。
前記判定手段により対象物との衝突の可能性が高いと判定されたとき、運転者に警告を発する警報手段を備え、該警告手段は、運転者がブレーキ操作を行っている場合であって、そのブレーキ操作による加速度が所定閾値より大きいときは、警報を発しないようにすることが望ましい。運転者がすでに対象物に気づいて適切なブレーキ操作を行っている場合は警告を発しないようにして、運転者によけいな煩わしさを与えないようにすることができる。
Further, it is desirable to determine the identity of the tracking object based on the barycentric position coordinate, the area, and the aspect ratio of the circumscribed rectangle. As a result, the identity of the object can be accurately determined.
When it is determined by the determination means that the possibility of a collision with an object is high, the warning means is provided to issue a warning to the driver, the warning means is a case where the driver is performing a brake operation, When the acceleration by the brake operation is larger than a predetermined threshold value, it is desirable not to issue an alarm. When the driver has already noticed the object and is performing an appropriate brake operation, the driver can be prevented from giving a warning so as not to be annoyed by the driver.

請求項1に記載の発明によれば、第1サンプリング時刻における対象物までの第1の距離と、第1サンプリング時刻から一定時間経過後の第2サンプリング時刻における対象物までの第2の距離とが算出され、第2の距離の逆数から第1の距離の逆数を減算した値に所定値を乗算することにより判定閾値が算出され、画像上での対象物の水平方向の移動距離が判定閾値以下であるとき、対象物が自車両に衝突する可能性があると判定される。上記判定条件は、自車両の進行方向に対してほぼ90度の方向から進行してくる対象物が衝突する可能性を判定するための条件であり、車両の進行方向に対して横断するように移動する対象物について衝突の可能性を判定することができる。 According to the first aspect of the present invention, the first distance to the object at the first sampling time and the second distance to the object at the second sampling time after a predetermined time has elapsed from the first sampling time; Is calculated, and a determination threshold value is calculated by multiplying a value obtained by subtracting the reciprocal number of the first distance from the reciprocal number of the second distance, and the moving distance in the horizontal direction of the object on the image is determined as the determination threshold value. When it is below, it is determined that the object may collide with the host vehicle. The above determination condition is a condition for determining the possibility that an object traveling from a direction of approximately 90 degrees with respect to the traveling direction of the host vehicle collides, and so as to cross the traveling direction of the vehicle. it is possible to determine the possibility of collision with the moving object to be.

以下本発明の実施の形態を図面を参照して説明する。
図1は本発明の一実施形態にかかる車両の周辺監視装置の構成を示す図であり、この装置は、遠赤外線を検出可能な2つの赤外線カメラ1R,1Lと、当該車両のヨーレートを検出するヨーレートセンサ5と、当該車両の走行速度(車速)VCARを検出する車速センサ6と、ブレーキの操作量を検出するためのブレーキセンサ7と、これらのカメラ1R,1Lによって得られる画像データの基づいて車両前方の動物等の対象物を検出し、衝突の可能性が高い場合に警報を発する画像処理ユニット2と、音声で警報を発するためのスピーカ3と、カメラ1Rまたは1Lによって得られる画像を表示するとともに、衝突の可能性が高い対象物を運転者に認識させるためのヘッドアップディスプレイ(以下「HUD」という)4とを備えている。
Embodiments of the present invention will be described below with reference to the drawings.
FIG. 1 is a diagram showing a configuration of a vehicle periphery monitoring device according to an embodiment of the present invention. This device detects two infrared cameras 1R and 1L capable of detecting far infrared rays, and a yaw rate of the vehicle. Based on the yaw rate sensor 5, the vehicle speed sensor 6 for detecting the travel speed (vehicle speed) VCAR of the vehicle, the brake sensor 7 for detecting the operation amount of the brake, and the image data obtained by these cameras 1R and 1L. An object such as an animal in front of the vehicle is detected, and an image obtained by an image processing unit 2 that issues an alarm when there is a high possibility of a collision, a speaker 3 that issues an alarm by sound, and a camera 1R or 1L is displayed. In addition, a head-up display (hereinafter referred to as “HUD”) 4 is provided to allow the driver to recognize an object having a high possibility of collision.

カメラ1R、1Lは、図2に示すように車両10の前部に、車両10の横方向の中心軸に対してほぼ対象な位置に配置されており、2つのカメラ1R、1Lの光軸が互いに平行となり、両者の路面からの高さが等しくなるように固定されている。赤外線カメラ1R、1Lは、対象物の温度が高いほど、その出力信号レベルが高くなる(輝度が増加する)特性を有している。   As shown in FIG. 2, the cameras 1R and 1L are arranged in front of the vehicle 10 at almost target positions with respect to the central axis in the lateral direction of the vehicle 10. The optical axes of the two cameras 1R and 1L are They are parallel to each other and fixed so that their height from the road surface is equal. The infrared cameras 1R and 1L have a characteristic that the output signal level increases (the luminance increases) as the temperature of the object increases.

画像処理ユニット2は、入力アナログ信号をディジタル信号に変換するA/D変換回路、ディジタル化した画像信号を記憶する画像メモリ、各種演算処理を行うCPU(Central Processing Unit)、CPUが演算途中のデータを記憶するために使用するRAM(Random Access Memory)、CPUが実行するプログラムやテーブル、マップなどを記憶するROM(Read Only Memory)、スピーカ3の駆動信号、HUD4の表示信号などを出力する出力回路などを備えており、カメラ1R,1L及びセンサ5〜7の出力信号は、ディジタル信号に変換されて、CPUに入力されるように構成されている。
HUD4は、図2に示すように、車両10のフロントウインドウの、運転者の前方位置に画面4aが表示されるように設けられている。
The image processing unit 2 includes an A / D conversion circuit that converts an input analog signal into a digital signal, an image memory that stores a digitized image signal, a CPU (Central Processing Unit) that performs various arithmetic processes, and data that is being calculated by the CPU Output circuit for outputting RAM (Random Access Memory) used for storing CPU, ROM (Read Only Memory) for storing programs and tables executed by CPU, map, etc., driving signal for speaker 3, display signal for HUD4, etc. The output signals of the cameras 1R and 1L and the sensors 5 to 7 are converted into digital signals and input to the CPU.
As shown in FIG. 2, the HUD 4 is provided so that the screen 4 a is displayed at the front position of the driver on the front window of the vehicle 10.

図3は画像処理ユニット2における処理の手順を示すフローチャートであり、先ずカメラ1R、1Lの出力信号をA/D変換して画像メモリに格納する(ステップS11,S12,S13)。画像メモリに格納される画像は、輝度情報を含んだグレースケール画像である。図5(a)(b)は、それぞれはカメラ1R,1Lによって得られるグレースケール画像(カメラ1Rにより右画像が得られ、カメラ1Lにより左画像が得られる)を説明するための図であり、ハッチングを付した領域は、中間階調(グレー)の領域であり、太い実線で囲んだ領域が、輝度レベルが高く(高温で)、画面上に白色として表示される対象物の領域(以下「高輝度領域」という)である。右画像と左画像では、同一の対象物の画面上の水平位置がずれて表示されるので、このずれ(視差)によりその対象物までの距離を算出することができる。   FIG. 3 is a flowchart showing a processing procedure in the image processing unit 2. First, the output signals of the cameras 1R and 1L are A / D converted and stored in the image memory (steps S11, S12, and S13). The image stored in the image memory is a grayscale image including luminance information. FIGS. 5A and 5B are diagrams for explaining gray scale images obtained by the cameras 1R and 1L (a right image is obtained by the camera 1R and a left image is obtained by the camera 1L), respectively. The hatched area is an intermediate gradation (gray) area, and the area surrounded by a thick solid line has a high luminance level (at a high temperature) and is an area of an object displayed as white on the screen (hereinafter, “ It is referred to as a “high luminance region”. In the right image and the left image, the horizontal positions of the same target object on the screen are shifted and displayed, and the distance to the target object can be calculated from this shift (parallax).

図3のステップS14では、右画像を基準画像とし、その画像信号の2値化、すなわち、実験的に決定される輝度閾値ITHより明るい領域を「1」(白)とし、暗い領域を「0」(黒)とする処理を行う。図6に図5(a)の画像を2値化した画像を示す。この図は、ハッチングを付した領域が黒であり、太い実線で囲まれた高輝度領域が白であることを示している。   In step S14 of FIG. 3, the right image is used as a reference image, and binarization of the image signal, that is, an area brighter than the experimentally determined luminance threshold value ITH is set to “1” (white), and a dark area is set to “0”. ”(Black). FIG. 6 shows an image obtained by binarizing the image of FIG. This figure shows that the hatched area is black and the high luminance area surrounded by the thick solid line is white.

続くステップS15では、2値化した画像データをランレングスデータに変換する処理を行う。図7(a)はこれを説明するための図であり、この図では2値化により白となった領域を画素レベルでラインL1〜L8として示している。ラインL1〜L8は、いずれもy方向には1画素の幅を有しており、実際にはy方向には隙間なく並んでいるが、説明のために離間して示している。またラインL1〜L8は、x方向にはそれぞれ2画素、2画素、3画素、8画素、7画素、8画素、8画素、8画素の長さを有している。ランレングスデータは、ラインL1〜L8を各ラインの開始点(各ラインの左端の点)の座標と、開始点から終了点(各ラインの右端の点)までの長さ(画素数)とで示したものである。例えばラインL3は、(x3,y5)、(x4,y5)及び(x5,y5)の3画素からなるので、ランレングスデータとしては、(x3,y5,3)となる。   In the subsequent step S15, the binarized image data is converted into run-length data. FIG. 7A is a diagram for explaining this, and in this figure, whitened areas by binarization are shown as lines L1 to L8 at the pixel level. Each of the lines L1 to L8 has a width of one pixel in the y direction and is actually arranged with no gap in the y direction, but is shown separated for the sake of explanation. The lines L1 to L8 have lengths of 2 pixels, 2 pixels, 3 pixels, 8 pixels, 7 pixels, 8 pixels, 8 pixels, and 8 pixels, respectively, in the x direction. The run length data includes the coordinates of the start point of each line (the leftmost point of each line) and the length (number of pixels) from the start point to the end point (the rightmost point of each line). It is shown. For example, since the line L3 includes three pixels (x3, y5), (x4, y5), and (x5, y5), the run length data is (x3, y5, 3).

ステップS16、S17では、図7(b)に示すように対象物のラベリングをすることにより、対象物を抽出する処理を行う。すなわち、ランレングスデータ化したラインL1〜L8のうち、y方向に重なる部分のあるラインL1〜L3を1つの対象物1とみなし、ラインL4〜L8を1つの対象物2とみなし、ランレングスデータに対象物ラベル1,2を付加する。この処理により、例えば図6に示す高輝度領域が、それぞれ対象物1から4として把握されることになる。   In steps S16 and S17, processing for extracting an object is performed by labeling the object as shown in FIG. 7B. That is, of the lines L1 to L8 converted to run length data, the lines L1 to L3 having portions overlapping in the y direction are regarded as one object 1, the lines L4 to L8 are regarded as one object 2, and the run length data The object labels 1 and 2 are added to. By this processing, for example, the high luminance regions shown in FIG. 6 are grasped as the objects 1 to 4, respectively.

ステップS18では図7(c)に示すように、抽出した対象物の重心G、面積S及び破線で示す外接四角形の縦横比ASPECTを算出する。面積Sは、ランレングスデータの長さを同一対象物について積算することにより算出し、重心Gの座標は、面積Sをx方向に2等分する線のx座標及びy方向に2等分する線のy座標として算出し、縦横比APECTは、図7(c)に示すDyとDxとの比Dy/Dxとして算出する。なお、重心Gの位置は、外接四角形の重心位置で代用してもよい。   In step S18, as shown in FIG. 7C, the center-of-gravity G of the extracted object, the area S, and the aspect ratio ASPECT of the circumscribed rectangle indicated by the broken line are calculated. The area S is calculated by integrating the lengths of the run length data for the same object, and the coordinates of the center of gravity G are equally divided into the x coordinate of the line that bisects the area S in the x direction and the y direction. The aspect ratio APECT is calculated as a ratio Dy / Dx between Dy and Dx shown in FIG. 7C. Note that the position of the center of gravity G may be substituted by the position of the center of gravity of the circumscribed rectangle.

ステップS19では、対象物の時刻間追跡、すなわちサンプリング周期毎に同一対象物の認識を行う。アナログ量としての時刻tをサンプリング周期で離散化した時刻をkとし、図8(a)に示すように時刻kで対象物1,2を抽出した場合において、時刻(k+1)で抽出した対象物3,4と、対象物1,2との同一性判定を行う。具体的には、以下の同一性判定条件1)〜3)を満たすときに、対象物1、2と対象物3、4とは同一であると判定し、対象物3、4をそれぞれ1,2というラベルに変更することにより、時刻間追跡が行われる。   In step S19, tracking of the object is performed between times, that is, the same object is recognized for each sampling period. When the time t as an analog quantity is discretized by the sampling period is k, and the objects 1 and 2 are extracted at the time k as shown in FIG. 8A, the object extracted at the time (k + 1) The identity determination between 3 and 4 and the objects 1 and 2 is performed. Specifically, when the following identity determination conditions 1) to 3) are satisfied, it is determined that the objects 1 and 2 and the objects 3 and 4 are the same, and the objects 3 and 4 are set to 1, respectively. By changing the label to 2, tracking between times is performed.

1)時刻kにおける対象物i(=1,2)の画像上での重心位置座標を、それぞれ(xi(k),yi(k))とし、時刻(k+1)における対象物j(=3,4)の画像上での重心位置座標を、(xj(k+1),yj(k+1))としたとき、
|xj(k+1)−xi(k)|<Δx
|yj(k+1)−yi(k)|<Δy
であること。ただし、Δx、Δyは、それぞれx方向及びy方向の画像上の移動量の許容値である。
1) The center-of-gravity position coordinates on the image of the object i (= 1, 2) at the time k are (xi (k), yi (k)), respectively, and the object j (= 3, 3) at the time (k + 1). 4) When the center-of-gravity position coordinates on the image are (xj (k + 1), yj (k + 1)),
| Xj (k + 1) −xi (k) | <Δx
| Yj (k + 1) −yi (k) | <Δy
Be. However, Δx and Δy are allowable values of the movement amount on the image in the x direction and the y direction, respectively.

2)時刻kにおける対象物i(=1,2)の画像上での面積をSi(k)とし、時刻(k+1)における対象物j(=3,4)の画像上での面積をSj(k+1)としたとき、
Sj(k+1)/Si(k)<1±ΔS
であること。ただし、ΔSは面積変化の許容値である。
2) The area of the object i (= 1, 2) on the image at time k is Si (k), and the area of the object j (= 3, 4) on the image at time (k + 1) is Sj ( k + 1)
Sj (k + 1) / Si (k) <1 ± ΔS
Be. However, ΔS is an allowable value of area change.

3)時刻kにおける対象物i(=1,2)の外接四角形の縦横比をASPECTi(k)とし、時刻(k+1)における対象物j(=3,4)の外接四角形の縦横比をASPECTj(k+1)としたとき、
ASPECTj(k+1)/ASPECTi(k)<1±ΔASPECT
であること。ただし、ΔASPECTは縦横比変化の許容値である。
3) The aspect ratio of the circumscribed rectangle of the object i (= 1, 2) at time k is ASPECTTi (k), and the aspect ratio of the circumscribed rectangle of the object j (= 3,4) at time (k + 1) is ASPECTj ( k + 1)
ASPECTj (k + 1) / ASPECTTi (k) <1 ± ΔASPECT
Be. However, ΔASPECT is an allowable value of the aspect ratio change.

図8(a)と(b)とを対比すると、各対象物は画像上での大きさが大きくなっているが、対象物1と3とが上記同一性判定条件を満たし、対象物2と4とが上記同一性判定条件を満たすので、対象物3、4はそれぞれ対象物1、2と認識される。このようにして認識された各対象物の(重心の)位置座標は、時系列位置データとしてメモリに格納され、後の演算処理に使用される。
なお以上説明したステップS14〜S19の処理は、2値化した基準画像(本実施形態では、右画像)ついて実行する。
8 (a) and 8 (b), each object has a large size on the image, but the objects 1 and 3 satisfy the above-described identity determination condition, and the object 2 and 4 and 4 meet the identity determination condition, the objects 3 and 4 are recognized as the objects 1 and 2, respectively. The position coordinates (center of gravity) of each object recognized in this manner are stored in the memory as time-series position data and used for later calculation processing.
Note that the processing in steps S14 to S19 described above is executed for a binarized reference image (right image in the present embodiment).

図3のステップS20では、車速センサ6により検出される車速VCAR及びヨーレートセンサ5より検出されるヨーレートYRを読み込み、ヨーレートYRを時間積分することより、自車両10の回頭角θr(図14参照)を算出する。   In step S20 in FIG. 3, the vehicle speed VCAR detected by the vehicle speed sensor 6 and the yaw rate YR detected by the yaw rate sensor 5 are read, and the yaw rate YR is integrated over time, whereby the turning angle θr of the host vehicle 10 (see FIG. 14). Is calculated.

一方、ステップS31〜S33では、ステップS19,S20の処理と平行して、対象物と自車両10と距離zを算出する処理を行う。この演算はステップS19,S20より長い時間を要するため、ステップS19,S20より長い周期(例えばステップS11〜S20の実行周期の3倍程度の周期)で実行される。   On the other hand, in steps S31 to S33, in parallel with the processes in steps S19 and S20, a process of calculating the object, the host vehicle 10, and the distance z is performed. Since this calculation requires a longer time than steps S19 and S20, it is executed in a longer cycle than steps S19 and S20 (for example, a cycle about three times the execution cycle of steps S11 to S20).

ステップS31では、基準画像(右画像)の2値化画像によって追跡される対象物の中の1つを選択することにより、図9(a)に示すように右画像から探索画像R1(ここでは、外接四角形で囲まれる領域全体を探索画像とする)を抽出する。続くステップS32では、左画像中から探索画像に対応する画像(以下「対応画像」という)を探索する探索領域を設定し、相関演算を実行して対応画像を抽出する。具体的には、探索画像R1の各頂点座標に応じて左画像中に図9(b)に示すように、探索領域R2を設定し、探索領域R2内で探索画像R1との相関の高さを示す輝度差分総和値C(a,b)を下記式(1)により算出し、この総和値C(a,b)が最小となる領域を対応画像として抽出する。なお、この相関演算は、2値画像ではなくグレースケール画像を用いて行う。また同一対象物についての過去の位置データがあるときは、その位置データに基づいて探索領域R2より狭い領域R2a(図9(b)に破線で示す)を探索領域として設定する。

Figure 0003949628
In step S31, by selecting one of the objects tracked by the binarized image of the reference image (right image), the search image R1 (in this case) is selected from the right image as shown in FIG. , The entire region surrounded by the circumscribed rectangle is set as a search image). In the subsequent step S32, a search area for searching for an image corresponding to the search image (hereinafter referred to as “corresponding image”) from the left image is set, and a correlation operation is executed to extract the corresponding image. Specifically, as shown in FIG. 9B, the search area R2 is set in the left image according to the vertex coordinates of the search image R1, and the correlation between the search image R1 and the search image R1 is high. Is calculated by the following equation (1), and a region where the total value C (a, b) is minimum is extracted as a corresponding image. This correlation calculation is performed using a gray scale image instead of a binary image. When there is past position data for the same object, an area R2a (shown by a broken line in FIG. 9B) narrower than the search area R2 is set as a search area based on the position data.
Figure 0003949628

ここで、IR(m,n)は、図10に示す探索画像R1内の座標(m,n)の位置の輝度値であり、IL(a+m−M,b+n−N)は、探索領域内の座標(a,b)を基点とした、探索画像R1と同一形状の局所領域R3内の座標(m,n)の位置の輝度値である。基点の座標(a,b)を変化させて輝度差分総和値C(a,b)が最小となる位置を求めることにより、対応画像の位置が特定される。   Here, IR (m, n) is a luminance value at the position of the coordinate (m, n) in the search image R1 shown in FIG. 10, and IL (a + m−M, b + n−N) is in the search region. The luminance value at the position of the coordinates (m, n) in the local region R3 having the same shape as the search image R1, with the coordinates (a, b) as a base point. The position of the corresponding image is specified by determining the position where the luminance difference sum C (a, b) is minimized by changing the coordinates (a, b) of the base point.

ステップS32の処理により、図11に示すように探索画像R1と、この対象物に対応する対応画像R4とが抽出されるので、ステップS33では、探索画像R1の重心位置と、画像中心線LCTRとの距離dR(画素数)及び対応画像R4の重心位置と画像中心線LCTRとの距離dL(画素数)を求め、下記式(2)に適用して、自車両10と、対象物との距離zを算出する。

Figure 0003949628
Since the search image R1 and the corresponding image R4 corresponding to the object are extracted by the process of step S32 as shown in FIG. 11, in step S33, the position of the center of gravity of the search image R1, the image center line LCTR, Distance dR (number of pixels) and the distance dL (number of pixels) between the center of gravity of the corresponding image R4 and the image center line LCTR are obtained and applied to the following equation (2) to determine the distance between the host vehicle 10 and the object. z is calculated.
Figure 0003949628

ここで、Bは基線長、すなわち図12に示すようにカメラ1Rの撮像素子11Rの中心位置と、カメラ1Lの撮像素子11Lの中心位置との水平方向(x方向)の距離(両カメラの光軸の間隔)、Fはレンズ12R、12Lの焦点距離、pは、撮像素子11R、11L内の画素間隔であり、Δd(=dR+dL)が視差量である。   Here, B is the baseline length, that is, the distance in the horizontal direction (x direction) between the center position of the image sensor 11R of the camera 1R and the center position of the image sensor 11L of the camera 1L as shown in FIG. Axis spacing), F is the focal length of the lenses 12R and 12L, p is the pixel spacing in the image sensors 11R and 11L, and Δd (= dR + dL) is the amount of parallax.

ステップS21では、画像内の座標(x,y)及び式(2)により算出した距離zを下記式(3)に適用し、実空間座標(X,Y,Z)に変換する。ここで、実空間座標(X,Y,Z)は、図13(a)に示すように、カメラ1R、1Lの取り付け位置の中点の位置(自車両10に固定された位置)を原点Oとして、図示のように定め、画像内の座標は同図(b)に示すように、画像の中心を原点として水平方向をx、垂直方向をyと定めている。

Figure 0003949628
In step S21, the coordinates (x, y) in the image and the distance z calculated by the equation (2) are applied to the following equation (3) to convert to real space coordinates (X, Y, Z). Here, as shown in FIG. 13A, the real space coordinates (X, Y, Z) are obtained by setting the position of the middle point (the position fixed to the host vehicle 10) of the camera 1R, 1L as the origin O. The coordinates in the image are defined as x in the horizontal direction and y in the vertical direction with the center of the image as the origin, as shown in FIG.
Figure 0003949628

ここで、(xc,yc)は、右画像上の座標(x,y)を、カメラ1Rの取り付け位置と、実空間原点Oとの相対位置関係に基づいて、実空間原点Oと画像の中心とを一致させた仮想的な画像内の座標に変換したものである。またfは、焦点距離Fと画素間隔pとの比である。   Here, (xc, yc) is the coordinate (x, y) on the right image based on the relative position relationship between the mounting position of the camera 1R and the real space origin O and the center of the image. Are converted into coordinates in a virtual image. F is a ratio between the focal length F and the pixel interval p.

ステップS22では、自車両10が回頭することによる画像上の位置ずれを補正するための回頭角補正を行う。図14に示すように、時刻kから(k+1)までの期間中に自車両が例えば左方向に回頭角θrだけ回頭すると、カメラによって得られる画像上では、図15に示すようにΔxだけx方向にずれるので、これを補正する処理である。具体的には、下記式(4)に実空間座標(X,Y,Z)を適用して、補正座標(Xr,Yr,Zr)を算出する。算出した実空間位置データ(Xr,Yr,Zr)は、対象物毎に対応づけてメモリに格納する。なお、以下の説明では、回頭角補正後の座標を(X,Y,Z)と表示する。

Figure 0003949628
In step S22, the turning angle correction for correcting the positional deviation on the image due to the turning of the host vehicle 10 is performed. As shown in FIG. 14, when the host vehicle turns, for example, to the left by the turning angle θr during the period from time k to (k + 1), on the image obtained by the camera, as shown in FIG. This is a process for correcting this. Specifically, correction coordinates (Xr, Yr, Zr) are calculated by applying real space coordinates (X, Y, Z) to the following equation (4). The calculated real space position data (Xr, Yr, Zr) is stored in the memory in association with each object. In the following description, the coordinates after the turning angle correction are displayed as (X, Y, Z).
Figure 0003949628

ステップS23では、図16に示すように同一対象物について、ΔTの期間内に得られた、回頭角補正後のN個の実空間位置データ(例えばN=10程度)、すなわち時系列データから、対象物と自車両10との相対移動ベクトルに対応する近似直線LMVを求める。具体的には、近似直線LMVの方向を示す方向ベクトルL=(lx,ly,lz)(|L|=1)とすると、下記式(5)で表される直線を求める。

Figure 0003949628
In step S23, for the same object as shown in FIG. 16, N pieces of real space position data (for example, about N = 10) after turning angle correction obtained during the period of ΔT, that is, time-series data, An approximate straight line LMV corresponding to the relative movement vector between the object and the vehicle 10 is obtained. Specifically, when a direction vector L = (lx, ly, lz) (| L | = 1) indicating the direction of the approximate straight line LMV, a straight line represented by the following formula (5) is obtained.
Figure 0003949628

ここでuは、任意の値をとる媒介変数であり、Xav,Yav及びZavは、それぞれ実空間位置データ列のX座標の平均値、Y座標の平均値及びZ座標の平均値である。なお、式(5)は媒介変数uを消去すれば下記式(5a)のようになる。
(X−Xav)/lx=(Y−Yav)/ly=(Z−Zav)/lz
…(5a)
Here, u is a parameter that takes an arbitrary value, and Xav, Yav, and Zav are the average value of the X coordinate, the average value of the Y coordinate, and the average value of the Z coordinate of the real space position data string, respectively. Equation (5) becomes the following equation (5a) if the parameter u is deleted.
(X-Xav) / lx = (Y-Yav) / ly = (Z-Zav) / lz
... (5a)

図16は、近似直線LMVを説明するための図であり、同図のP(0),P(1),P(2),…,P(N−2),P(N−1)が回頭角補正後の時系列データを示し、近似直線LMVは、この時系列データの平均位置座標Pav(=(Xav,Yav,Zav))を通り、各データ点からの距離の2乗の平均値が最小となるような直線として求められる。ここで各データ点の座標を示すPに付した()内の数値はその値が増加するほど過去のデータであることを示す。例えば、P(0)は最新の位置座標、P(1)は1サンプル周期前の位置座標、P(2)は2サンプル周期前の位置座標を示す。以下の説明におけるD(j)、X(j)、Y(j)、Z(j)等も同様である。   FIG. 16 is a diagram for explaining the approximate straight line LMV, and P (0), P (1), P (2),..., P (N-2), P (N-1) in FIG. The time series data after the turning angle correction is shown, and the approximate straight line LMV passes through the average position coordinates Pav (= (Xav, Yav, Zav)) of this time series data, and the average value of the square of the distance from each data point Is obtained as a straight line that minimizes. Here, the numerical value in () attached to P indicating the coordinates of each data point indicates that the data increases as the value increases. For example, P (0) indicates the latest position coordinates, P (1) indicates the position coordinates one sample period before, and P (2) indicates the position coordinates two sample periods before. The same applies to D (j), X (j), Y (j), Z (j) and the like in the following description.

より具体的には、平均位置座標Pavから各データ点の座標P(0)〜P(N−1)に向かうベクトルD(j)=(DX(j),DY(j),DZ(j))=(X(j)−Xav,Y(j)−Yav,Z(j)−Zav)と、方向ベクトルLとの内積sを下記式(6)により算出し、この内積sの分散が最大となる方向ベクトルL=(lx,ly,lz)を求める。
s=lx・DX(j)+ly・DY(j)+lz・DZ(j) (6)
More specifically, a vector D (j) = (DX (j), DY (j), DZ (j) from the average position coordinate Pav to the coordinates P (0) to P (N−1) of each data point. ) = (X (j) -Xav, Y (j) -Yav, Z (j) -Zav)) and the inner product s of the direction vector L are calculated by the following equation (6), and the variance of the inner product s is maximum. A direction vector L = (lx, ly, lz) is obtained.
s = lx · DX (j) + ly · DY (j) + lz · DZ (j) (6)

各データ点の座標の分散共分散行列Vは、下記式(7)で表され、この行列の固有値σが内積sの分散に相当するので、この行列から算出される3つの固有値のうち最大の固有値に対応する固有ベクトルが求める方向ベクトルLとなる。なお、式(7)の行列から固有値と固有ベクトルを算出するには、ヤコビ法(例えば「数値計算ハンドブック」(オーム社)に示されている)として知られている手法を用いる。

Figure 0003949628
The variance-covariance matrix V of the coordinates of each data point is expressed by the following equation (7). Since the eigenvalue σ of this matrix corresponds to the variance of the inner product s, the maximum of the three eigenvalues calculated from this matrix is The eigenvector corresponding to the eigenvalue is the direction vector L to be obtained. In order to calculate eigenvalues and eigenvectors from the matrix of equation (7), a method known as the Jacobian method (for example, shown in “Numerical Calculation Handbook” (Ohm)) is used.
Figure 0003949628

次いで最新の位置座標P(0)=(X(0),Y(0),Z(0))と、(N−1)サンプル前(時間ΔT前)の位置座標P(Nー1)=(X(N−1),Y(N−1),Z(N−1))を近似直線LMV上の位置に補正する。具体的には、前記式(5a)にZ座標Z(0)、Z(N−1)を適用することにより、すなわち下記式(8)により、補正後の位置座標Pv(0)=(Xv(0),Yv(0),Zv(0))及びPv(N−1)=(Xv(N−1),Yv(N−1),Zv(N−1))を求める。

Figure 0003949628
Next, the latest position coordinate P (0) = (X (0), Y (0), Z (0)) and (N−1) position coordinate P (N−1) before the sample (before time ΔT) = (X (N-1), Y (N-1), Z (N-1)) is corrected to a position on the approximate straight line LMV. Specifically, by applying the Z coordinates Z (0) and Z (N−1) to the equation (5a), that is, according to the following equation (8), the corrected position coordinates Pv (0) = (Xv (0), Yv (0), Zv (0)) and Pv (N-1) = (Xv (N-1), Yv (N-1), Zv (N-1)) are obtained.
Figure 0003949628

式(8)で算出された位置座標Pv(N−1)からPv(0)に向かうベクトルとして、相対移動ベクトルが得られる。このようにモニタ期間ΔT内の複数(N個)のデータから対象物の自車両10に対する相対移動軌跡を近似する近似直線を算出して相対移動ベクトルを求めることにより、位置検出誤差の影響を軽減して対象物との衝突の可能性をより正確に予測することが可能となる。   A relative movement vector is obtained as a vector from the position coordinates Pv (N−1) calculated by Expression (8) toward Pv (0). In this way, by calculating an approximate straight line that approximates the relative movement locus of the object with respect to the host vehicle 10 from a plurality (N) of data within the monitoring period ΔT, the influence of the position detection error is reduced. Thus, the possibility of collision with the object can be predicted more accurately.

図3に戻り、ステップS24では、検出した対象物との衝突の可能性を判定し、その可能性が高いときに警報を発する警報判定処理(図4)を実行する。
ステップS41では、下記式(9)によりZ方向の相対速度Vsを算出し、下記式(10)及び(11)が成立するとき、衝突の可能性があると判定してステップS42に進み、式(10)及び/または式(11)が不成立のときは、この処理を終了する。
Vs=(Zv(N−1)−Zv(0))/ΔT (9)
Zv(0)/Vs≦T (10)
|Yv(0)|≦H (11)
Returning to FIG. 3, in step S <b> 24, the possibility of collision with the detected object is determined, and an alarm determination process (FIG. 4) for issuing an alarm when the possibility is high is executed.
In step S41, the relative speed Vs in the Z direction is calculated by the following equation (9). When the following equations (10) and (11) are satisfied, it is determined that there is a possibility of a collision, and the process proceeds to step S42. If (10) and / or equation (11) is not established, this process is terminated.
Vs = (Zv (N−1) −Zv (0)) / ΔT (9)
Zv (0) / Vs ≦ T (10)
| Yv (0) | ≦ H (11)

ここで、Zv(0)は最新の距離検出値(vは近似直線LMVによる補正後のデータであることを示すために付しているが、Z座標は補正前と同一の値である)であり、Zv(N−1)は、時間ΔT前の距離検出値である。またTは、余裕時間であり、衝突の可能性を予測衝突時刻より時間Tだけ前に判定することを意図したものであり、例えば2〜5秒程度に設定される。またHは、Y方向、すなわち高さ方向の範囲を規定する所定高さであり、例えば自車両10の車高の2倍程度に設定される。
式(10)の関係を図示すると図17に示すようになり、検出した相対速度Vsと距離Zv(0)とに対応する座標が、ハッチングを付した領域にあり、かつ|Yv(0)|≦Hであるとき、ステップS42以下の判定が実行される。
Here, Zv (0) is the latest distance detection value (v is attached to indicate that it is data after correction by the approximate straight line LMV, but the Z coordinate is the same value as before correction). Yes, Zv (N−1) is a distance detection value before time ΔT. T is an allowance time and is intended to determine the possibility of a collision by a time T before the predicted collision time, and is set to about 2 to 5 seconds, for example. H is a predetermined height that defines a range in the Y direction, that is, the height direction, and is set to, for example, about twice the vehicle height of the host vehicle 10.
The relationship of equation (10) is illustrated in FIG. 17, where the coordinates corresponding to the detected relative velocity Vs and the distance Zv (0) are in the hatched area, and | Yv (0) | When ≦ H, the determination after step S42 is executed.

図18は、カメラ1R、1Lで監視可能な領域を、太い実線で示す外側の三角形の領域AR0で示し、さらに領域AR0内の、Z1=Vs×Tより自車両10に近い領域AR1,AR2,AR3を、警報判定領域としている。ここで領域AR1は、自車両10の車幅αの両側に余裕β(例えば50〜100cm程度とする)を加えた範囲に対応する領域、換言すれば自車両10の横方向の中心軸の両側に(α/2+β)の幅を有する領域であって、対象物がそのまま存在し続ければ衝突の可能性がきわめて高いので、接近判定領域と呼ぶ。領域AR2,AR3は、接近判定領域よりX座標の絶対値が大きい(接近判定領域の横方向外側の)領域であり、この領域内にある対象物については、後述する侵入衝突判定を行うので、侵入判定領域と呼ぶ。なおこれらの領域は、前記式(11)に示したようにY方向には、所定高さHを有する。   FIG. 18 shows an area that can be monitored by the cameras 1R and 1L as an outer triangular area AR0 indicated by a thick solid line, and further, areas AR1, AR2, closer to the host vehicle 10 than Z1 = Vs × T in the area AR0. AR3 is used as an alarm determination area. Here, the area AR1 is an area corresponding to a range obtained by adding a margin β (for example, about 50 to 100 cm) to both sides of the vehicle width α of the host vehicle 10, in other words, both sides of the lateral central axis of the host vehicle 10. The region having a width of (α / 2 + β) is called an approach determination region because the possibility of a collision is extremely high if the object continues to exist as it is. The areas AR2 and AR3 are areas where the absolute value of the X coordinate is larger than that of the approach determination area (outside in the lateral direction of the approach determination area), and for an object in this area, an intrusion collision determination described later is performed. This is called an intrusion determination area. These regions have a predetermined height H in the Y direction as shown in the equation (11).

前記ステップS41の答が肯定(YES)となるのは、対象物が接近判定領域AR1または侵入判定領域AR2,AR3のいずれかに存在する場合である。
続くステップS42では、対象物が接近判定領域AR1内にあるか否かを判別し、この答が肯定(YES)であるときは、直ちにステップS44に進む一方、否定(NO)であるときは、ステップS43で侵入衝突判定を行う。具体的には、画像上での最新のx座標xc(0)(cは前述したように画像の中心位置を実空間原点Oに一致させる補正を行った座標であることを示すために付している)と、時間ΔT前のx座標xc(N−1)との差が下記式(12)を満たすか否かを判別し、満たす場合に衝突の可能性が高いと判定する。

Figure 0003949628
The answer to step S41 is affirmative (YES) when the object exists in either the approach determination area AR1 or the intrusion determination areas AR2 and AR3.
In subsequent step S42, it is determined whether or not the object is in the approach determination area AR1, and when the answer is affirmative (YES), the process immediately proceeds to step S44, whereas when the answer is negative (NO), In step S43, an intrusion collision determination is performed. Specifically, the latest x-coordinate xc (0) on the image (c is added to indicate that the correction has been made so that the center position of the image matches the real space origin O as described above. And the difference from the x coordinate xc (N−1) before the time ΔT satisfies the following formula (12), and if so, it is determined that the possibility of a collision is high.
Figure 0003949628

図19に示すように、自車両10の進行方向に対してほぼ90°の方向から進行してくる動物20がいた場合、Xv(Nー1)/Zv(N−1)=Xv(0)/Zv(0)であるとき、換言すれば動物の速度Vpと相対速度Vsの比Vp/Vs=Xv(Nー1)/Zv(N−1)であるとき、自車両10から動物20と見る方位角θdは一定となり、衝突の可能性が高い。式(12)は、この可能性を自車両10の車幅αを考慮して判定するものである。以下図20を参照して式(12)の導出手法を説明する。   As shown in FIG. 19, when there is an animal 20 traveling from a direction of approximately 90 ° with respect to the traveling direction of the host vehicle 10, Xv (N−1) / Zv (N−1) = Xv (0) / Zv (0), in other words, when the ratio Vp / Vs = Xv (N−1) / Zv (N−1) between the animal speed Vp and the relative speed Vs, The viewing azimuth angle θd is constant and the possibility of collision is high. Formula (12) determines this possibility in consideration of the vehicle width α of the host vehicle 10. Hereinafter, the method of deriving the equation (12) will be described with reference to FIG.

対象物20の最新の位置座標と時間ΔT前の位置座標と通る直線、すなわち近似直線LMVとXY平面(X軸とY軸とを含む平面、すなわち車両10の先端部に対応する線(X軸)を含み車両10の進行方向に垂直な面)との交点のX座標をXCLとすると、車幅αを考慮した衝突発生の条件は、下記式(13)で与えられる。   A straight line passing through the latest position coordinate of the object 20 and the position coordinate before time ΔT, that is, an approximate straight line LMV and an XY plane (a plane including the X axis and the Y axis, that is, a line corresponding to the tip of the vehicle 10 (X axis ) And the plane perpendicular to the traveling direction of the vehicle 10), the condition for the occurrence of a collision in consideration of the vehicle width α is given by the following equation (13).

−α/2≦XCL≦α/2 (13)
一方近似直線LMVをXZ平面に投影した直線は、下記式(14)で与えられる。

Figure 0003949628
この式にZ=0,X=XCLを代入してXCLを求めると下記式(15)のようになる。
Figure 0003949628
-Α / 2 ≦ XCL ≦ α / 2 (13)
On the other hand, a straight line obtained by projecting the approximate straight line LMV onto the XZ plane is given by the following equation (14).
Figure 0003949628
Substituting Z = 0 and X = XCL into this equation to obtain XCL yields the following equation (15).
Figure 0003949628

また実空間座標Xと、画像上の座標xcとは、前記式(3)に示した関係があるので、
Xv(0)=xc(0)×Zv(0)/f (16)
Xv(N−1)=xc(N−1)×Zv(N−1)/f (17)
であり、これらを式(15)に適用すると、交点X座標XCLは下記式(18)で与えられる。これを式(13)に代入して整理することにより、式(12)の条件が得られる。

Figure 0003949628
Further, since the real space coordinate X and the coordinate xc on the image have the relationship shown in the equation (3),
Xv (0) = xc (0) × Zv (0) / f (16)
Xv (N-1) = xc (N-1) * Zv (N-1) / f (17)
When these are applied to the equation (15), the intersection X coordinate XCL is given by the following equation (18). By substituting this into equation (13) and rearranging, the condition of equation (12) is obtained.
Figure 0003949628

図4に戻り、ステップS43で衝突の可能性が高いと判定したときは、ステップS44に進み、低いと判定したときは本処理を終了する。
ステップS44では、以下のようにして警報出力判定、すなわち警報出力を行うか否かの判定を行う。先ずブレーキセンサ7の出力から自車両10の運転者がブレーキ操作を行っているか否かを判別し、ブレーキ操作を行っていなければ直ちにステップS45に進んで、警報出力を行う。ブレーキ操作を行っている場合には、それによって発生する加速度Gs(減速方向を正とする)を算出し、この加速度Gsが所定閾値GTH以下であるときは、ステップS45に進む一方、Gx>GTHであるときは、ブレーキ操作により衝突が回避されると判定して本処理を終了する。これにより、適切なブレーキ操作が行われているときは、警報を発しないようにして、運転者に余計な煩わしさを与えないようにすることができる。
Returning to FIG. 4, when it is determined in step S43 that the possibility of a collision is high, the process proceeds to step S44, and when it is determined that the collision is low, this process is terminated.
In step S44, alarm output determination, that is, whether or not alarm output is to be performed is performed as follows. First, it is determined from the output of the brake sensor 7 whether or not the driver of the host vehicle 10 is performing a brake operation. If the brake operation is not being performed, the process immediately proceeds to step S45 to output an alarm. If the brake operation is being performed, the acceleration Gs generated (deceleration direction is positive) is calculated. If the acceleration Gs is less than or equal to the predetermined threshold GTH, the process proceeds to step S45 while Gx> GTH When it is, it determines with a collision being avoided by brake operation, and complete | finishes this process. As a result, when an appropriate brake operation is performed, an alarm is not issued, and the driver is not bothered excessively.

所定閾値GTHは、下記式(19)のように定める。これは、ブレーキ加速度Gsがそのまま維持された場合に、距離Zv(0)以下の走行距離で自車両10が停止する条件に対応する値である。

Figure 0003949628
ステップS45では、スピーカ3を介して音声による警報を発するとともに、図21に示すようにHUD4により例えばカメラ1Rにより得られる画像を画面4aに表示し、接近してくる対象物を強調表示する(例えば枠で囲んで強調する)する。図21(a)はHUDの画面4aの表示がない状態を示し、同図(b)が画面4aが表示された状態を示す。このようにすることにより、衝突の可能性の高い対象物を運転者が確実に認識することができる。 The predetermined threshold GTH is determined as in the following formula (19). This is a value corresponding to a condition in which the host vehicle 10 stops at a travel distance equal to or less than the distance Zv (0) when the brake acceleration Gs is maintained as it is.
Figure 0003949628
In step S45, an audio alarm is issued via the speaker 3, and an image obtained by the camera 1R, for example, is displayed on the screen 4a by the HUD 4 as shown in FIG. 21, and an approaching object is highlighted (for example, (Enhance with a frame). FIG. 21A shows a state where the HUD screen 4a is not displayed, and FIG. 21B shows a state where the screen 4a is displayed. In this way, the driver can reliably recognize an object having a high possibility of collision.

以上のように本実施形態では、同一対象物についての時系列の複数の位置データに基づいてその対象物の実空間での位置を算出し、その実空間位置から移動ベクトルを算出し、そのようにして算出された移動ベクトルに基づいて対象物と自車両10との衝突の可能性を判定するようにしたので、従来の装置のような誤判定が発生することがなく、衝突可能性の判定精度を向上させることができる。
また、対象物の相対移動軌跡を近似する近似直線LMVを求め、検出位置がこの近似直線上の位置するように位置座標を補正し、補正後の位置座標から移動ベクトルを求めるようにしたので、検出位置の誤差の影響を軽減してより正確な衝突可能性の判定を行うことができる。
また車幅αを考慮した衝突判定を行うようにしたので、衝突の可能性を正確に判定し、無用の警報を発することを防止することができる。
As described above, in the present embodiment, the position in the real space of the target object is calculated based on a plurality of time-series position data for the same target object, and the movement vector is calculated from the real space position. Since the possibility of collision between the target object and the host vehicle 10 is determined based on the movement vector calculated in the above manner, the erroneous determination as in the conventional apparatus does not occur, and the determination accuracy of the collision possibility Can be improved.
Also, an approximate straight line LMV that approximates the relative movement trajectory of the object is obtained, the position coordinates are corrected so that the detection position is located on this approximate line, and the movement vector is obtained from the corrected position coordinates. It is possible to reduce the influence of the error in the detection position and perform a more accurate collision possibility determination.
Further, since the collision determination is performed in consideration of the vehicle width α, it is possible to accurately determine the possibility of the collision and prevent the use of an unnecessary warning.

本実施形態では、画像処理ユニット2が、相対位置検出手段、実空間位置算出手段、判定手段、及び警報手段の一部を構成する。より具体的には、図3のステップS14〜S19が相対位置検出手段に相当し、ステップS20〜S23が実空間位置算出手段に相当し、図4のステップS41〜S44が判定手段に相当し、同図のステップS45並びにスピーカ3及びHUD4が警報手段に相当する。   In the present embodiment, the image processing unit 2 constitutes a part of relative position detection means, real space position calculation means, determination means, and alarm means. More specifically, steps S14 to S19 in FIG. 3 correspond to relative position detection means, steps S20 to S23 correspond to real space position calculation means, and steps S41 to S44 in FIG. 4 correspond to determination means. Step S45, the speaker 3 and the HUD 4 in FIG.

なお本発明は上述した実施形態に限るものではなく、種々の変形が可能である。例えば、本実施形態では、撮像手段として赤外線カメラを使用したが、例えば特開平9−226490号公報に示されるように通常の可視光線のみ検出可能なテレビカメラを使用してもよい。ただし、赤外線カメラを用いることにより、動物あるいは走行中の車両などの抽出処理を簡略化することができ、演算装置の演算能力が比較的低いものでも実現できる。
また上述した実施形態では、車両の前方を監視する例を示したが、車両の後方などいずれの方向を監視するようにしてもよい。
The present invention is not limited to the embodiment described above, and various modifications can be made. For example, in this embodiment, an infrared camera is used as the imaging means. However, for example, as shown in Japanese Patent Laid-Open No. 9-226490, a television camera that can detect only normal visible light may be used. However, by using an infrared camera, it is possible to simplify the extraction process of animals or running vehicles, and it can be realized even if the computing capability of the computing device is relatively low.
Moreover, although the example which monitors the front of a vehicle was shown in embodiment mentioned above, you may make it monitor any directions, such as the back of a vehicle.

本発明の一実施形態にかかる周辺監視装置の構成を示すブロック図である。It is a block diagram which shows the structure of the periphery monitoring apparatus concerning one Embodiment of this invention. 図1に示すカメラの取り付け位置を説明するための図である。It is a figure for demonstrating the attachment position of the camera shown in FIG. 図1の画像処理ユニットにおける処理の手順を示すフローチャートである。3 is a flowchart showing a processing procedure in the image processing unit of FIG. 1. 図3の警報判定処理を詳細に示すフローチャートである。It is a flowchart which shows the warning determination process of FIG. 3 in detail. 赤外線カメラにより得られるグレースケール画像を説明するために、中間階調部にハッチングを付して示す図である。In order to explain a gray scale image obtained by an infrared camera, it is a diagram showing hatching in an intermediate gradation part. グレースケール画像を2値化した画像を説明するために、黒の領域をハッチングを付して示す図である。It is a figure which shows the black area | region which hatched, in order to demonstrate the image which binarized the gray scale image. ランレングスデータへの変換処理及びラベリングを説明するための図である。It is a figure for demonstrating the conversion process and labeling to run length data. 対象物の時刻間追跡を説明するための図である。It is a figure for demonstrating tracking between the time of a target object. 右画像中の探索画像と、左画像に設定する探索領域を説明するための図である。It is a figure for demonstrating the search image in a right image, and the search area | region set to a left image. 探索領域を対象とした相関演算処理を説明するための図である。It is a figure for demonstrating the correlation calculation process which made the search area | region object. 視差の算出方法を説明するための図である。It is a figure for demonstrating the calculation method of a parallax. 視差から距離を算出する手法を説明するための図である。It is a figure for demonstrating the method of calculating distance from parallax. 本実施形態における座標系を示す図である。It is a figure which shows the coordinate system in this embodiment. 回頭角補正を説明するための図である。It is a figure for demonstrating a turning angle correction | amendment. 車両の回頭により発生する画像上の対象物位置のずれを示す図である。It is a figure which shows the shift | offset | difference of the target object position on the image which generate | occur | produces by turning of a vehicle. 相対移動ベクトルの算出手法を説明するための図である。It is a figure for demonstrating the calculation method of a relative movement vector. 警報判定を行う条件を説明するための図である。It is a figure for demonstrating the conditions which perform warning determination. 車両前方の領域区分を説明するための図である。It is a figure for demonstrating the area division ahead of a vehicle. 衝突が発生しやすい場合を説明するための図である。It is a figure for demonstrating the case where a collision is easy to generate | occur | produce. 車両の幅に応じた侵入警報判定の手法を説明するための図である。It is a figure for demonstrating the method of the intrusion warning determination according to the width | variety of a vehicle. ヘッドアップディスプレイ上の表示を説明するための図である。It is a figure for demonstrating the display on a head-up display.

符号の説明Explanation of symbols

1R、1L 赤外線カメラ(撮像手段)
2 画像処理ユニット(相対位置検出手段、実空間位置算出手段、判定手段、警報手段)
3 スピーカ(警報手段)
4 ヘッドアップディスプレイ(警報手段)
5 ヨーレートセンサ
6 車速センサ
7 ブレーキセンサ
1R, 1L infrared camera (imaging means)
2 Image processing unit (relative position detection means, real space position calculation means, determination means, alarm means)
3 Speaker (alarm means)
4 Head-up display (alarm means)
5 Yaw rate sensor 6 Vehicle speed sensor 7 Brake sensor

Claims (1)

車両に搭載された撮像手段により得られる画像から当該車両の周辺に存在する対象物を検出する車両の周辺監視装置において、
前記撮像手段により得られる画像から前記対象物の当該車両に対する相対位置を位置データとして検出する相対位置検出手段と、
該相対位置検出手段により検出される、前記対象物についての位置データに基づいてその対象物の実空間での位置を算出する実空間位置算出手段と、
該実空間位置算出手段により算出された、第1サンプリング時刻における前記対象物までの第1の距離と、前記第1サンプリング時刻から一定時間経過後の第2サンプリング時刻における前記対象物までの第2の距離とを算出し、前記第2の距離の逆数から前記第1の距離の逆数を減算した値に所定値を乗算することにより判定閾値を算出し、前記画像上での前記対象物の水平方向の移動距離が前記判定閾値以下であるとき、前記対象物が前記車両に衝突する可能性があると判定する判定手段とを備えることを特徴とする車両の周辺監視装置。
In the vehicle periphery monitoring device for detecting an object existing around the vehicle from an image obtained by an imaging means mounted on the vehicle,
Relative position detection means for detecting, as position data, a relative position of the object to the vehicle from an image obtained by the imaging means;
Real space position calculating means for calculating the position of the object in real space based on position data about the object detected by the relative position detecting means;
The first distance to the object at the first sampling time calculated by the real space position calculating means and the second distance to the object at the second sampling time after a lapse of a certain time from the first sampling time. And calculating a determination threshold by multiplying a value obtained by subtracting the reciprocal of the first distance from the reciprocal of the second distance, and calculating a horizontal value of the object on the image. A vehicle periphery monitoring device comprising: a determination unit that determines that the object may collide with the vehicle when a moving distance in a direction is equal to or less than the determination threshold.
JP2003309717A 2003-09-02 2003-09-02 Vehicle periphery monitoring device Expired - Fee Related JP3949628B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2003309717A JP3949628B2 (en) 2003-09-02 2003-09-02 Vehicle periphery monitoring device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2003309717A JP3949628B2 (en) 2003-09-02 2003-09-02 Vehicle periphery monitoring device

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP17672799A Division JP3515926B2 (en) 1999-06-23 1999-06-23 Vehicle periphery monitoring device

Publications (2)

Publication Number Publication Date
JP2004103018A JP2004103018A (en) 2004-04-02
JP3949628B2 true JP3949628B2 (en) 2007-07-25

Family

ID=32290713

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2003309717A Expired - Fee Related JP3949628B2 (en) 2003-09-02 2003-09-02 Vehicle periphery monitoring device

Country Status (1)

Country Link
JP (1) JP3949628B2 (en)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7778770B2 (en) 2005-03-31 2010-08-17 Honda Motor Co., Ltd. Communication system between vehicles
JP5676151B2 (en) * 2010-06-15 2015-02-25 株式会社横須賀テレコムリサーチパーク Positioning device and positioning method
JP6015756B2 (en) 2012-07-02 2016-10-26 日本電気株式会社 Position management device, position management system, position management method, and position management program
CN103287337A (en) * 2013-06-26 2013-09-11 宁夏新航信息科技有限公司 GPS life detection system
JP5884794B2 (en) 2013-08-29 2016-03-15 株式会社デンソー Collision possibility determination device and program
CN105403187A (en) * 2015-12-14 2016-03-16 长春轨道客车股份有限公司 High-speed motor train unit body three-dimensional dimension detection method
JP6504078B2 (en) * 2016-02-24 2019-04-24 株式会社デンソー Collision prediction device
WO2020062032A1 (en) * 2018-09-28 2020-04-02 Baidu.Com Times Technology (Beijing) Co., Ltd. A pedestrian probability prediction system for autonomous vehicles

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07105497A (en) * 1993-10-05 1995-04-21 Mitsubishi Electric Corp Inter-vehicle distance sensor
FR2713808B1 (en) * 1993-12-14 1996-01-26 Thomson Csf Anti-collision device, in particular for motor vehicles.
JPH0845000A (en) * 1994-07-28 1996-02-16 Fuji Heavy Ind Ltd Vehicle-to-vehicle distance controller
JP3727400B2 (en) * 1996-02-22 2005-12-14 株式会社日本自動車部品総合研究所 Crossing detection device
JP3866328B2 (en) * 1996-06-06 2007-01-10 富士重工業株式会社 Vehicle peripheral three-dimensional object recognition device
JPH10143245A (en) * 1996-11-07 1998-05-29 Komatsu Ltd Obstacle collision preventing device for mobile object
JP3337197B2 (en) * 1997-04-04 2002-10-21 富士重工業株式会社 Outside monitoring device

Also Published As

Publication number Publication date
JP2004103018A (en) 2004-04-02

Similar Documents

Publication Publication Date Title
JP4615139B2 (en) Vehicle periphery monitoring device
JP3515926B2 (en) Vehicle periphery monitoring device
JP3764086B2 (en) Vehicle information providing device
JP3739693B2 (en) Image recognition device
JP5503728B2 (en) Vehicle periphery monitoring device
JP4410292B1 (en) Vehicle periphery monitoring device
JP4173902B2 (en) Vehicle periphery monitoring device
JP2007241740A (en) Vehicle periphery monitoring device
JP2003016429A (en) Vehicle periphery monitor device
JP4528283B2 (en) Vehicle periphery monitoring device
JP2001169310A (en) Distance detector
JP3919975B2 (en) Vehicle periphery monitoring device
JP5292047B2 (en) Vehicle periphery monitoring device
JP3949628B2 (en) Vehicle periphery monitoring device
US7885430B2 (en) Automotive environment monitoring device, vehicle with the automotive environment monitoring device, and automotive environment monitoring program
JP3916930B2 (en) Approach warning device
JP2009075124A (en) Distance detector
JP3910345B2 (en) Position detection device
JP3897956B2 (en) Position detection device
JP4176558B2 (en) Vehicle periphery display device
JP4567072B2 (en) Vehicle periphery monitoring device
JP4943403B2 (en) Vehicle periphery monitoring device
JP3961269B2 (en) Obstacle alarm device
JP4040657B2 (en) Moving object detection device
JP2004362265A (en) Infrared image recognition device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040729

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20051102

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20051227

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20060220

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20070109

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20070302

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: 20070403

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070418

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20110427

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20110427

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20130427

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20130427

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20140427

Year of fee payment: 7

LAPS Cancellation because of no payment of annual fees