JP4661602B2 - Rear vehicle analysis device and collision prediction device - Google Patents

Rear vehicle analysis device and collision prediction device Download PDF

Info

Publication number
JP4661602B2
JP4661602B2 JP2006006679A JP2006006679A JP4661602B2 JP 4661602 B2 JP4661602 B2 JP 4661602B2 JP 2006006679 A JP2006006679 A JP 2006006679A JP 2006006679 A JP2006006679 A JP 2006006679A JP 4661602 B2 JP4661602 B2 JP 4661602B2
Authority
JP
Japan
Prior art keywords
vehicle
analysis device
positional relationship
rear vehicle
predetermined
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
JP2006006679A
Other languages
Japanese (ja)
Other versions
JP2007188349A (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.)
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 JP2006006679A priority Critical patent/JP4661602B2/en
Publication of JP2007188349A publication Critical patent/JP2007188349A/en
Application granted granted Critical
Publication of JP4661602B2 publication Critical patent/JP4661602B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Description

本発明は、自車両の後方に位置する後方車両の走行経路を解析する後方車両解析装置、及びこれを利用した衝突予測装置に関する。   The present invention relates to a rear vehicle analysis device that analyzes a travel route of a rear vehicle located behind the host vehicle, and a collision prediction device that uses the rear vehicle analysis device.

近年、主に自車両が停車している際に、後方から接近する車両をレーダー装置やカメラを用いて検出し、衝突を予測した場合に運転者に警報を行なう等、種々の制御を行なう車載用の装置が知られている。こうした装置においては、後方から接近する車両がそのまま走行すると自車両に衝突するか否かを判別することが必要である。   In recent years, mainly when the host vehicle is stopped, a vehicle approaching from the rear is detected using a radar device or a camera, and when a collision is predicted, an alarm is given to the driver. Devices for use are known. In such a device, it is necessary to determine whether or not the vehicle approaching from behind collides with the own vehicle when traveling as it is.

後方から接近する車両をカメラを用いて検出する装置の例として、自車両が端車線を走行している際には、路肩側における車両の検出を制限して、道路端に存在する種々の物体(街路樹や標識等)による誤検出を抑制したものが知られている(例えば、特許文献1参照)。
特開2002−104112号公報
As an example of a device that detects a vehicle approaching from behind using a camera, when the host vehicle is traveling in an end lane, the detection of the vehicle on the shoulder side is limited, and various objects existing at the end of the road There is known one in which erroneous detection due to (street trees, signs, etc.) is suppressed (see, for example, Patent Document 1).
JP 2002-104112 A

しかしながら、上記従来の特許文献1に記載の装置においては、車両と走行車線の位置関係が考慮されていない。このため、後方から接近する車両がそのまま走行すると自車両に衝突するか否かを適切に判別することができない場合が生じる。   However, in the device described in the above-mentioned conventional patent document 1, the positional relationship between the vehicle and the travel lane is not taken into consideration. For this reason, when a vehicle approaching from behind travels as it is, it may not be possible to appropriately determine whether or not it collides with the host vehicle.

例えば、交差点の右折待ち停車時等、自車両が走行車線に対してヨー角を有する場合が考えられるが、この場合、車両の進行方向(車両幅方向の中心軸に沿った方向)に沿って後方の車両を検出すると、道路上の走行車線に対して検出範囲が斜めに広がることとなる。従って、検出された車両は、必ずしもそのまま走行すると自車両に衝突する車両とは限らない。   For example, when the host vehicle has a yaw angle with respect to the traveling lane, such as when waiting for a right turn at an intersection, in this case, along the traveling direction of the vehicle (the direction along the central axis in the vehicle width direction) When a vehicle behind is detected, the detection range is extended obliquely with respect to the traveling lane on the road. Therefore, the detected vehicle is not necessarily a vehicle that collides with the host vehicle when traveling as it is.

また、自車両が走行車線内でいずれかの端に寄った状態である場合も考えられるが、この場合、そのまま走行すると自車両に衝突すると考えられる走行経路と道路上の走行車線が道路幅方向にずれを生じる。従って、カメラ等により認識された道路上の走行車線に沿って検出を行なうと、検出された車両は、必ずしもそのまま走行すると自車両に衝突する車両とは限らない。   In addition, there may be a case where the host vehicle is close to either end in the driving lane. In this case, the driving route and the driving lane on the road that are considered to collide with the host vehicle when the vehicle is driven as it is Deviation occurs. Therefore, if detection is performed along a traveling lane on a road recognized by a camera or the like, the detected vehicle is not necessarily a vehicle that collides with the own vehicle when traveling as it is.

本発明はこのような課題を解決するためのものであり、車両と走行車線の位置関係を考慮して自車両の後方に位置する後方車両の走行経路を適切に解析することが可能な後方車両解析装置を提供すること、及びこれを利用して後方からの衝突を適切に予測することが可能な衝突予測装置を提供することを、主たる目的とする。   The present invention is for solving such a problem, and a rear vehicle capable of appropriately analyzing a travel route of a rear vehicle located behind the host vehicle in consideration of the positional relationship between the vehicle and the travel lane. It is a main object to provide an analysis apparatus and a collision prediction apparatus that can appropriately predict a collision from behind by using the analysis apparatus.

上記目的を達成するための本発明の第1の態様は、自車両の後方に位置する後方車両の走行経路を解析する後方車両解析装置であって、走行車線と自車両の位置関係を検出する位置関係検出手段と、後方車両に関する情報を取得する後方車両情報取得手段と、位置関係検出手段により検出された走行車線と自車両の位置関係、及び、後方車両情報取得手段により取得された後方車両に関する情報、に基づいて、後方車両が自車両の後方に延在する所定後方領域を走行している確率を所定後方領域確率として推定する、所定後方領域確率推定手段と、を備えることを特徴とするものである。   In order to achieve the above object, a first aspect of the present invention is a rear vehicle analysis device that analyzes a travel route of a rear vehicle located behind the host vehicle, and detects a positional relationship between the travel lane and the host vehicle. Position relation detection means, rear vehicle information acquisition means for acquiring information related to the rear vehicle, position relation between the traveling lane and the own vehicle detected by the position relation detection means, and the rear vehicle acquired by the rear vehicle information acquisition means And a predetermined rear region probability estimating means for estimating, as a predetermined rear region probability, a probability that the rear vehicle is traveling in a predetermined rear region extending behind the host vehicle based on the information on To do.

この本発明の第1の態様によれば、車両と走行車線の位置関係を考慮して自車両の後方に位置する後方車両の走行経路を適切に解析することができる。   According to the first aspect of the present invention, it is possible to appropriately analyze the travel route of the rear vehicle positioned behind the host vehicle in consideration of the positional relationship between the vehicle and the travel lane.

また、この本発明の第1の態様において、所定後方領域は、例えば、車両後端の車両幅方向に関する中央部から走行車線に沿って車両の後方に延びる直線、を中心として走行車線に沿って延在する領域である。   Further, in the first aspect of the present invention, the predetermined rear region is, for example, along the travel lane centering on a straight line extending from the center of the rear end of the vehicle in the vehicle width direction along the travel lane to the rear of the vehicle. This is an extended area.

また、この本発明の第1の態様において、位置関係検出手段は、例えば、走行車線に対する自車両のヨー角、及び、自車両の走行車線幅方向における変位、を走行車線と自車両の位置関係として検出する手段である。   Further, in the first aspect of the present invention, the positional relationship detection means determines, for example, the yaw angle of the host vehicle with respect to the travel lane and the displacement of the host vehicle in the travel lane width direction, and the positional relationship between the travel lane and the host vehicle. It is a means to detect as.

また、この本発明の第1の態様において、所定後方領域確率推定手段は、例えば、後方車両情報取得手段が後方車両に関する情報を取得する範囲に対して、位置関係検出手段により検出された走行車線と自車両の位置関係に基づいて作成される所定の確率マップを適用して、前記所定後方領域確率を推定する手段である。   Further, in the first aspect of the present invention, the predetermined rear region probability estimation unit is, for example, a travel lane detected by the positional relationship detection unit with respect to a range in which the rear vehicle information acquisition unit acquires information on the rear vehicle. And a means for estimating the predetermined rear region probability by applying a predetermined probability map created based on the positional relationship between the vehicle and the host vehicle.

また、この本発明の第1の態様において、所定後方領域確率推定手段は、例えば、後方車両情報取得手段が後方車両に関する情報を取得する範囲のうち、位置関係検出手段により検出された走行車線と自車両の位置関係に基づいて選択された一部に対して、所定の確率マップを適用して、前記所定後方領域確率を推定する手段である。   Further, in the first aspect of the present invention, the predetermined rear region probability estimation unit includes, for example, a travel lane detected by the positional relationship detection unit in a range in which the rear vehicle information acquisition unit acquires information about the rear vehicle. It is means for estimating the predetermined rear region probability by applying a predetermined probability map to a part selected based on the positional relationship of the host vehicle.

また、この本発明の第1の態様において、後方車両情報取得手段は、例えば、位置関係検出手段により検出された走行車線と自車両の位置関係に基づいて、後方車両に関する情報を取得する範囲を変更可能な手段である。   Further, in the first aspect of the present invention, the rear vehicle information acquisition means has a range for acquiring information related to the rear vehicle based on the positional relationship between the traveling lane and the host vehicle detected by the positional relationship detection means, for example. It can be changed.

また、この本発明の第1の態様において、位置関係検出手段は、例えば、車両周辺を撮像する撮像手段を備え、該撮像手段からの画像に基づいて走行車線と自車両の位置関係を検出する手段である。   In the first aspect of the present invention, the positional relationship detection means includes, for example, an imaging means for imaging the periphery of the vehicle, and detects the positional relationship between the traveling lane and the host vehicle based on the image from the imaging means. Means.

また、この本発明の第1の態様は、例えば、車両の操舵角を検出する操舵角検出手段と、車速を検出する車速検出手段と、を備え、所定後方領域確率推定手段は、好ましくは、位置関係検出手段の検出値と、操舵角検出手段により検出された車両の操舵角、及び車速検出手段により検出された車速に基づいて予測した将来の走行車線と自車両の位置関係と、に基づいて所定後方領域確率を推定する手段である。   In addition, the first aspect of the present invention includes, for example, a steering angle detection unit that detects a steering angle of a vehicle, and a vehicle speed detection unit that detects a vehicle speed. Based on the detected value of the positional relationship detecting means, the steering angle of the vehicle detected by the steering angle detecting means, and the positional relationship between the future traveling lane and the own vehicle predicted based on the vehicle speed detected by the vehicle speed detecting means. The means for estimating the predetermined rear region probability.

また、この本発明の第1の態様において、例えば、車両の操舵角を検出する操舵角検出手段と、車速を検出する車速検出手段と、を備え、所定後方領域確率推定手段は、好ましくは、位置関係検出手段の検出値に基づいて前記所定後方領域確率を推定する第1の推定モードと、位置関係検出手段の検出値と、操舵角検出手段により検出された車両の操舵角、及び車速検出手段により検出された車速に基づいて予測した将来の走行車線と自車両の位置関係と、に基づいて所定後方領域確率を推定する第2の推定モードと、を切替え可能な手段である。   In the first aspect of the present invention, for example, the vehicle includes a steering angle detection unit that detects a steering angle of the vehicle and a vehicle speed detection unit that detects a vehicle speed, and the predetermined rear region probability estimation unit preferably includes: First estimation mode for estimating the predetermined rear region probability based on the detection value of the positional relationship detection means, the detection value of the positional relationship detection means, the steering angle of the vehicle detected by the steering angle detection means, and the vehicle speed detection It is a means which can switch between the 2nd estimation mode which estimates the predetermined back area | region probability based on the future driving | running | working lane predicted based on the vehicle speed detected by the means, and the positional relationship of the own vehicle.

また、この本発明の第1の態様において、所定後方領域確率推定手段は、車速検出手段により検出された車速に基づいて、第1の推定モードと第2の推定モードとを切替える手段であってもよく、車速検出手段により検出された車速と、操舵角検出手段により検出された操舵角と、に基づいて第1の推定モードと第2の推定モードとを切替える手段であってもよい。   Further, in the first aspect of the present invention, the predetermined rear region probability estimation means is means for switching between the first estimation mode and the second estimation mode based on the vehicle speed detected by the vehicle speed detection means. Alternatively, it may be a means for switching between the first estimation mode and the second estimation mode based on the vehicle speed detected by the vehicle speed detection means and the steering angle detected by the steering angle detection means.

また、この本発明の第1の態様において、後方車両情報取得手段は、例えば、後方車両の、自車両からの距離、速度、及び方位を検出可能なレーダー装置を含む。   Moreover, in this 1st aspect of this invention, a back vehicle information acquisition means contains the radar apparatus which can detect the distance, speed, and direction of the back vehicle from the own vehicle, for example.

また、この本発明の第1の態様において、位置関係検出手段は、好ましくは、走行車線が不明な領域に仮想走行車線を設定する仮想車線設定手段を備え、走行車線が不明な領域については、該仮想車線設定手段により設定された仮想車線により補完を行なって、走行車線と自車両の位置関係を検出する手段である。   In the first aspect of the present invention, the positional relationship detection means preferably includes virtual lane setting means for setting a virtual travel lane in an area where the travel lane is unknown, and for an area where the travel lane is unknown, It is a means for detecting the positional relationship between the traveling lane and the host vehicle by complementing with the virtual lane set by the virtual lane setting means.

本発明の第2の態様は、本発明の第1の態様の後方車両解析装置を備え、後方車両解析装置が備える所定後方領域確率推定手段により推定された所定後方領域確率に基づいて、後方車両の自車両への衝突に関する予測を行なう、衝突予測装置である。   According to a second aspect of the present invention, there is provided the rear vehicle analysis device according to the first aspect of the present invention, and the rear vehicle is based on the predetermined rear region probability estimated by the predetermined rear region probability estimation means included in the rear vehicle analysis device. It is a collision prediction apparatus which performs the prediction regarding the collision to the own vehicle.

本発明によれば、車両と走行車線の位置関係を考慮して自車両の後方に位置する後方車両の走行経路を適切に解析することが可能な後方車両解析装置を提供すること、及びこれを利用して後方からの衝突を適切に予測することが可能な衝突予測装置を提供することができる。   According to the present invention, it is possible to provide a rear vehicle analysis device capable of appropriately analyzing a travel route of a rear vehicle located behind the host vehicle in consideration of the positional relationship between the vehicle and the travel lane, and It is possible to provide a collision prediction apparatus that can appropriately predict a collision from the rear by using it.

以下、本発明を実施するための最良の形態について、添付図面を参照しながら実施例を挙げて説明する。   Hereinafter, the best mode for carrying out the present invention will be described with reference to the accompanying drawings.

以下、図1〜7を用いて、本発明に係る後方車両解析装置及びこれを利用した衝突予測装置の一実施例について説明する。図1は、衝突予測装置1の全体構成の一例を示す図である。衝突予測装置1は、主要な構成として、車線認識装置(特許請求の範囲における位置関係検出手段に相当する)10と、後方車両情報取得装置20と、衝突予測装置用電子制御ユニット(以下、衝突予測装置用ECUと称する)30と、車速センサー40と、ステアリング角センサー50と、を備える。なお、以下の説明における車両内の機器間の通信は、CAN(Controller Area Network)等の適切なシリアル通信プロトコルを用いて行なわれる。   Hereinafter, an embodiment of a rear vehicle analyzing apparatus according to the present invention and a collision prediction apparatus using the same will be described with reference to FIGS. FIG. 1 is a diagram illustrating an example of the overall configuration of the collision prediction apparatus 1. The collision prediction device 1 has, as main components, a lane recognition device (corresponding to the positional relationship detection means in the claims) 10, a rear vehicle information acquisition device 20, and an electronic control unit for collision prediction device (hereinafter referred to as a collision). 30), a vehicle speed sensor 40, and a steering angle sensor 50. Note that communication between devices in the vehicle in the following description is performed using an appropriate serial communication protocol such as CAN (Controller Area Network).

車線認識装置10は、例えば、ウインドシールド中央上部に配設され、前方カメラ12と、前方カメラ用電子制御ユニット(以下、前方カメラ用ECUと称する)14と、を内蔵する。前方カメラ12は、例えば、CMOSカメラであり、車両前方の斜め下方に向いた光軸を有し、車両の前方数十[m]までの範囲に亘って道路を撮像する。なお、車線認識装置10は、周知の車線維持支援制御(レーンキーピングアシスト)や、車線逸脱警報制御(レーンデパーチャワーニング)に用いられる車線認識用の装置と共用されてよい。   The lane recognition device 10 is disposed, for example, at the upper center of the windshield, and includes a front camera 12 and a front camera electronic control unit (hereinafter referred to as a front camera ECU) 14. The front camera 12 is, for example, a CMOS camera, has an optical axis directed obliquely downward in front of the vehicle, and images a road over a range up to several tens [m] ahead of the vehicle. The lane recognition device 10 may be shared with a known lane recognition device used for lane maintenance assist control (lane keeping assist) and lane departure warning control (lane departure warning).

前方カメラ用ECU14は、例えば、CPUを中心とするコンピューターであり、ROMやRAM等の記憶手段と通信ポートを備える(以下、各種ECUは、同様のハードウエア構成であるものとする)。前方カメラ用ECU14は、前方カメラ12が撮像した画像に基づいて2値化処理や特徴点抽出処理を行うことにより、道路上の道路区画線(白線や黄線、破線、ボッツドッツ等)に該当すると考えられる画素(道路区画線候補点)を選出し、選出した道路区画線候補点のうち直線的に並んだものを道路区画線であると認識する。そして、道路区画線で画成される領域を車線であると認識する。なお、この他にも、種々の手法により道路区画線及び車線を認識することが可能である。例えば、路肩や中央分離帯をパターンマッチング等の手法により検出してこれを加味してもよい。また、道路上において道路区画線が存在しない領域(交差点内等)においては、過去に認識した車線の履歴(RAMに記憶するものとした)等に基づいて仮想車線を設定し、車線の認識を補完している。   The front camera ECU 14 is, for example, a computer centered on a CPU, and includes storage means such as a ROM and a RAM and a communication port (hereinafter, various ECUs have the same hardware configuration). The front camera ECU 14 performs binarization processing and feature point extraction processing based on the image captured by the front camera 12, and thus corresponds to a road marking line (white line, yellow line, broken line, botsdots, etc.) on the road. Possible pixels (road lane line candidate points) are selected, and the straight line among the selected road lane line candidate points is recognized as a road lane line. Then, the area defined by the road lane marking is recognized as a lane. In addition to this, it is possible to recognize road marking lines and lanes by various methods. For example, a road shoulder or a median strip may be detected by a method such as pattern matching, and this may be taken into account. Also, in areas where there are no road lane markings (such as in intersections) on the road, virtual lanes are set based on histories of lanes recognized in the past (stored in RAM), etc., and lane recognition is performed. Complement.

さらに、前方カメラ用ECU14は、上記の如く前方カメラ12からの画像の中で認識した車線と自車両の位置関係を検出する。具体的には、車線端部からの車両中心の変位(以下、オフセットと称する)Xと、車線の延在方向に対する自車両の向き(以下、ヨー角と称する)θを検出し、これを衝突予測装置用ECU30に送信する。図2に、オフセットXとヨー角θを検出する様子の一例を示す。オフセットXは、例えば、画像の左右方向における中心軸Mから、画像下端部における道路区画線(上記の如く設定される仮想車線の端部である場合もある)までの距離x1、x2の差分に所定の計数を乗じることにより計算される。また、ヨー角θは、例えば、画像中で道路区画線(同上)が画像下端線に対して有する角度α、βを、自車両が車線に沿って走行している場合の角度と比較することにより計算される。より具体的には、前方カメラ12の焦点距離や仰角を予め前方カメラ用ECU14のROMに記憶しておき、これらに基づいて計算を行なうものとしてもよいし、距離x1、x2が得られるとオフセットXを導出するマップや、角度α、βが得られるとヨー角θを導出するマップを予め作成し、これを前方カメラ用ECU14のROMに記憶して用いるものとしてもよい。   Further, the front camera ECU 14 detects the positional relationship between the lane recognized in the image from the front camera 12 and the host vehicle as described above. Specifically, the vehicle center displacement X (hereinafter referred to as offset) X from the lane edge and the direction (hereinafter referred to as yaw angle) θ of the host vehicle with respect to the lane extending direction are detected and collided. It transmits to ECU30 for prediction apparatuses. FIG. 2 shows an example of how the offset X and yaw angle θ are detected. The offset X is, for example, the difference between the distances x1 and x2 from the central axis M in the left-right direction of the image to the road lane marking (which may be the end of the virtual lane set as described above) at the lower end of the image. Calculated by multiplying by a predetermined count. In addition, the yaw angle θ is, for example, comparing the angles α and β that the road marking line (same as above) has with respect to the image lower end line in the image with the angle when the host vehicle is traveling along the lane. Is calculated by More specifically, the focal length and elevation angle of the front camera 12 may be stored in advance in the ROM of the front camera ECU 14 and the calculation may be performed based on these, or the offset is obtained when the distances x1 and x2 are obtained. A map for deriving X and a map for deriving the yaw angle θ when the angles α and β are obtained may be created in advance and stored in the ROM of the front camera ECU 14 for use.

後方車両情報取得装置20は、例えば、レーダー装置22と、後方カメラ24と、後方カメラ用電子制御ユニット(以下、後方カメラ用ECUと称する)26と、を備える。   The rear vehicle information acquisition device 20 includes, for example, a radar device 22, a rear camera 24, and a rear camera electronic control unit (hereinafter referred to as a rear camera ECU) 26.

レーダー装置22は、例えば、移動体の自車両からの距離、速度、及び方位を検出することが可能な、ミリ波レーダーである。レーダー装置22は、例えば、車体後端のバンパーやトランクルームの内部等に固設され、車両の略後方に広がる一定の検出範囲にある移動体の距離、速度、及び方位を検出する。   The radar device 22 is, for example, a millimeter wave radar that can detect the distance, speed, and direction of a moving body from the host vehicle. The radar device 22 is fixed, for example, inside a bumper or a trunk room at the rear end of the vehicle body, and detects the distance, speed, and direction of a moving body in a certain detection range extending substantially rearward of the vehicle.

後方カメラ24は、例えば、広角レンズとCCDカメラにより構成される。後方カメラ24は、車体後端のバンパーやナンバープレート上部等に配設され、車両後方の斜め下方に向いた光軸を有し、車両の後方を撮像する。   The rear camera 24 is composed of, for example, a wide angle lens and a CCD camera. The rear camera 24 is disposed on the bumper at the rear end of the vehicle body, the upper part of the license plate, etc., and has an optical axis directed obliquely downward at the rear of the vehicle, and images the rear of the vehicle.

後方カメラ用ECU26は、例えば、CPUを中心とするコンピューターであり、ROMやRAM等の記憶手段を備える。後方カメラ用ECU26は、後方カメラ24が撮像した画像に基づいて2値化処理や特徴点抽出処理を行うことにより、後方車両(自動車や2輪車等)を検出する。なお、後方カメラ24や後方カメラ用ECU26は、周知のバックガイドモニターに用いられる機器と共用されてよい。   The rear camera ECU 26 is, for example, a computer centered on a CPU, and includes storage means such as a ROM and a RAM. The rear camera ECU 26 detects a rear vehicle (automobile, two-wheeled vehicle, etc.) by performing binarization processing and feature point extraction processing based on an image captured by the rear camera 24. The rear camera 24 and the rear camera ECU 26 may be used in common with devices used for known back guide monitors.

後方車両情報取得装置20では、例えば、レーダー装置により検出された移動体のうち、後方カメラ24及び画像処理装置26により車両であると確認されたものの自車両からの距離、速度、及び方位を、後方車両の情報として、衝突予測装置用ECU30に送信する。こうした判別は、後方カメラ用ECU26により行なってもよいし、別個ECU等を設けてもよい。なお、後方車両がレーダー装置22により検出される場合、一点として検出されるのではなく、実際は後方車両の複数の箇所が検出され、検出された箇所の集合が後方車両として認識される。   In the rear vehicle information acquisition device 20, for example, among the moving bodies detected by the radar device, the distance, speed, and direction from the own vehicle of the vehicle that has been confirmed to be a vehicle by the rear camera 24 and the image processing device 26, The information is transmitted to the ECU 30 for the collision prediction device as information on the rear vehicle. Such a determination may be performed by the rear camera ECU 26, or a separate ECU may be provided. When the rear vehicle is detected by the radar device 22, it is not detected as one point, but actually a plurality of locations of the rear vehicle are detected, and a set of detected locations is recognized as the rear vehicle.

衝突予測装置用ECU30は、主要な機能ブロックとして、確率マップ作成部32と、動的補正部34と、衝突予測部36と、を有する。   The collision prediction apparatus ECU 30 includes a probability map creation unit 32, a dynamic correction unit 34, and a collision prediction unit 36 as main functional blocks.

確率マップ作成部32では、車線認識装置10や後方車両情報取得装置20から送信される情報に基づいて、後方車両情報取得装置20により検出された車両が、所定後方領域を走行している確率を求めるための確率マップを設定する。   In the probability map creation unit 32, the probability that the vehicle detected by the rear vehicle information acquisition device 20 is traveling in a predetermined rear region based on information transmitted from the lane recognition device 10 or the rear vehicle information acquisition device 20 is determined. Set a probability map to find.

所定後方領域は、後方からの衝突を予測する過程において用いられる概念であり、そのまま走行すると自車両に衝突すると考えられる走行経路を意味する。本実施例では、所定後方領域は、自車両の車両後端の中央部から車線に沿って車両の後方に延びる直線を中心として、一般的な道路幅と同程度の幅(例えば、3.5[m]等)を有する領域である。   The predetermined rear region is a concept used in the process of predicting a collision from the rear, and means a traveling route that is considered to collide with the host vehicle when traveling as it is. In the present embodiment, the predetermined rear region has a width approximately equal to a general road width (for example, 3.5) centering on a straight line extending from the center of the rear end of the host vehicle to the rear of the vehicle along the lane. [M] etc.).

但し、所定後方領域内で車両を検出したとしても、車線変更に伴って一時的に通過した場合等、所定後方領域を走行しているとは言えない場合が存在する。又、上記の如く、後方車両は、レーダー装置22により一点として検出されるのではなく、複数の箇所が検出されるため、例えば、後方車両の端部における一点が所定後方領域内で検出されるような場合も想定される。   However, even if a vehicle is detected in the predetermined rear area, there may be cases where it cannot be said that the vehicle is traveling in the predetermined rear area, such as when the vehicle has temporarily passed along with a lane change. Further, as described above, the rear vehicle is not detected as one point by the radar device 22, but a plurality of locations are detected. For example, one point at the end of the rear vehicle is detected within a predetermined rear region. Such a case is also assumed.

そこで、その位置で後方車両(その一部である場合を含む)が検出されると、所定後方領域を走行しているといえることの確からしさを求めるための、確率マップを以下の如くに作成している。   Therefore, if a rear vehicle (including a part of it) is detected at that position, a probability map is created as follows to determine the certainty that it can be said that the vehicle is traveling in a predetermined rear region. is doing.

図3は、基準となる確率マップ(以下、基準マップと称する)の一例を示す図である。車線の中央を車線に沿って走行している場合は、この基準マップを車両の後方に向けた領域に対して適用すればよい。しかしながら、自車両が車線に対してヨー角θをもっている場合に、車両の後方に向けて基準マップを適用すると、図4(A)に示す如く、確率の分布が車線に対して斜めに広がることとなる。一方、自車両が車線に対してオフセットXをもっている場合に、車線を基準に確率マップを適用すると、図4(B)に示す如く、所定後方領域と確率の分布が車線幅方向にずれを生じたりすることとなる。従って、いずれの場合にも、そのまま走行すると自車両に衝突すると考えられる車両を適切に検出することができない。   FIG. 3 is a diagram illustrating an example of a reference probability map (hereinafter referred to as a reference map). When the vehicle is traveling in the center of the lane along the lane, this reference map may be applied to the area facing the rear of the vehicle. However, when the host vehicle has a yaw angle θ with respect to the lane and the reference map is applied toward the rear of the vehicle, the probability distribution spreads obliquely with respect to the lane as shown in FIG. It becomes. On the other hand, when the own vehicle has an offset X with respect to the lane and the probability map is applied with reference to the lane, the distribution of the probability of the predetermined rear region and the probability is shifted in the lane width direction as shown in FIG. Will be. Therefore, in any case, it is not possible to appropriately detect a vehicle that is considered to collide with the host vehicle when traveling as it is.

そこで、本発明の衝突予測装置1では、ヨー角θや調整後オフセットX´(車両後端の中央部における車線の端部からの変位であり、前述のオフセットXに対して、車両の長さの半分にsinθを乗じたものを加減して求めることができる)を考慮して、確率マップを作成している。図5(A)は、ヨー角θを考慮して変更(シフト)後、作成された確率マップであり、図5(B)は、更に調整後オフセットX´を考慮して変更(シフト)後、作成された確率マップである。   Therefore, in the collision prediction apparatus 1 of the present invention, the yaw angle θ and the adjusted offset X ′ (the displacement from the end of the lane at the center of the rear end of the vehicle, the length of the vehicle with respect to the offset X described above. The probability map is created in consideration of the fact that it can be obtained by adding or subtracting one half multiplied by sin θ. FIG. 5A is a probability map created after changing (shifting) in consideration of the yaw angle θ, and FIG. 5B is after changing (shifting) in consideration of the adjusted offset X ′. This is a created probability map.

図6は、このように作成された確率マップを用いた場合の、確率の分布を示す図である。図示するように、確率マップは、所定後方領域に沿ったものとなっている。これにより、そのまま走行すると自車両に後方から衝突すると考えられる車両を、適切に検出することができる。なお、レーダー装置22や後方カメラ24の検出範囲自体を機械的に可変させることによっても同様の効果を得ることができるが、本実施例の如く、検出範囲をそのまま用いると共に確率マップをソフトウエア的に変更する態様をとる場合、レーダー装置22や後方カメラ24の検出範囲を機械的に可変させるためのアクチュエーター等を備える必要がないため、装置の大型化を抑制することができる。   FIG. 6 is a diagram showing a probability distribution when the probability map created in this way is used. As shown in the figure, the probability map is along a predetermined rear region. Accordingly, it is possible to appropriately detect a vehicle that is considered to collide with the host vehicle from behind when traveling as it is. The same effect can be obtained by mechanically changing the detection ranges of the radar device 22 and the rear camera 24. However, as in this embodiment, the detection range is used as it is and the probability map is used as a software. Therefore, since it is not necessary to provide an actuator or the like for mechanically changing the detection range of the radar device 22 or the rear camera 24, the size of the device can be suppressed.

なお、レーダー装置22を車両後端の中央部に配設し、レーダー装置22の位置を基準(中心)として所定後方領域を設定する場合は、オフセットX分の変更は考慮しなくともよい。   When the radar device 22 is arranged at the center of the rear end of the vehicle and the predetermined rear region is set with the position of the radar device 22 as a reference (center), the change for the offset X need not be considered.

動的補正部34は、後述する所定の条件が成立した場合に、車線認識装置10により検出されたオフセットX及びヨー角θに加えて、車速センサー40により検出された車速Vとステアリング角センサー50により検出されたステアリング角Sを考慮して、オフセットX及びヨー角θを補正する。具体的には、車線認識装置10により検出されたオフセットX及びヨー角θを基に、車速Vやステアリング角Sに基づいて直後(近い将来)のオフセットX及びヨー角θを予測し、これを用いて前述した確率マップを作成する。   The dynamic correction unit 34, in addition to the offset X and the yaw angle θ detected by the lane recognition device 10 when a predetermined condition described later is satisfied, the vehicle speed V and the steering angle sensor 50 detected by the vehicle speed sensor 40. The offset X and the yaw angle θ are corrected in consideration of the steering angle S detected by. Specifically, on the basis of the offset X and the yaw angle θ detected by the lane recognition device 10, the offset X and the yaw angle θ immediately after (near future) are predicted based on the vehicle speed V and the steering angle S, To create the probability map described above.

衝突予測部36では、確率マップ作成部32により設定された確率マップを基に、検出された後方車両が所定後方領域を走行している確率、及び、後方車両の自車両からの距離、速度、方位の履歴に基づいて、後方車両が自車両に衝突するか否かを予測する。なお、この予測は択一的なものに限られず、例えば衝突確率を出力するようなものでもよい。   In the collision prediction unit 36, based on the probability map set by the probability map creation unit 32, the probability that the detected rear vehicle is traveling in a predetermined rear region, the distance from the host vehicle of the rear vehicle, the speed, Based on the azimuth history, it is predicted whether or not the rear vehicle collides with the host vehicle. Note that this prediction is not limited to an alternative, and may be one that outputs a collision probability, for example.

以下、衝突予測装置1の動作について説明する。図7は、衝突予測装置用ECU30が実行する特徴的な処理の流れを示すフローチャートである。   Hereinafter, the operation of the collision prediction apparatus 1 will be described. FIG. 7 is a flowchart showing a flow of characteristic processing executed by the ECU 30 for collision prediction device.

まず、衝突予測装置用ECU30は、車線認識装置10からオフセットX及びヨー角θを、車速センサー40から車速Vを、ステアリング角センサー50からステアリング角Sを、それぞれ入力する(S100)。   First, the collision prediction device ECU 30 inputs the offset X and yaw angle θ from the lane recognition device 10, the vehicle speed V from the vehicle speed sensor 40, and the steering angle S from the steering angle sensor 50 (S100).

次に、車速Vが閾値V1未満であり、且つステアリング角Sが閾値S1以上であるか否かを判定する(S110)。この判定は、例えば交差点で右折待ち停車をしている際等、発進に伴って自車両のヨー角が大きくなって車線を離脱するような状況か否かを判別するものである。こうした状況から自車両が発進すると、ヨー角θやオフセットXが急変するため、動的補正を行なうべく所定停車フラグを変更する。所定停車フラグは、動的補正を行なうか否かを判断するためのものであり、初期値として0が設定されている。閾値V1は停車状態であるか否かを判断するための小さい値(例えば、1〜30[km/h]等)である。また、閾値S1は、右折や左折を行なう前になされる程度のステアリング操作に応じた値に定められる。   Next, it is determined whether the vehicle speed V is less than the threshold value V1 and the steering angle S is greater than or equal to the threshold value S1 (S110). This determination is performed to determine whether or not the vehicle is in a situation where the yaw angle of the host vehicle increases and the vehicle leaves the lane, for example, when the vehicle is waiting for a right turn at an intersection. When the host vehicle starts from such a situation, the yaw angle θ and the offset X change suddenly, so the predetermined stop flag is changed to perform dynamic correction. The predetermined stop flag is used to determine whether or not to perform dynamic correction, and 0 is set as an initial value. The threshold value V1 is a small value (for example, 1 to 30 [km / h] or the like) for determining whether or not the vehicle is stopped. Further, the threshold value S1 is set to a value corresponding to the steering operation that is performed before making a right turn or a left turn.

車速Vが閾値V1未満であり、且つステアリング角Sが閾値S1以上である場合には、所定停車フラグに1を設定する(S120)。   If the vehicle speed V is less than the threshold value V1 and the steering angle S is greater than or equal to the threshold value S1, 1 is set to the predetermined stop flag (S120).

続いて、動的補正の終了条件として、自車両が右折や左折に伴って車線を逸脱したか、又は車速Vが閾値V2以上となったか否かを判定する(S130)。これらのうちいずれか一方を満たした場合は、所定停車フラグに0を設定する(S140)。   Subsequently, as an end condition for the dynamic correction, it is determined whether the host vehicle has deviated from the lane due to a right turn or a left turn, or whether the vehicle speed V is equal to or higher than the threshold value V2 (S130). If any one of these is satisfied, 0 is set to the predetermined stop flag (S140).

そして、所定停車フラグが1であり、且つ車速VがV1以上であるか否かを判定する(S150)。   Then, it is determined whether or not the predetermined stop flag is 1 and the vehicle speed V is equal to or higher than V1 (S150).

S150において否定的な判定を得た場合は、動的補正を行なわず、車線認識装置10の検出値に基づいて確率マップを作成する(S160)。   If a negative determination is obtained in S150, the probability map is created based on the detection value of the lane recognition device 10 without performing dynamic correction (S160).

確率マップの作成は、例えば、基準マップに対して、周知の回転行列の逆行列を用いると共に、調整後オフセットX´を加味して、次式(1)の如く行なわれる。ここで、Rxは、自車両の中心を車線幅方向に移動させた結果車線の中央と交差する点である基準点からのx方向の変位(車線幅方向の変位)を、Ryは、上記基準点からのy方向の変位(車線長手方向に沿った変位)を、それぞれ表す。また、M(Rx,Ry)は、座標(Rx,Ry)に対して基準マップを適用して導出される確率を表し、M´(Rx,Ry)は、調整後オフセットX´やヨー角θを用いて変更されたマップを用いて、座標(Rx,Ry)から導出される確率を表す。   The creation of the probability map is performed, for example, using the known inverse matrix of the rotation matrix and the adjusted offset X ′ with respect to the reference map as shown in the following equation (1). Here, Rx is the displacement in the x direction (displacement in the lane width direction) from the reference point that is the point that intersects the center of the lane as a result of moving the center of the host vehicle in the lane width direction, and Ry is the above reference The displacement in the y direction from the point (displacement along the lane longitudinal direction) is represented respectively. M (Rx, Ry) represents the probability derived by applying the reference map to the coordinates (Rx, Ry), and M ′ (Rx, Ry) represents the adjusted offset X ′ and the yaw angle θ. Represents the probability derived from the coordinates (Rx, Ry) using the map modified using.

M´(Rx,Ry)=M(Rx・cos(−θ)−Ry・sin(−θ)−X´,Rx・sin(−θ)+Ry・cos(−θ)) ‥(1)   M ′ (Rx, Ry) = M (Rx · cos (−θ) −Ry · sin (−θ) −X ′, Rx · sin (−θ) + Ry · cos (−θ)) (1)

そして、後方車両における上記基準点からの変位(Px,Py)に対して上記の確率マップを適用して、後方車両が所定後方領域を走行している確率を導出する。なお、この結果は、次式(2)の如くに表すこともできる。従って、確率マップを作成せずに、式(2)を直接適用して確率を導出するものとしてもよい。ここで、Pは後方車両と基準点との距離である。   Then, the probability map is applied to the displacement (Px, Py) from the reference point in the rear vehicle to derive the probability that the rear vehicle is traveling in the predetermined rear region. This result can also be expressed as the following equation (2). Therefore, the probability may be derived by directly applying Equation (2) without creating a probability map. Here, P is the distance between the rear vehicle and the reference point.

M´(Px,Py)=M(Psin(φ−θ)−X´,Pcos(φ−θ)) ‥(2)
(但し、tanφ=Px/Py)
M ′ (Px, Py) = M (Psin (φ−θ) −X ′, Pcos (φ−θ)) (2)
(However, tanφ = Px / Py)

なお、前述した如く、レーダー装置22を車両後端の中央部に配設し、レーダー装置22の位置を基準(中心)として所定後方領域を設定する場合は、オフセットXや調整後オフセットX´分の変更は考慮しなくともよい。従って、上記式(1)、(2)の適用において、RxやPxは、自車両からのx方向の変位を、RyやPyは、自車両からのy方向の変位を、それぞれ表すものとし、両式はX´の部分を削除したものによって置換すればよい。後述するS180の処理においても同様である。   As described above, when the radar device 22 is disposed at the center of the rear end of the vehicle and the predetermined rear region is set with the position of the radar device 22 as a reference (center), the offset X and the adjusted offset X ′ are set. This change need not be considered. Accordingly, in the application of the above formulas (1) and (2), Rx and Px represent the displacement in the x direction from the host vehicle, and Ry and Py represent the displacement in the y direction from the host vehicle, respectively. Both formulas may be replaced with those obtained by deleting the X ′ portion. The same applies to the processing of S180 described later.

S150において肯定的な判定を得た場合は、車速Vとステアリング角Sに基づいて時間T後のオフセットXやヨー角θを予測し(S170)、この予測値に上記式(1)を適用して、確率マップを作成する(S180)。すなわち、動的補正を行なう。時間Tは、例えば0コンマ数[sec]〜数[sec]程度の時間である。動的補正は、具体的には、車速Vとステアリング角Sが与えられるとオフセットやヨー角の変化分を導出するマップを予め記憶しておき、これを用いて得られた上記変化分を、現在認識されているオフセットXやヨー角θに加算して行なう。また、より正確さを期すために、所定時間(周期)毎に、車線認識装置10の検出値と比較検証し、検出値との偏差が大きい場合には検出値側に再補正してもよい。   If a positive determination is obtained in S150, the offset X and yaw angle θ after time T are predicted based on the vehicle speed V and the steering angle S (S170), and the above equation (1) is applied to this predicted value. Then, a probability map is created (S180). That is, dynamic correction is performed. The time T is, for example, a time of about 0 comma number [sec] to several [sec]. Specifically, in the dynamic correction, when a vehicle speed V and a steering angle S are given, a map for deriving a change amount of an offset or a yaw angle is stored in advance, and the change amount obtained by using this is calculated as follows: This is performed by adding to the currently recognized offset X and yaw angle θ. Further, for the sake of more accuracy, it may be compared and verified with the detection value of the lane recognition device 10 every predetermined time (cycle), and if the deviation from the detection value is large, it may be corrected again to the detection value side. .

動的補正は、前述の如く、自車両が停車して(V<V1)ステアリング角Sが所定角(S1)以上切られた状態において、自車両が発進した際(V≧V1)に開始され、車速VがV2以上となるか又は右左折して車線を離脱すると終了される(S110〜S150)。このような状況では、オフセットXやヨー角θが比較的早く変化するため、前方カメラ12の画像を処理してオフセットXやヨー角θを計算する処理の速度が変化に十分に対応できない場合が生じる。一方、一般的に車速Vやステアリング角Sの検出速度は上記画像処理に比して早いものであるから、オフセットXやヨー角θが比較的早く変化する状況にも迅速に対応することができる。   As described above, the dynamic correction is started when the host vehicle starts (V ≧ V1) in a state where the host vehicle stops (V <V1) and the steering angle S is cut by a predetermined angle (S1) or more. When the vehicle speed V becomes V2 or higher or turns right and left and leaves the lane, the process ends (S110 to S150). In such a situation, since the offset X and the yaw angle θ change relatively quickly, the processing speed of processing the image of the front camera 12 and calculating the offset X and the yaw angle θ may not be sufficient to cope with the change. Arise. On the other hand, since the detection speed of the vehicle speed V and the steering angle S is generally faster than that of the image processing, it is possible to quickly cope with a situation where the offset X and the yaw angle θ change relatively quickly. .

S160又はS180の処理により確率マップを作成すると、これに基づいて所定後方領域確率を導出する(S190)。   When a probability map is created by the processing of S160 or S180, a predetermined rear region probability is derived based on the probability map (S190).

そして、所定後方領域確率に基づいて、後方車両の自車両への衝突に関する予測を行なう(S200)。この予測は、例えば、衝突するか否かを予測するものであってもよいし、衝突可能性を算出するものであってもよい。具体的には、例えば、所定後方領域確率に、後方車両の自車両との距離、速度、及び方位の履歴の関数として求められる所定係数を乗じることにより行なうことができる。前述の如く、所定後方領域を後方車両が走行している所定後方領域確率を適切に求めることができるため、衝突に関する予測についても、より適切に行なうことができる。   Then, based on the predetermined rear region probability, prediction regarding the collision of the rear vehicle with the host vehicle is performed (S200). This prediction may predict, for example, whether or not to collide, or may calculate the possibility of collision. Specifically, for example, it can be performed by multiplying a predetermined rear region probability by a predetermined coefficient obtained as a function of the distance, speed, and direction history of the vehicle behind the host vehicle. As described above, since the predetermined rear region probability that the vehicle behind the vehicle is traveling in the predetermined rear region can be obtained appropriately, the prediction regarding the collision can be performed more appropriately.

後方車両の自車両への衝突に関する予測を行なうと、この予測に基づいて種々の制御を行なうことが可能である。例えば、ステアリング装置のアシストモータを駆動してステアリング角を変更したり、乗員に衝突警報を発したりする等が考えられる。但し、この制御については本発明の中核をなさないので、詳細な説明は省略する。   When the prediction about the collision of the rear vehicle with the own vehicle is performed, various controls can be performed based on the prediction. For example, driving the assist motor of the steering device to change the steering angle or issuing a collision warning to the occupant can be considered. However, since this control does not form the core of the present invention, a detailed description is omitted.

このように、本実施例に係る衝突予測装置1によれば、オフセットXやヨー角θを用いて確率マップを作成するから、確率マップが所定後方領域に合致したものとなり、そのまま走行すると自車両に後方から衝突する走行経路を走行している車両を、適切に検出することができる。また、レーダー装置22や後方カメラ24の検出範囲自体を機械的に可変させるものに比して、装置の大型化を抑制することができる。   Thus, according to the collision prediction apparatus 1 according to the present embodiment, since the probability map is created using the offset X and the yaw angle θ, the probability map matches the predetermined rear region, and when the vehicle travels as it is, the own vehicle It is possible to appropriately detect a vehicle traveling on a traveling path that collides with the vehicle from behind. In addition, it is possible to suppress an increase in the size of the device as compared with a device in which the detection range of the radar device 22 and the rear camera 24 is mechanically variable.

さらに、オフセットXやヨー角θが比較的早く変化する状況では、より早い速度で検出可能な車速Vやステアリング角Sを用いて動的補正を行なうから、オフセットXやヨー角θが比較的早く変化する状況にも迅速に対応することができる。   Further, in a situation where the offset X and the yaw angle θ change relatively quickly, the offset X and the yaw angle θ are relatively fast because dynamic correction is performed using the vehicle speed V and the steering angle S that can be detected at a faster speed. It can respond quickly to changing conditions.

また、上記の如く所定後方領域確率を適切に求めることができるため、衝突に関する予測についても、より適切に行なうことができる。   In addition, since the predetermined rear region probability can be appropriately obtained as described above, the prediction regarding the collision can be performed more appropriately.

なお、本実施例に係る衝突予測装置1の構成のうち、車線認識装置10と、後方車両情報取得装置20と、衝突予測装置用ECU30の機能ブロックのうち確率マップ作成部32とが、本発明の後方車両解析装置を構成する。   In the configuration of the collision prediction device 1 according to the present embodiment, the lane recognition device 10, the rear vehicle information acquisition device 20, and the probability map creation unit 32 among the functional blocks of the collision prediction device ECU 30 are the present invention. The rear vehicle analysis apparatus is configured.

以上、本発明を実施するための最良の形態について一実施例を用いて説明したが、本発明はこうした一実施例に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において、上述した一実施例に種々の変形及び置換を加えることができる。   As mentioned above, although the best mode for carrying out the present invention has been described using one embodiment, the present invention is not limited to such one embodiment, and within the scope not departing from the gist of the present invention, Various modifications and substitutions can be made to the above-described embodiment.

例えば、基準マップの形状については、実施例で例示したものに限られず、任意に設定することができる。   For example, the shape of the reference map is not limited to that illustrated in the embodiment, and can be arbitrarily set.

また、所定後方領域の定義についても、任意に変更が可能である。例えば、自車両の後方にかけて徐々に幅が減少する領域であってもよいし、自車両の後方にかけて徐々に幅が拡大する領域であってもよい。この変更に応じて基準マップを変更してもよい。   Also, the definition of the predetermined rear region can be arbitrarily changed. For example, a region where the width gradually decreases toward the rear of the host vehicle or a region where the width gradually increases toward the rear of the host vehicle may be used. The reference map may be changed according to this change.

また、オフセットXやヨー角θに基づいて確率マップを作成するものとしたが、検出範囲のうちオフセットXやヨー角θに基づいて選択された部分について前述の基準マップ、を適用し、所定領域確率を求めてもよい。   In addition, the probability map is created based on the offset X and the yaw angle θ. However, the above-described reference map is applied to a portion selected based on the offset X and the yaw angle θ in the detection range, and the predetermined region is set. The probability may be obtained.

また、後方車両情報取得装置20は、レーダー装置22と、後方カメラ24及び後方カメラ用ECU26とを備えるものとして例示したが、いずれか一方により後方車両に関する情報を取得するものとしてもよい。   Moreover, although the back vehicle information acquisition apparatus 20 was illustrated as a thing provided with the radar apparatus 22, the back camera 24, and ECU26 for back cameras, it is good also as what acquires the information regarding a back vehicle by either one.

また、車線認識装置10は、前方カメラ12からの画像に基づいて車線と自車両の位置関係を検出するものとしたが、道路側に設置されたレーダー装置等のインフラにより検出された情報を通信により取得してもよい。   The lane recognition device 10 detects the positional relationship between the lane and the host vehicle based on the image from the front camera 12, but communicates information detected by an infrastructure such as a radar device installed on the road side. You may acquire by.

また、S160の処理は、後方車両における基準点からの(前述した如く、オフセットXを考慮しない場合は、自車両からの)変位(Px,Py)自体を、周知の回転行列により回転させると共に修正後オフセットX´分調整した調整後座標(Px´,Py´)を求め、これに基準マップを適用して、確率を導出してもよい。   Further, the process of S160 rotates and corrects the displacement (Px, Py) itself from the reference point in the rear vehicle (from the own vehicle when the offset X is not considered as described above) by a known rotation matrix. The adjusted coordinates (Px ′, Py ′) adjusted by the post-offset X ′ may be obtained, and the probability may be derived by applying a reference map to the coordinates.

また、動的補正の開始及び終了条件は、実施例のものに限られず、如何なる条件で動的補正の開始及び終了を行なってもよい。また、動的補正を行なわないものとしてもよく、常時行なうものとしてもよい。さらに、車線認識装置10の検出値を、動的補正を用いて常時比較検証するものとしてもよい。   The start and end conditions of dynamic correction are not limited to those in the embodiment, and the start and end of dynamic correction may be performed under any conditions. Further, dynamic correction may not be performed, or it may be performed constantly. Furthermore, the detection value of the lane recognition device 10 may be constantly compared and verified using dynamic correction.

また、動的補正は、ステアリング角センサーにより検出されるステアリング角Sに代えて、ヨーレートセンサーにより検出されるヨー方向の加速度を積分することにより行なってもよい。   The dynamic correction may be performed by integrating the acceleration in the yaw direction detected by the yaw rate sensor instead of the steering angle S detected by the steering angle sensor.

本発明は、少なくとも後方からの車両を検出して制御を行なう装置に利用できる。搭載される車両の外観、重量、サイズ、走行性能等は問わない。   The present invention can be used for an apparatus that detects and controls a vehicle from at least the rear. The appearance, weight, size, running performance, etc. of the vehicle to be mounted are not limited.

本発明の一実施例に係る衝突予測装置1の全体構成の一例を示す図である。It is a figure which shows an example of the whole structure of the collision prediction apparatus 1 which concerns on one Example of this invention. オフセットXとヨー角θを検出する様子の一例を示す図である。It is a figure which shows an example of a mode that the offset X and yaw angle (theta) are detected. 基準マップの一例を示す図である。It is a figure which shows an example of a reference | standard map. 自車両が車線に対してオフセットXやヨー角θをもっているときに、基準マップを適用した場合の、確率の分布を示す図である。It is a figure which shows distribution of a probability at the time of applying a reference | standard map, when the own vehicle has offset X and yaw angle (theta) with respect to a lane. ヨー角θやオフセットXを考慮して変更後、作成された確率マップを示す図である。It is a figure which shows the probability map produced after changing considering the yaw angle (theta) and the offset X. FIG. ヨー角θやオフセットXを考慮して変更後、作成された確率マップを用いた場合の、確率の分布を示す図である。It is a figure which shows distribution of probability at the time of using the created probability map after changing in consideration of the yaw angle θ and the offset X. 衝突予測装置用ECU30が実行する特徴的な処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the characteristic process which ECU30 for collision prediction apparatuses performs.

符号の説明Explanation of symbols

1 衝突予測装置
10 車線認識装置
12 前方カメラ
14 前方カメラ用電子制御ユニット
20 後方車両情報取得装置
22 レーダー装置
24 後方カメラ
26 後方カメラ用電子制御ユニット
30 衝突予測装置用電子制御ユニット
32 確率マップ作成部
34 動的補正部
36 衝突予測部
40 車速センサー
50 ステアリング角センサー
DESCRIPTION OF SYMBOLS 1 Collision prediction apparatus 10 Lane recognition apparatus 12 Front camera 14 Front camera electronic control unit 20 Rear vehicle information acquisition apparatus 22 Radar apparatus 24 Rear camera 26 Rear camera electronic control unit 30 Collision prediction apparatus electronic control unit 32 Probability map creation unit 34 Dynamic correction part 36 Collision prediction part 40 Vehicle speed sensor 50 Steering angle sensor

Claims (14)

自車両の後方に位置する後方車両の走行経路を解析する後方車両解析装置であって、
走行車線と自車両の位置関係を検出する位置関係検出手段と、
前記後方車両に関する情報を取得する後方車両情報取得手段と、
前記位置関係検出手段により検出された走行車線と自車両の位置関係、及び、前記後方車両情報取得手段により取得された後方車両に関する情報、に基づいて、該後方車両が自車両の後方に延在する所定後方領域を走行している確率を所定後方領域確率として推定する、所定後方領域確率推定手段と、
を備えることを特徴とする、後方車両解析装置。
A rear vehicle analysis device for analyzing a travel route of a rear vehicle located behind the host vehicle,
Positional relationship detection means for detecting the positional relationship between the traveling lane and the host vehicle;
Back vehicle information acquisition means for acquiring information about the back vehicle;
Based on the positional relationship between the traveling lane detected by the positional relationship detection means and the host vehicle, and information on the rear vehicle acquired by the rear vehicle information acquisition unit, the rear vehicle extends behind the host vehicle. A predetermined rear area probability estimating means for estimating a probability of traveling in a predetermined rear area as a predetermined rear area probability;
A rear vehicle analysis device comprising:
請求項1に記載の後方車両解析装置であって、
前記所定後方領域は、車両後端の車両幅方向に関する中央部から走行車線に沿って車両の後方に延びる直線、を中心として走行車線に沿って延在する領域である、
後方車両解析装置。
The rear vehicle analysis device according to claim 1,
The predetermined rear region is a region extending along the traveling lane centering on a straight line extending rearward of the vehicle along the traveling lane from the central portion in the vehicle width direction at the rear end of the vehicle.
Rear vehicle analysis device.
請求項1又は2に記載の後方車両解析装置であって、
前記位置関係検出手段は、走行車線に対する自車両のヨー角、及び、自車両の走行車線幅方向における変位、を走行車線と自車両の位置関係として検出する手段である、
後方車両解析装置。
The rear vehicle analysis device according to claim 1 or 2,
The positional relationship detection means is means for detecting the yaw angle of the host vehicle with respect to the traveling lane and the displacement of the host vehicle in the traveling lane width direction as the positional relationship between the traveling lane and the host vehicle.
Rear vehicle analysis device.
請求項1ないし3のいずれかに記載の後方車両解析装置であって、
前記所定後方領域確率推定手段は、前記後方車両情報取得手段が後方車両に関する情報を取得する範囲に対して、前記位置関係検出手段により検出された走行車線と自車両の位置関係に基づいて作成される所定の確率マップを適用して、前記所定後方領域確率を推定する手段である、
後方車両解析装置。
The rear vehicle analysis device according to any one of claims 1 to 3,
The predetermined rear region probability estimation unit is created based on the positional relationship between the traveling lane and the own vehicle detected by the positional relationship detection unit with respect to a range in which the rear vehicle information acquisition unit acquires information on the rear vehicle. Applying a predetermined probability map to estimate the predetermined rear region probability,
Rear vehicle analysis device.
請求項1ないし3のいずれかに記載の後方車両解析装置であって、
前記所定後方領域確率推定手段は、前記後方車両情報取得手段が後方車両に関する情報を取得する範囲のうち、前記位置関係検出手段により検出された走行車線と自車両の位置関係に基づいて選択された一部に対して、所定の確率マップを適用して、前記所定後方領域確率を推定する手段である、
後方車両解析装置。
The rear vehicle analysis device according to any one of claims 1 to 3,
The predetermined rear region probability estimation unit is selected based on a positional relationship between the traveling lane and the own vehicle detected by the positional relationship detection unit in a range in which the rear vehicle information acquisition unit acquires information on the rear vehicle. A means for applying a predetermined probability map to a part and estimating the predetermined backward region probability.
Rear vehicle analysis device.
請求項1ないし3のいずれかに記載の後方車両解析装置であって、
前記後方車両情報取得手段は、前記位置関係検出手段により検出された走行車線と自車両の位置関係に基づいて、後方車両に関する情報を取得する範囲を変更可能な手段である、
後方車両解析装置。
The rear vehicle analysis device according to any one of claims 1 to 3,
The rear vehicle information acquisition unit is a unit capable of changing a range for acquiring information on the rear vehicle based on the positional relationship between the traveling lane and the host vehicle detected by the positional relationship detection unit.
Rear vehicle analysis device.
請求項1ないし6のいずれかに記載の後方車両解析装置であって、
前記位置関係検出手段は、車両周辺を撮像する撮像手段を備え、該撮像手段からの画像に基づいて走行車線と自車両の位置関係を検出する手段である、
後方車両解析装置。
The rear vehicle analysis device according to any one of claims 1 to 6,
The positional relationship detection means includes imaging means for imaging the periphery of the vehicle, and is means for detecting the positional relationship between the traveling lane and the host vehicle based on an image from the imaging means.
Rear vehicle analysis device.
請求項1ないし7のいずれかに記載の後方車両解析装置であって、
車両の操舵角を検出する操舵角検出手段と、車速を検出する車速検出手段と、を備え、
前記所定後方領域確率推定手段は、前記位置関係検出手段の検出値と、前記操舵角検出手段により検出された車両の操舵角、及び前記車速検出手段により検出された車速に基づいて予測した将来の走行車線と自車両の位置関係と、に基づいて前記所定後方領域確率を推定する手段である、
後方車両解析装置。
The rear vehicle analysis device according to any one of claims 1 to 7,
Steering angle detection means for detecting the steering angle of the vehicle, and vehicle speed detection means for detecting the vehicle speed,
The predetermined rear region probability estimation means is a future predicted based on the detected value of the positional relationship detection means, the steering angle of the vehicle detected by the steering angle detection means, and the vehicle speed detected by the vehicle speed detection means. A means for estimating the predetermined rear region probability based on a positional relationship between the traveling lane and the host vehicle;
Rear vehicle analysis device.
請求項1ないし7のいずれかに記載の後方車両解析装置であって、
車両の操舵角を検出する操舵角検出手段と、車速を検出する車速検出手段と、を備え、
前記所定後方領域確率推定手段は、
前記位置関係検出手段の検出値に基づいて前記所定後方領域確率を推定する第1の推定モードと、
前記位置関係検出手段の検出値と、前記操舵角検出手段により検出された車両の操舵角、及び前記車速検出手段により検出された車速に基づいて予測した将来の走行車線と自車両の位置関係と、に基づいて前記所定後方領域確率を推定する第2の推定モードと、
を切替え可能な手段である、後方車両解析装置。
The rear vehicle analysis device according to any one of claims 1 to 7,
Steering angle detection means for detecting the steering angle of the vehicle, and vehicle speed detection means for detecting the vehicle speed,
The predetermined backward region probability estimation means is
A first estimation mode for estimating the predetermined rear region probability based on a detection value of the positional relationship detection means;
The positional relationship between the detected value of the positional relationship detecting means, the steering angle of the vehicle detected by the steering angle detecting means, and the future traveling lane and the own vehicle predicted based on the vehicle speed detected by the vehicle speed detecting means. A second estimation mode for estimating the predetermined rear region probability based on
The vehicle analysis apparatus which is a means which can be switched.
請求項9に記載の後方車両解析装置であって、
前記所定後方領域確率推定手段は、前記車速検出手段により検出された車速に基づいて、前記第1の推定モードと前記第2の推定モードとを切替える手段である、
後方車両解析装置。
The rear vehicle analysis device according to claim 9,
The predetermined rear region probability estimation means is means for switching between the first estimation mode and the second estimation mode based on the vehicle speed detected by the vehicle speed detection means.
Rear vehicle analysis device.
請求項9に記載の後方車両解析装置であって、
前記所定後方領域確率推定手段は、前記車速検出手段により検出された車速と、前記操舵角検出手段により検出された操舵角と、に基づいて前記第1の推定モードと前記第2の推定モードとを切替える手段である、
後方車両解析装置。
The rear vehicle analysis device according to claim 9,
The predetermined rear region probability estimation means includes the first estimation mode and the second estimation mode based on the vehicle speed detected by the vehicle speed detection means and the steering angle detected by the steering angle detection means. Is a means of switching
Rear vehicle analysis device.
請求項1ないし11のいずれかに記載の後方車両解析装置であって、
前記後方車両情報取得手段は、前記後方車両の、自車両からの距離、速度、及び方位を検出可能なレーダー装置を含む、
後方車両解析装置。
The rear vehicle analysis device according to any one of claims 1 to 11 ,
The rear vehicle information acquisition means includes a radar device capable of detecting the distance, speed, and direction of the rear vehicle from the host vehicle.
Rear vehicle analysis device.
請求項1ないし12のいずれかに記載の後方車両解析装置であって、
前記位置関係検出手段は、走行車線が不明な領域に仮想走行車線を設定する仮想車線設定手段を備え、走行車線が不明な領域については、該仮想車線設定手段により設定された仮想車線により補完を行なって、走行車線と自車両の位置関係を検出する手段である、
後方車両解析装置。
The rear vehicle analysis device according to any one of claims 1 to 12,
The positional relationship detection means includes virtual lane setting means for setting a virtual lane in an area where the travel lane is unknown, and the area where the travel lane is unknown is complemented by the virtual lane set by the virtual lane setting means. Is a means for detecting the positional relationship between the traveling lane and the host vehicle,
Rear vehicle analysis device.
請求項1ないし13のいずれかに記載の後方車両解析装置を備え、該後方車両解析装置が備える所定後方領域確率推定手段により推定された所定後方領域確率に基づいて、前記後方車両の自車両への衝突に関する予測を行なう、衝突予測装置。   A rear vehicle analysis device according to any one of claims 1 to 13, wherein the vehicle of the rear vehicle is based on a predetermined rear region probability estimated by a predetermined rear region probability estimation means included in the rear vehicle analysis device. Collision prediction device that makes predictions about collisions.
JP2006006679A 2006-01-13 2006-01-13 Rear vehicle analysis device and collision prediction device Expired - Fee Related JP4661602B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2006006679A JP4661602B2 (en) 2006-01-13 2006-01-13 Rear vehicle analysis device and collision prediction device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006006679A JP4661602B2 (en) 2006-01-13 2006-01-13 Rear vehicle analysis device and collision prediction device

Publications (2)

Publication Number Publication Date
JP2007188349A JP2007188349A (en) 2007-07-26
JP4661602B2 true JP4661602B2 (en) 2011-03-30

Family

ID=38343470

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006006679A Expired - Fee Related JP4661602B2 (en) 2006-01-13 2006-01-13 Rear vehicle analysis device and collision prediction device

Country Status (1)

Country Link
JP (1) JP4661602B2 (en)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101163446B1 (en) * 2009-03-18 2012-07-18 기아자동차주식회사 A lane departure warning system using a virtual lane and a system according to the same
JP5463919B2 (en) * 2010-01-07 2014-04-09 マツダ株式会社 Vehicle rear side warning device
JP5648420B2 (en) * 2010-10-26 2015-01-07 トヨタ自動車株式会社 Risk prediction device
EP3159866B1 (en) 2014-06-19 2022-04-13 Hitachi Astemo, Ltd. Object recognition apparatus and vehicle travel controller using same
WO2018228666A1 (en) * 2017-06-12 2018-12-20 Continental Automotive Gmbh A rear pre-crash safety system

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11227624A (en) * 1998-02-16 1999-08-24 Toyota Central Res & Dev Lab Inc Emergency steering device for vehicle
JPH11337644A (en) * 1998-05-27 1999-12-10 Mitsubishi Motors Corp Rear monitoring system for vehicle
JP2000315255A (en) * 1999-03-01 2000-11-14 Yazaki Corp Back side direction monitoring device for vehicle and back side direction monitoring alarm device for vehicle
JP2004220341A (en) * 2003-01-15 2004-08-05 Fujitsu Ten Ltd Preceding vehicle estimating method
JP2005228136A (en) * 2004-02-13 2005-08-25 Nissan Motor Co Ltd Road area detecting device

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11227624A (en) * 1998-02-16 1999-08-24 Toyota Central Res & Dev Lab Inc Emergency steering device for vehicle
JPH11337644A (en) * 1998-05-27 1999-12-10 Mitsubishi Motors Corp Rear monitoring system for vehicle
JP2000315255A (en) * 1999-03-01 2000-11-14 Yazaki Corp Back side direction monitoring device for vehicle and back side direction monitoring alarm device for vehicle
JP2004220341A (en) * 2003-01-15 2004-08-05 Fujitsu Ten Ltd Preceding vehicle estimating method
JP2005228136A (en) * 2004-02-13 2005-08-25 Nissan Motor Co Ltd Road area detecting device

Also Published As

Publication number Publication date
JP2007188349A (en) 2007-07-26

Similar Documents

Publication Publication Date Title
JP6446732B2 (en) Vehicle control device, vehicle control method, and vehicle control program
JP4420011B2 (en) Object detection device
US9809251B2 (en) Lane following control device
US20180201271A1 (en) Vehicle control device, vehicle control method, and vehicle control program
JP4923520B2 (en) VEHICLE POSITION ESTIMATION DEVICE, VEHICLE TRAVEL SUPPORT DEVICE, AND VEHICLE POSITION ESTIMATION METHOD
KR102112125B1 (en) Vehicle control device
WO2018074287A1 (en) Vehicle control device
CN109327677B (en) Surroundings monitoring device
US20190073540A1 (en) Vehicle control device, vehicle control method, and storage medium
CN108974010B (en) Processing device, vehicle, processing method, and storage medium
CN112208533B (en) Vehicle control system, vehicle control method, and storage medium
US11351997B2 (en) Collision prediction apparatus and collision prediction method
JP2009251953A (en) Moving object trajectory estimating device
JP2012089114A (en) Obstacle recognition device
US20210269040A1 (en) Driving assist method and driving assist device
JP6970547B2 (en) Vehicle control device and vehicle control method
KR20180128030A (en) Method and apparatus for parking assistance
US10640128B2 (en) Vehicle control device, vehicle control method, and storage medium
JP4661602B2 (en) Rear vehicle analysis device and collision prediction device
JP2019046143A (en) Travel support device
JP2003276538A (en) Obstacle predicting device
JP4768499B2 (en) In-vehicle peripheral other vehicle detection device
JP2020042340A (en) Mobile object detection system
US11938879B2 (en) Vehicle control device, information processing apparatus, operation methods thereof, and storage medium
US11495029B2 (en) Estimation device, estimation method, and storage medium

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080521

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100729

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100803

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20100831

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

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

R151 Written notification of patent or utility model registration

Ref document number: 4661602

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

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

Free format text: PAYMENT UNTIL: 20140114

Year of fee payment: 3

LAPS Cancellation because of no payment of annual fees