JP2010108168A - Collision prediction device - Google Patents

Collision prediction device Download PDF

Info

Publication number
JP2010108168A
JP2010108168A JP2008278581A JP2008278581A JP2010108168A JP 2010108168 A JP2010108168 A JP 2010108168A JP 2008278581 A JP2008278581 A JP 2008278581A JP 2008278581 A JP2008278581 A JP 2008278581A JP 2010108168 A JP2010108168 A JP 2010108168A
Authority
JP
Japan
Prior art keywords
vehicle
edge
collision
target object
collision probability
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2008278581A
Other languages
Japanese (ja)
Other versions
JP5083172B2 (en
Inventor
Masayuki Kato
雅之 加藤
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 JP2008278581A priority Critical patent/JP5083172B2/en
Publication of JP2010108168A publication Critical patent/JP2010108168A/en
Application granted granted Critical
Publication of JP5083172B2 publication Critical patent/JP5083172B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Image Analysis (AREA)
  • Image Processing (AREA)
  • Traffic Control Systems (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a collision prediction device for accurately determining the probability that a target object may collide with one's own vehicle according to the detecting accuracy of an image sensor when the target object is detected by means of a radar sensor and the image sensor. <P>SOLUTION: A collision prediction ECU 1 includes a collision probability calculating unit 18 and a collision probability correcting and computing unit 20. The collision probability calculating unit 18 calculates the position and probability of collision of the one's own vehicle with an incoming vehicle on the basis of the track and the vehicle speed of the one's own vehicle and the vehicle speed and the track of the incoming vehicle. The collision probability correcting and computing unit 20 detects the relative positional relationship between a lateral position of the incoming vehicle and an edge of the incoming vehicle, and corrects the probability of the collision based on the relative positional relationship between the lateral position of the incoming vehicle and the edge of the incoming vehicle. <P>COPYRIGHT: (C)2010,JPO&INPIT

Description

本発明は、自車両における他車両などの自車両の周囲における対象物体との衝突確率を予測する衝突予測装置に関するものである。   The present invention relates to a collision prediction apparatus that predicts a collision probability with a target object around a host vehicle such as another vehicle in the host vehicle.

従来、自車両の周囲の車両を検出する装置として、レーダセンサおよび画像センサを用いた車両検出装置がある(たとえば、特許文献1)。この車両検出装置は、前方探査レーダが受信した各反射点のクラスタリング処理によって前方車両を認識するとともに、自車両の前方を撮像した画像に対する画像処理によってエッジを抽出し、抽出したエッジに基づいて前方車両を認識する。これらのクラスタリング処理および画像処理によって認識された前方車両にセンサフュージョンを行い、このセンサフュージョンによって前方車両を検出する。そして、検出した前方車両と自車両との衝突の可能性を判定するというものである。
特開2005−141517号公報
Conventionally, there is a vehicle detection device using a radar sensor and an image sensor as a device for detecting a vehicle around the host vehicle (for example, Patent Document 1). This vehicle detection device recognizes a forward vehicle by clustering processing of each reflection point received by the forward search radar, extracts an edge by image processing on an image obtained by capturing the front of the host vehicle, and moves forward based on the extracted edge. Recognize the vehicle. Sensor fusion is performed on the preceding vehicle recognized by these clustering processing and image processing, and the preceding vehicle is detected by this sensor fusion. Then, the possibility of a collision between the detected preceding vehicle and the host vehicle is determined.
JP 2005-141517 A

しかし、上記特許文献1に開示された車両検出装置では、画像処理によってエッジを抽出するにあたり、抽出したエッジまでの距離を取得することができず、複数のエッジを抽出した際に、エッジと前方車両との対応関係が不明確となる場合があった。このため、車両の前方における物体のエッジを検出したにも関わらず、検出したエッジが前方車両のものであるか否かが不明確となる結果、前方車両の検出精度が低くなる。そして、前方車両の検出精度が低くなるということから、衝突の可能性の判定精度が低くなるという問題があった。   However, in the vehicle detection device disclosed in Patent Document 1, when extracting an edge by image processing, the distance to the extracted edge cannot be acquired, and when a plurality of edges are extracted, the edge and the front In some cases, the relationship with the vehicle was unclear. For this reason, in spite of detecting the edge of the object in front of the vehicle, it becomes unclear whether the detected edge is that of the preceding vehicle, and as a result, the detection accuracy of the preceding vehicle is lowered. And since the detection accuracy of the vehicle ahead becomes low, there is a problem that the determination accuracy of the possibility of collision is low.

そこで、本発明の課題は、レーダセンサと画像センサによって対象物体を検出するにあたり、画像センサによる検出精度に応じて、自車両に対する対象物体の衝突確率を精度よく判定することができる衝突予測装置を提供することにある。   Therefore, an object of the present invention is to provide a collision prediction device that can accurately determine the collision probability of a target object with respect to the host vehicle according to the detection accuracy of the image sensor when the target object is detected by the radar sensor and the image sensor. It is to provide.

上記課題を解決した本発明に係る衝突予測装置は、レーダによって対象物体を検出するレーダ検出手段と、撮像手段によって撮像した画像からエッジを検出し、検出したエッジに基づいて対象物体を検出する画像検出手段と、対象物体と自車両との関係に基づいて、対象物体と自車両との衝突確率を算出する衝突確率算出手段と、レーダ検出手段で検出した対象物体の自車両における車幅方向に対する位置であるレーダ横位置と、画像検出手段で検出した対象物体に対応するエッジである対象物体対応エッジにおけるエッジ幅方向位置との相対位置関係を検出する相対位置関係検出手段と、レーダ横位置と対象物体対応エッジにおけるエッジ幅方向位置との相対位置関係に基づいて、対象物体と自車両との衝突確率を補正する衝突確率補正手段と、を備えることを特徴とする。   A collision prediction apparatus according to the present invention that solves the above problems includes a radar detection unit that detects a target object using a radar, an image that detects an edge from an image captured by the imaging unit, and detects the target object based on the detected edge. A collision probability calculating unit for calculating a collision probability between the target object and the host vehicle based on a relationship between the detection unit, the target object and the host vehicle; and a target object detected by the radar detecting unit with respect to the vehicle width direction in the host vehicle. A relative positional relationship detecting means for detecting a relative positional relationship between a radar lateral position as a position and an edge width direction position at a target object corresponding edge that is an edge corresponding to the target object detected by the image detecting means; A collision probability correction method for correcting the collision probability between the target object and the host vehicle based on the relative positional relationship between the edge corresponding to the target object and the position in the edge width direction. Characterized in that it comprises a and.

本発明に係る衝突予測装置は、対象物体と自車両との関係に基づいて、対象物体と自車両との衝突確率を算出する。ここで、対象物体対応エッジの検出精度が低いとしたとしても、対象物体対応エッジの検出精度レーダ横位置と対象物体対応エッジの幅方向位置との相対位置関係に依存すると考えられる。この点、本発明に係る衝突予測装置では、対象物体の自車両における車幅方向に対する位置であるレーダ横位置と、対象物体に対応するエッジである対象物体対応エッジにおけるエッジ幅方向位置との相対位置関係に基づいて、対象物体と自車両との衝突確率を補正している。このため、レーダセンサと画像センサによって対象物体を検出するにあたり、画像センサによる検出精度に応じて、自車両に対する対象物体の衝突確率を精度よく判定することができる。   The collision prediction apparatus according to the present invention calculates the collision probability between the target object and the host vehicle based on the relationship between the target object and the host vehicle. Here, even if the detection accuracy of the target object-corresponding edge is low, it is considered that the detection accuracy of the target object-corresponding edge depends on the relative positional relationship between the radar lateral position and the width direction position of the target object-corresponding edge. In this regard, in the collision prediction apparatus according to the present invention, the relative position of the radar lateral position, which is the position of the target object with respect to the vehicle width direction of the host vehicle, and the edge width direction position of the target object corresponding edge that is the edge corresponding to the target object. Based on the positional relationship, the collision probability between the target object and the host vehicle is corrected. For this reason, when the target object is detected by the radar sensor and the image sensor, the collision probability of the target object with respect to the host vehicle can be accurately determined according to the detection accuracy of the image sensor.

ここで、衝突確率補正手段は、レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の端部に位置する場合は、対象物体対応エッジにおけるエッジ幅方向の中央部に位置する場合に比べて、衝突確率が相対的に低くなるように補正する態様とすることができる。   Here, the collision probability correcting means is configured such that when the radar lateral position is located at the edge of the target object corresponding edge in the edge width direction, compared to the case where the radar lateral position is located at the center of the target object corresponding edge in the edge width direction. It can be set as the aspect correct | amended so that a probability may become relatively low.

レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の中央部に位置する場合には、レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の端部に位置する場合よりも衝突確率が高くなると考えられる。そこで、本発明に係る衝突予測装置では、レーダ横位置が、対象物体対応エッジにおけるエッジ幅方向の端部に位置する場合は対象物体対応エッジにおけるエッジ幅方向の中央部に位置する場合に比べて、衝突確率が相対的に低くなるように補正する。このため、自車両に対する対象物体の衝突確率を精度よく判定することができる。   If the radar lateral position is located at the center of the edge corresponding to the target object in the edge width direction, the collision probability is considered to be higher than if the radar lateral position is located at the edge of the target object corresponding edge in the edge width direction. . Therefore, in the collision prediction device according to the present invention, when the radar lateral position is located at the edge of the target object corresponding edge in the edge width direction, compared to the case where the radar lateral position is located at the center of the target object corresponding edge in the edge width direction. The correction is made so that the collision probability is relatively low. For this reason, it is possible to accurately determine the collision probability of the target object with respect to the host vehicle.

なお、本発明において「レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の端部に位置する場合は、対象物体対応エッジにおけるエッジ幅方向の中央部に位置する場合に比べて、衝突確率が低くなるように補正する」とは、「レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の中央部に位置する場合を基準としてレーダ横位置が対象物体対応エッジにおけるエッジ幅方向の端部に位置する場合の衝突確率を低く補正する」場合と、「レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の端部に位置する場合を基準として、レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の中央部に位置する場合の衝突確率を高く補正する」場合を含む。さらに、「レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の端部と中央部との間に位置する場合を基準として、レーダ横位置が対象物体対応エッジの幅方向中央部に位置する場合には衝突確率を高く補正し、幅方向の端部に位置する場合には衝突確率を低く補正する」場合も含む。   Note that in the present invention, “when the radar lateral position is located at the edge of the target object corresponding edge in the edge width direction, the collision probability is lower than that in the center of the target object corresponding edge in the edge width direction. "Correction to be so that" means that the radar lateral position is located at the edge of the target object corresponding edge in the edge width direction with reference to the case where the radar lateral position is located at the center of the target object corresponding edge. If the radar lateral position is located at the edge width direction edge of the target object corresponding edge, the radar lateral position is the center in the edge width direction of the target object corresponding edge. The case where the collision probability when positioned in a part is corrected to be high is included. Furthermore, “When the radar lateral position is located at the center in the width direction of the edge corresponding to the target object, the radar lateral position is located between the edge in the edge width direction and the center in the edge corresponding to the target object. Includes a case where the collision probability is corrected to be high and the collision probability is corrected to be low when positioned at the end in the width direction.

また、衝突確率補正手段は、レーダ横位置が、対象物体対応エッジにおけるエッジ幅方向の自車両に近い側の端部に位置する場合には、対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合に比べて、衝突確率が相対的に高くなるように補正する態様とすることもできる。   In addition, the collision probability correcting means is far from the own vehicle in the edge width direction at the target object corresponding edge when the radar lateral position is located at the end near the own vehicle in the edge width direction at the target object corresponding edge. It can also be set as the aspect correct | amended so that a collision probability may become relatively high compared with the case where it is located in the edge part of the side.

自車両に対して対象物体がオフセット衝突を生じる可能性があるとき、対象物体対応エッジには、自車両に近い側の端部と自車両に遠い側の端部が生じる場合がある。また、車両の側方に位置する物体を対象物体と一体であるとして誤認識したときにも対象物体対応エッジには、自車両に近い側の端部と自車両に遠い側の端部が生じる場合がある。ここで、自車両に対して対象物体がオフセット衝突を生じる可能性があるときには、レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の自車両に近い側の端部に位置することとなる。その一方、車両の側方に位置する物体を対象物体と一体であるとして誤認識したときには、レーダ横位置の対象物体対応エッジにおけるエッジ幅方向の位置は種々の位置となると考えられる。そこで、本発明に係る衝突予測装置では、レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の自車両に近い側の端部に位置する場合には対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合には、衝突確率が相対的に高くなるように補正している。このため、自車両に対して対象物体がオフセット衝突を生じる可能性がある場合に、衝突確率を低く見積もりすぎることを防止することができる。したがって、対象物体における自車両に対する対象物体の衝突確率をさらに精度よく判定することができる。   When the target object may cause an offset collision with respect to the host vehicle, the target object-corresponding edge may have an end portion closer to the host vehicle and an end portion farther from the host vehicle. Also, when an object located on the side of the vehicle is misrecognized as being integrated with the target object, the target object-corresponding edge has an end near the host vehicle and an end far from the host vehicle. There is a case. Here, when the target object may cause an offset collision with respect to the host vehicle, the radar lateral position is located at the end of the target object corresponding edge on the side closer to the host vehicle in the edge width direction. On the other hand, when the object located on the side of the vehicle is erroneously recognized as being integrated with the target object, the position in the edge width direction at the target object corresponding edge at the lateral position of the radar is considered to be various positions. Therefore, in the collision prediction device according to the present invention, when the radar lateral position is located at the end of the target object corresponding edge near the own vehicle in the edge width direction, When located at the far end, the collision probability is corrected to be relatively high. For this reason, when the target object may cause an offset collision with respect to the host vehicle, it is possible to prevent the collision probability from being estimated too low. Therefore, the collision probability of the target object with respect to the host vehicle in the target object can be determined with higher accuracy.

なお、本発明において「レーダ横位置が、対象物体対応エッジにおけるエッジ幅方向の自車両に近い側の端部に位置する場合には、対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合に比べて、衝突確率が相対的に高くなるように補正する」とは、「レーダ横位置が、対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合を基準として、レーダ横位置が、対象物体対応エッジにおけるエッジ幅方向の自車両に近い側の端部に位置する場合を高く補正する」場合と、「レーダ横位置が、対象物体対応エッジにおけるエッジ幅方向の自車両に近い側の端部に位置する場合を基準として、レーダ横位置が、対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合の衝突確率を低く補正する」場合を含む。さらには、「レーダ横位置が、対象物体対応エッジにおけるエッジ幅方向の中央部を基準として、レーダ横位置が、エッジ幅方向の自車両に近い側の端部に位置する場合には、衝突確率を高く補正し、エッジ幅方向の自車両に遠い側の端部に位置する場合には、衝突確率を低く補正する」場合も含む。   In the present invention, when the radar lateral position is located at the end of the target object corresponding edge near the host vehicle in the edge width direction, “Correction so that the collision probability is relatively higher than when positioned at the end” means that “the radar lateral position is at the end of the target object corresponding edge in the edge width direction far from the vehicle. When the position of the radar is positioned, the radar lateral position is corrected to be higher when the edge corresponding to the target object is located at the end of the edge width direction closer to the host vehicle. When the radar lateral position is located at the end of the target object corresponding edge that is far from the host vehicle in the edge width direction, based on the case where the edge is located at the end near the own vehicle in the edge width direction Collision probability to the low correction "including the case. Furthermore, “If the radar lateral position is located at the edge of the edge corresponding to the target object, the center of the edge corresponding to the edge width direction is the reference, the collision probability In the edge width direction, the collision probability is corrected to be low.

さらに、対象物体が自車両進行方向に対して直交する方向に沿った速度成分である横速度成分を有して自車両に接近しているか否かを検出する横速度検出手段を備え、衝突確率補正手段は、対象物体が横速度成分を有して接近している場合は、対象物体が横速度成分を有して接近していない場合に比べて対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合の衝突確率が相対的に高くなるように衝突確率を補正する態様とすることができる。   Furthermore, the vehicle has a lateral velocity detecting means for detecting whether the target object has a lateral velocity component that is a velocity component along a direction orthogonal to the traveling direction of the host vehicle, and detects the collision probability. When the target object is approaching with a lateral velocity component, the correcting means is subject to the subject vehicle in the edge width direction at the target object corresponding edge as compared with the case where the target object is not approaching with the lateral velocity component. It is possible to adopt a mode in which the collision probability is corrected so that the collision probability is relatively high when it is located at the far end.

レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合、対象物体が横速度成分を有して自車両に接近している場合と、自車両の側方における不動の物体を対象物体と誤検出してしまう場合とがある。ここで、検出された物体が横速度成分を有している場合には、自車両に衝突する可能性が高い対象物体であり、横速度成分を有していない場合には、自車両衝突する可能性が低い物体を対象物体と誤検出したと考えられる。この点、本発明に係る衝突予測装置では、対象物体が横速度成分を有して自車両に接近している場合には、対象物体が横速度成分を有して接近していない場合に比べて、対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合の衝突確率が相対的に高くなるように補正している。このため、レーダ横位置が対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合における自車両に対する対象物体の衝突確率を低く見積もりすぎることを防止することができる。その結果、自車両に対する対象物体の衝突確率をさらに精度よく判定することができる。   When the radar lateral position is located at the edge of the target object corresponding edge in the edge width direction far from the host vehicle, the target object has a lateral velocity component and approaches the host vehicle, In some cases, a stationary object may be erroneously detected as a target object. Here, if the detected object has a lateral velocity component, the target object is highly likely to collide with the host vehicle. If the detected object does not have a lateral velocity component, the host vehicle collides. It is considered that an object with a low possibility is erroneously detected as a target object. In this regard, in the collision prediction device according to the present invention, when the target object has a lateral velocity component and approaches the host vehicle, the target object has a lateral velocity component and does not approach. Thus, the collision probability when the edge corresponding to the target object is located at the end far from the host vehicle in the edge width direction is corrected so as to be relatively high. For this reason, it is possible to prevent the collision probability of the target object with respect to the own vehicle from being estimated too low when the radar lateral position is located at the edge of the target object corresponding edge in the edge width direction far from the own vehicle. As a result, the collision probability of the target object with respect to the host vehicle can be determined with higher accuracy.

なお、本発明において、「対象物体が横速度成分を有して接近している場合は、対象物体が横速度成分を有して接近していない場合に比べて対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合の衝突確率が相対的に高くなるように衝突確率を補正する」とは、「対象物体が横速度成分を有して接近していない場合を基準として、対象物体が横速度成分を有して接近している場合には対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合の衝突確率を高く補正する」場合と、「対象物体が横速度成分を有して接近している場合を基準として、対象物体が横速度成分を有して接近していない場合には対象物体対応エッジにおけるエッジ幅方向の自車両に遠い側の端部に位置する場合の衝突確率を低く補正する」場合を含む。   Note that in the present invention, “when the target object is approaching with a lateral velocity component, the edge width direction at the target object corresponding edge compared to when the target object is not approaching with a lateral velocity component. `` Correcting the collision probability so that the collision probability is relatively high when it is located at the end far from the host vehicle '' means that the target object has a lateral velocity component and is not approaching. As a reference, when the target object is approaching with a lateral velocity component, the collision probability when the edge corresponding to the target object is located at the end of the edge width direction far from the host vehicle is corrected. "When the target object is approaching with a lateral velocity component, the vehicle in the edge width direction at the target object corresponding edge when the target object is not approaching with a lateral velocity component." If it is located at the end far from the Probability of correcting lower, "including the case.

また、上記課題を解決した本発明に係る衝突予測装置は、レーダによって対象物体を検出するレーダ検出手段と、撮像手段によって撮像した画像から複数のエッジを検出し、検出した複数のエッジに基づいて対象物体を検出する画像検出手段と、レーダ検出手段および画像検出手段でそれぞれ検出された対象物体と、自車両との関係に基づいて、対象物体と自車両との衝突確率を算出する衝突確率算出手段と、複数のエッジが同一の物体に属する確度であるエッジ確度を検出するエッジ確度検出手段と、エッジ確度に応じて衝突確率を補正する衝突確率補正手段と、を備えることを特徴とするものである。   In addition, a collision prediction apparatus according to the present invention that has solved the above-described problem is a radar detection unit that detects a target object using a radar, a plurality of edges detected from an image captured by the imaging unit, and based on the detected plurality of edges. Collision probability calculation that calculates the collision probability between the target object and the host vehicle based on the relationship between the target object detected by the image detection unit that detects the target object, the target object detected by the radar detection unit and the image detection unit, and the host vehicle. And a collision probability correction unit that corrects the collision probability according to the edge accuracy, and an edge accuracy detection unit that detects an edge accuracy that is an accuracy of a plurality of edges belonging to the same object. It is.

本発明に係る衝突予測装置は、エッジ確度に応じて衝突確率を補正している。このため、対象物体と異なるエッジが検出されている場合における衝突確率を低くすることができるので、レーダセンサと画像センサによって対象物体を検出するにあたり、自車両に対する対象物体の衝突確率を精度よく判定することができる。   The collision prediction apparatus according to the present invention corrects the collision probability according to the edge accuracy. For this reason, the collision probability when an edge different from the target object is detected can be lowered. Therefore, when the target object is detected by the radar sensor and the image sensor, the collision probability of the target object with respect to the own vehicle is accurately determined. can do.

本発明に係る衝突予測装置によれば、レーダセンサと画像センサによって対象物体を検出するにあたり、画像センサによる検出精度に応じて、自車両に対する対象物体の衝突確率を精度よく判定することができる。   According to the collision prediction apparatus according to the present invention, when the target object is detected by the radar sensor and the image sensor, the collision probability of the target object with respect to the host vehicle can be accurately determined according to the detection accuracy by the image sensor.

以下、添付図面を参照して本発明の実施形態について説明する。なお、図面の説明において同一の要素には同一の符号を付し、重複する説明を省略する。また、図示の便宜上、図面の寸法比率は説明のものと必ずしも一致しない。   Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings. In the description of the drawings, the same elements are denoted by the same reference numerals, and redundant description is omitted. For the convenience of illustration, the dimensional ratios in the drawings do not necessarily match those described.

図1は、本発明に係る衝突予測装置の構成を示すブロック構成図である。図1に示すように、衝突予測装置は、衝突予測ECU1を備えている。衝突予測ECU1には、操舵角センサ2、ヨーレートセンサ3、車輪速センサ4、ミリ波レーダセンサ5、および画像センサ6が接続されている。また、衝突予測ECU1には、警報装置31、衝突回避支援装置32、シートベルト制御装置33、シート位置制御装置34、ブレーキ制御装置35、およびエアバッグ制御装置36といった衝突回避デバイスが接続されている。   FIG. 1 is a block configuration diagram showing a configuration of a collision prediction apparatus according to the present invention. As shown in FIG. 1, the collision prediction apparatus includes a collision prediction ECU 1. A steering angle sensor 2, a yaw rate sensor 3, a wheel speed sensor 4, a millimeter wave radar sensor 5, and an image sensor 6 are connected to the collision prediction ECU 1. In addition, a collision avoidance device such as an alarm device 31, a collision avoidance support device 32, a seat belt control device 33, a seat position control device 34, a brake control device 35, and an airbag control device 36 is connected to the collision prediction ECU 1. .

衝突予測ECU1は、電子制御する自動車デバイスのコンピュータであり、CPU(Central Processing Unit)、ROM(Read Only Memory)、RAM(Random Access Memory)、および入出力インターフェイスなどを備えて構成されている。衝突予測ECU1は、推定カーブ半径演算部11、自車両軌道演算部12、自車速演算部13、および相手車速演算部14を備えている。また衝突予測ECU1は、相手車両移動距離演算部15、相手車両横位置演算部16、および相手車両軌道演算部17を備えている。さらに、衝突予測ECU1は、衝突確率演算部18、画像処理部19および衝突確率補正・演算部20を備えている。また、衝突確率演算部18には、衝突位置演算部21および衝突位置分布演算部22が設けられている。   The collision prediction ECU 1 is a computer of an automobile device that is electronically controlled, and includes a CPU (Central Processing Unit), a ROM (Read Only Memory), a RAM (Random Access Memory), an input / output interface, and the like. The collision prediction ECU 1 includes an estimated curve radius calculation unit 11, a host vehicle track calculation unit 12, a host vehicle speed calculation unit 13, and a counterpart vehicle speed calculation unit 14. The collision prediction ECU 1 includes an opponent vehicle movement distance calculation unit 15, an opponent vehicle lateral position calculation unit 16, and an opponent vehicle track calculation unit 17. The collision prediction ECU 1 further includes a collision probability calculation unit 18, an image processing unit 19, and a collision probability correction / calculation unit 20. Further, the collision probability calculation unit 18 is provided with a collision position calculation unit 21 and a collision position distribution calculation unit 22.

操舵角センサ2は、たとえば車両におけるステアリングロッドに取り付けられており、運転者が操作したステアリングホイールの操舵角を検出する。操舵角センサ2は、検出した操舵角に関する操舵角信号を衝突予測ECU1における推定カーブ半径演算部11に出力する。   The steering angle sensor 2 is attached to a steering rod in a vehicle, for example, and detects the steering angle of the steering wheel operated by the driver. The steering angle sensor 2 outputs a steering angle signal related to the detected steering angle to the estimated curve radius calculation unit 11 in the collision prediction ECU 1.

ヨーレートセンサ3は、たとえば車体の中央位置に設けられており、車体にかかるヨーレートを検出する。ヨーレートセンサ3は、検出したヨーレートに関するヨーレート信号を衝突予測ECU1における推定カーブ半径演算部11に出力する。   The yaw rate sensor 3 is provided, for example, at the center position of the vehicle body, and detects the yaw rate applied to the vehicle body. The yaw rate sensor 3 outputs a yaw rate signal related to the detected yaw rate to the estimated curve radius calculation unit 11 in the collision prediction ECU 1.

車輪速センサ4は、たとえば車両のホイール部分に取り付けられており、車両の車輪速度を検出する。車輪速センサ4は、検出した車輪速度に関する車輪速度信号を衝突予測ECU1における自車速演算部13に出力する。   The wheel speed sensor 4 is attached to a wheel portion of the vehicle, for example, and detects the wheel speed of the vehicle. The wheel speed sensor 4 outputs a wheel speed signal related to the detected wheel speed to the host vehicle speed calculation unit 13 in the collision prediction ECU 1.

ミリ波レーダセンサ5は、たとえば車両のフロントグリルおよびリアトランクのカバー部分にそれぞれ取り付けられており、ミリ波を前方および側方にそれぞれ出射し、その反射波を受信する。ミリ波レーダセンサ5は、受信した反射波に関する反射波信号を衝突予測ECU1における相手車速演算部14、相手車両移動距離演算部15、および相手車両横位置演算部16に出力する。ミリ波レーダセンサ5は、レーダ検出手段を構成する。   The millimeter wave radar sensor 5 is attached to, for example, the front grille and rear trunk cover portions of the vehicle, emits millimeter waves forward and sideward, and receives the reflected waves. The millimeter wave radar sensor 5 outputs the reflected wave signal relating to the received reflected wave to the opponent vehicle speed calculation unit 14, the opponent vehicle movement distance calculation unit 15, and the opponent vehicle lateral position calculation unit 16 in the collision prediction ECU 1. The millimeter wave radar sensor 5 constitutes radar detection means.

画像センサ6は、車両の前方を撮像する車載カメラを備えている。画像センサ6は、車載カメラで撮像した車両の前方の画像を衝突予測ECU1における画像処理部19に送信する。車両の前方を走行する他車両などの障害物が存在する場合には、車載カメラで撮像される画像中にその障害物が映りこむこととなる。画像センサ6は、画像検出手段を構成する。   The image sensor 6 includes an in-vehicle camera that images the front of the vehicle. The image sensor 6 transmits an image ahead of the vehicle imaged by the in-vehicle camera to the image processing unit 19 in the collision prediction ECU 1. When an obstacle such as another vehicle traveling in front of the vehicle is present, the obstacle is reflected in an image captured by the in-vehicle camera. The image sensor 6 constitutes image detection means.

衝突予測ECU1における推定カーブ半径演算部11は、操舵角センサ2から出力される操舵角信号およびヨーレートセンサ3から出力されるヨーレート信号に基づいて、自車両の推定カーブ半径を演算によって算出する。推定カーブ半径演算部11は、算出した推定カーブ半径を自車両軌道演算部12に出力する。   Based on the steering angle signal output from the steering angle sensor 2 and the yaw rate signal output from the yaw rate sensor 3, the estimated curve radius calculation unit 11 in the collision prediction ECU 1 calculates the estimated curve radius of the host vehicle by calculation. The estimated curve radius calculation unit 11 outputs the calculated estimated curve radius to the host vehicle track calculation unit 12.

自車両軌道演算部12は、推定カーブ半径演算部11から出力される推定カーブ半径信号に基づいて、自車両の軌道を演算によって算出する。自車両軌道演算部12は、算出した自車両の軌道である自車両軌道を衝突確率演算部18に出力する。   The host vehicle track calculation unit 12 calculates the track of the host vehicle by calculation based on the estimated curve radius signal output from the estimated curve radius calculation unit 11. The host vehicle track calculation unit 12 outputs the host vehicle track that is the calculated track of the host vehicle to the collision probability calculation unit 18.

自車速演算部13は、車輪速センサ4から出力される車輪速度信号に基づいて、自車両の車速を演算によって算出する。自車速演算部13は、算出した自車両の車速である自車速を衝突確率演算部18に出力する。   The own vehicle speed calculation unit 13 calculates the vehicle speed of the own vehicle by calculation based on the wheel speed signal output from the wheel speed sensor 4. The host vehicle speed calculation unit 13 outputs the calculated host vehicle speed, which is the vehicle speed of the host vehicle, to the collision probability calculation unit 18.

相手車速演算部14は、ミリ波レーダセンサ5から出力される反射波信号に基づいて、移動体である相手車両の車速を演算によって算出する。相手車速演算部14は、算出した相手車両の車速である相手車速を衝突確率演算部18に出力する。   The counterpart vehicle speed calculation unit 14 calculates the vehicle speed of the counterpart vehicle, which is a moving body, based on the reflected wave signal output from the millimeter wave radar sensor 5 by calculation. The partner vehicle speed calculation unit 14 outputs the partner vehicle speed, which is the calculated vehicle speed of the partner vehicle, to the collision probability calculation unit 18.

相手車両移動距離演算部15は、ミリ波レーダセンサ5から出力される反射波信号に基づいて、ミリ波レーダセンサ5が相手車両を捕捉した後における相手車両の移動距離を演算によって算出する。相手車両移動距離演算部15は、算出した相手車両の移動距離である相手車両移動距離を相手車両軌道演算部17に出力する。   Based on the reflected wave signal output from the millimeter wave radar sensor 5, the opponent vehicle movement distance calculation unit 15 calculates the movement distance of the opponent vehicle after the millimeter wave radar sensor 5 captures the opponent vehicle. The partner vehicle movement distance calculation unit 15 outputs the partner vehicle movement distance, which is the calculated movement distance of the partner vehicle, to the partner vehicle trajectory calculation unit 17.

相手車両横位置演算部16は、ミリ波レーダセンサ5から出力される反射波信号に基づいて、相手車両の自車両における車幅方向に対する位置である相手車両横位置を演算によって算出する。相手車両横位置演算部16は、算出した相手車両横位置を相手車両軌道演算部17および衝突確率補正・演算部20に出力する。   The partner vehicle lateral position calculation unit 16 calculates the partner vehicle lateral position, which is the position of the partner vehicle in the vehicle width direction of the host vehicle, based on the reflected wave signal output from the millimeter wave radar sensor 5. The opponent vehicle lateral position calculation unit 16 outputs the calculated opponent vehicle lateral position to the opponent vehicle track calculation unit 17 and the collision probability correction / calculation unit 20.

相手車両軌道演算部17は、相手車両横位置演算部16から出力される相手車両横位置および相手車両移動距離演算部15から出力される相手車両移動距離に基づいて、相手車両の軌道を演算によって算出する。相手車両軌道演算部17は、算出した相手車両の軌道である相手車両軌道を衝突確率演算部18に出力する。   The partner vehicle trajectory calculation unit 17 calculates the trajectory of the partner vehicle based on the partner vehicle lateral position output from the partner vehicle lateral position calculator 16 and the partner vehicle travel distance output from the partner vehicle travel distance calculator 15. calculate. The opponent vehicle trajectory calculation unit 17 outputs the opponent vehicle trajectory that is the calculated trajectory of the opponent vehicle to the collision probability calculation unit 18.

衝突確率演算部18は、衝突位置演算部21において、自車両軌道演算部12から出力される自車両軌道、自車速演算部13から出力される自車速、相手車速演算部14から出力される相手車速、および相手車両軌道演算部17から出力される相手車両軌道に基づいて、自車両における相手車両の衝突位置を演算によって算出する。   In the collision position calculation unit 21, the collision probability calculation unit 18 includes a host vehicle track output from the host vehicle track calculation unit 12, a host vehicle speed output from the host vehicle speed calculation unit 13, and a partner output from the partner vehicle speed calculation unit 14. Based on the vehicle speed and the opponent vehicle track output from the opponent vehicle track calculation unit 17, the collision position of the opponent vehicle in the host vehicle is calculated by calculation.

また、衝突確率演算部18は、衝突位置分布演算部22において、衝突位置分布を算出する。また、衝突位置分布演算部22では、予め自車両の幅方向の長さを所定間隔で複数の区画に区切っておき、衝突位置演算部21で算出された衝突位置がどの区画に含まれるかを判断する。   In addition, the collision probability calculation unit 18 calculates the collision position distribution in the collision position distribution calculation unit 22. In addition, the collision position distribution calculation unit 22 divides the length of the host vehicle in the width direction into a plurality of sections in advance at predetermined intervals, and which section includes the collision position calculated by the collision position calculation unit 21. to decide.

続いて、衝突位置が含まれる区画を判断したら衝突位置が含まれる区画に衝突位置計数値を加算する。こうして、各区画について、衝突位置演算部21で算出された回数を計数し、その計数結果を衝突位置分布として算出する。また、衝突位置分布演算部22では、計数回数が所定数に到達した場合には、古い衝突位置データから削除して新しい衝突位置データを計数していく。   Subsequently, when the section including the collision position is determined, the collision position count value is added to the section including the collision position. Thus, for each section, the number of times calculated by the collision position calculation unit 21 is counted, and the counting result is calculated as a collision position distribution. In addition, when the number of counts reaches a predetermined number, the collision position distribution calculation unit 22 deletes old collision position data and counts new collision position data.

さらに、衝突確率演算部18は、算出した衝突位置分布に基づいて、自車両に対する相手車両の衝突確率を算出する。ここで、衝突確率演算部18は、区切られた各区画に衝突する確率として衝突確率を算出する。衝突確率演算部18は、算出した各区画に対する衝突確率を衝突確率補正・演算部20に出力する。   Furthermore, the collision probability calculation unit 18 calculates the collision probability of the opponent vehicle with respect to the host vehicle based on the calculated collision position distribution. Here, the collision probability calculation unit 18 calculates a collision probability as a probability of collision with each partitioned section. The collision probability calculation unit 18 outputs the calculated collision probability for each section to the collision probability correction / calculation unit 20.

また、衝突確率演算部18は、自車両軌道演算部12から出力される自車両軌跡、相手車両軌道演算部17から出力される相手車両軌跡、および相手車速演算部14から出力される相手車速に基づいて、自車両に対する相手車両の横速度である相手車両横速度を算出する。衝突確率演算部18は、算出した相手車両横速度を衝突確率補正・演算部20に出力する。衝突確率演算部18は、衝突確率算出手段を構成する。   Further, the collision probability calculation unit 18 determines the own vehicle trajectory output from the own vehicle trajectory calculation unit 12, the opponent vehicle trajectory output from the opponent vehicle track calculation unit 17, and the opponent vehicle speed output from the opponent vehicle speed calculation unit 14. Based on this, the opponent vehicle lateral speed which is the lateral speed of the opponent vehicle with respect to the own vehicle is calculated. The collision probability calculation unit 18 outputs the calculated opponent vehicle lateral speed to the collision probability correction / calculation unit 20. The collision probability calculation unit 18 constitutes a collision probability calculation unit.

画像処理部19は、画像センサ6から送信される画像に画像処理を施してエッジ検出を行う。また、画像処理部19は、検出したエッジに基づいて相手車両に対応する相手車両エッジを検出する。さらに、画像処理部19は、検出した相手車両エッジを衝突確率補正・演算部20に出力する。   The image processing unit 19 performs edge processing by performing image processing on the image transmitted from the image sensor 6. Further, the image processing unit 19 detects an opponent vehicle edge corresponding to the opponent vehicle based on the detected edge. Further, the image processing unit 19 outputs the detected opponent vehicle edge to the collision probability correction / calculation unit 20.

衝突確率補正・演算部20は、衝突確率演算部18から出力される衝突確率に対して、相手車両横位置演算部16から出力された相手車両横位置と画像処理部19から出力される相手車両エッジとの相対位置関係を検出する。衝突確率補正・演算部20は、相対位置関係検出手段を構成する。   The collision probability correction / calculation unit 20 corresponds to the collision probability output from the collision probability calculation unit 18 and the partner vehicle lateral position output from the partner vehicle lateral position calculation unit 16 and the partner vehicle output from the image processing unit 19. The relative positional relationship with the edge is detected. The collision probability correction / calculation unit 20 constitutes a relative positional relationship detection unit.

また、衝突確率補正・演算部20は、検出した相手車両横位置と相手車両エッジとの相対位置関係に基づいて、衝突確率の補正を行う。衝突確率補正・演算部20は、衝突確率補正手段を構成する。さらに、衝突確率演算部18から出力される相手車両横速度や相手車両エッジが同一の物体に属する確度であるエッジ確度を検出し、相手車両横速度やエッジ確度を用いた衝突確率の補正も行う。衝突確率補正・演算部20は、エッジ確度検出手段を構成する。   The collision probability correction / calculation unit 20 corrects the collision probability based on the detected relative positional relationship between the opponent vehicle lateral position and the opponent vehicle edge. The collision probability correction / calculation unit 20 constitutes a collision probability correction unit. Further, the opponent vehicle lateral velocity output from the collision probability calculation unit 18 and the edge accuracy which is the accuracy that the opponent vehicle edge belongs to the same object are detected, and the collision probability is corrected using the opponent vehicle lateral velocity and edge accuracy. . The collision probability correction / calculation unit 20 constitutes edge accuracy detection means.

衝突確率補正・演算部20は、補正した衝突確率に基づいて自車両における相手車両との衝突位置を演算によって予測する。衝突確率補正・演算部20は、演算した衝突位置に関する衝突確率に応じた衝突対応作動信号を衝突回避デバイスである警報装置31、衝突回避支援装置32、シートベルト制御装置33、シート位置制御装置34、ブレーキ制御装置35、およびエアバッグ制御装置36にそれぞれ出力する。   The collision probability correction / calculation unit 20 predicts the collision position of the own vehicle with the opponent vehicle based on the corrected collision probability. The collision probability correction / calculation unit 20 outputs a collision response operation signal corresponding to the calculated collision probability relating to the collision position to an alarm device 31, which is a collision avoidance device, a collision avoidance support device 32, a seat belt control device 33, and a seat position control device 34. , Output to the brake control device 35 and the airbag control device 36, respectively.

警報装置31は、警告音を発するスピーカおよびスピーカを制御するスピーカ制御装置、警報を表示するモニタおよびモニタ制御装置を備えている。警報装置31は、衝突確率補正・演算部20から出力された衝突対応作動信号に基づいて、スピーカから発生させる警告音およびモニタに表示する警報をそれぞれスピーカ制御装置およびモニタ制御装置で生成して、それぞれスピーカに発生させ、モニタに表示させる。   The alarm device 31 includes a speaker that emits a warning sound, a speaker control device that controls the speaker, a monitor that displays an alarm, and a monitor control device. Based on the collision response operation signal output from the collision probability correction / calculation unit 20, the alarm device 31 generates an alarm sound generated from the speaker and an alarm to be displayed on the monitor by the speaker control device and the monitor control device, respectively. Each is generated on a speaker and displayed on a monitor.

衝突回避支援装置32は、自動操舵制御装置および自動操舵装置を備えている。衝突回避支援装置32は、自動操舵制御装置において、衝突確率補正・演算部20から出力された衝突対応作動信号に基づいて、衝突を回避し、または衝突による衝撃を緩和するための自動操舵装置における操舵方向および操舵量を算出する。衝突回避支援装置32は、自動操舵制御装置によって算出した操舵方向および操舵量に基づいて、自動操舵装置を制御する。   The collision avoidance assistance device 32 includes an automatic steering control device and an automatic steering device. The collision avoidance assisting device 32 is an automatic steering control device that is based on the collision response operation signal output from the collision probability correction / calculation unit 20 and is used in an automatic steering device for avoiding a collision or alleviating an impact caused by a collision. A steering direction and a steering amount are calculated. The collision avoidance assistance device 32 controls the automatic steering device based on the steering direction and the steering amount calculated by the automatic steering control device.

シートベルト制御装置33は、シートベルトの締付力を制御している。シートベルト制御装置33は、衝突確率補正・演算部20から出力された衝突対応作動信号に基づいて、シートベルトの締付力を算出し、必要に応じてシートベルトに締付力を付加する。   The seat belt control device 33 controls the tightening force of the seat belt. The seat belt control device 33 calculates the tightening force of the seat belt based on the collision response operation signal output from the collision probability correction / calculation unit 20, and adds the tightening force to the seat belt as necessary.

シート位置制御装置34は、車両のシート位置を自動的に調整するシート位置移動装置の制御を行う。シート位置制御装置34は、衝突確率補正・演算部20から出力された衝突対応作動信号に基づいて、衝突による乗員への衝撃を緩和するためのシート位置を算出する。シート位置制御装置34は、算出したシート位置に基づいて、シート位置移動装置の制御を行う。   The seat position control device 34 controls a seat position moving device that automatically adjusts the seat position of the vehicle. The seat position control device 34 calculates a seat position for alleviating the impact on the occupant due to the collision based on the collision response operation signal output from the collision probability correction / calculation unit 20. The sheet position control device 34 controls the sheet position moving device based on the calculated sheet position.

ブレーキ制御装置35は、自動的にブレーキを制御して車両減速力を付与するものである。ブレーキ制御装置35は、衝突確率補正・演算部20から出力された衝突対応作動信号に基づいて、車両に付与する減速力を算出し、算出した減速力に基づいて、ブレーキを制御する。   The brake control device 35 automatically controls the brake to give a vehicle deceleration force. The brake control device 35 calculates a deceleration force to be applied to the vehicle based on the collision response operation signal output from the collision probability correction / calculation unit 20, and controls the brake based on the calculated deceleration force.

エアバッグ制御装置36は、エアバッグの展開およびその展開準備を制御している。エアバッグ制御装置36は、衝突確率補正・演算部20から出力された衝突対応作動信号に基づいて、エアバッグを展開させるかまたはその展開準備を行わせるかを決定し、その決定に基づいてエアバッグを制御する。   The airbag control device 36 controls the deployment of the airbag and its deployment preparation. The airbag control device 36 determines whether the airbag is to be deployed or prepared for deployment based on the collision response operation signal output from the collision probability correction / calculation unit 20, and based on the determination, the airbag control device 36 Control the bag.

続いて、本実施形態に係る衝突予測装置の制御手順について説明する。図2は、本実施形態に係る衝突予測装置の制御手順を示すフローチャートである。   Subsequently, a control procedure of the collision prediction apparatus according to the present embodiment will be described. FIG. 2 is a flowchart showing a control procedure of the collision prediction apparatus according to the present embodiment.

図2に示すように、衝突予測ECU1では、まず、ミリ波レーダセンサ5から出力された反射波情報に基づいて、相手車両情報を取得する(S1)。具体的には、相手車速演算部14において相手車速を算出するとともに、相手車両移動距離演算部15において、相手車両移動距離を算出する。さらには、相手車両横位置演算部16において、相手車両横位置を算出する。   As shown in FIG. 2, the collision prediction ECU 1 first acquires opponent vehicle information based on the reflected wave information output from the millimeter wave radar sensor 5 (S1). Specifically, the opponent vehicle speed calculation unit 14 calculates the opponent vehicle speed, and the opponent vehicle movement distance calculation unit 15 calculates the opponent vehicle movement distance. Further, the opponent vehicle lateral position calculation unit 16 calculates the opponent vehicle lateral position.

次に、推定カーブ半径の算出を行う(S2)。推定カーブ半径の算出は、推定カーブ半径演算部11において、操舵角センサ2から出力された操舵角情報およびヨーレートセンサ3から出力されたヨーレート情報に基づいて行われる。推定カーブ半径の算出が済んだら、自車速の算出を行う(S3)。自車速の算出は、自車速演算部13において、車輪速センサ4から出力された車輪速情報に基づいて行われる。自車速の算出が済んだら、自車両軌道線を算出する(S4)。自車両軌道線の算出は、自車両軌道演算部12において、推定カーブ半径演算部11から出力された推定カーブ半径に基づいて行われる。   Next, an estimated curve radius is calculated (S2). The estimated curve radius is calculated by the estimated curve radius calculation unit 11 based on the steering angle information output from the steering angle sensor 2 and the yaw rate information output from the yaw rate sensor 3. After the calculation of the estimated curve radius, the vehicle speed is calculated (S3). The calculation of the host vehicle speed is performed by the host vehicle speed calculation unit 13 based on the wheel speed information output from the wheel speed sensor 4. After the calculation of the host vehicle speed, the host vehicle track line is calculated (S4). The calculation of the own vehicle track line is performed in the own vehicle track calculation unit 12 based on the estimated curve radius output from the estimated curve radius calculation unit 11.

自車両軌道線の算出が済んだら、相手車両軌道線を算出する(S5)。相手車両軌道線は、相手車両軌道演算部17において、相手車両移動距離演算部15から出力される相手車両移動距離および相手車両横位置演算部16から出力される相手車両横位置に基づいて算出される。相手車両軌道線は、複数の相手車両横位置を用いて行われる。このため、相手車両軌道線を算出する際には、相手車両横位置が複数必要となる。相手車両軌道演算部17では、相手車両横位置演算部16から出力される相手車両横位置を記憶しておき、相手車両横位置が複数揃った際に相手車両軌道線の算出を開始する。複数の相手車両横位置が揃って複数の相手車両横位置が求められたら、これらの複数の相手車両横位置から最小二乗法などを用いて直線回帰を行って相手車両軌道線を算出する。   When the calculation of the own vehicle track line is completed, the opponent vehicle track line is calculated (S5). The opponent vehicle trajectory line is calculated in the opponent vehicle trajectory calculation unit 17 based on the opponent vehicle movement distance output from the opponent vehicle movement distance calculation unit 15 and the opponent vehicle lateral position output from the opponent vehicle lateral position calculation unit 16. The The opponent vehicle track line is performed using a plurality of opponent vehicle lateral positions. For this reason, when calculating the opponent vehicle track line, a plurality of opponent vehicle lateral positions are required. The opponent vehicle trajectory calculation unit 17 stores the opponent vehicle lateral position output from the opponent vehicle lateral position calculation unit 16, and starts calculating the opponent vehicle track line when a plurality of opponent vehicle lateral positions are arranged. When a plurality of opponent vehicle lateral positions are obtained and a plurality of opponent vehicle lateral positions are obtained, an opponent vehicle track line is calculated by performing linear regression from the plurality of opponent vehicle lateral positions using a least square method or the like.

続いて、衝突確率演算部18において自車両と相手車両との衝突確率を算出する(S6)。衝突確率を算出するにあたり、まず、衝突位置演算部21において、自車速演算部13から出力される自車速および相手車速演算部14から出力される相手車速、さらには自車両軌道演算部12から出力される自車両軌道および相手車両軌道演算部17から出力される相手車両軌道に基づいて、自車両の幅方向に対する相手車両の衝突位置が、予め区切られた複数の区画のうちどの区画に含まれるかを算出する。次に、所定時間、たとえば10ms後に同様の処理を経て相手車両の衝突位置が含まれる区画を算出する。   Subsequently, the collision probability calculation unit 18 calculates the collision probability between the host vehicle and the opponent vehicle (S6). In calculating the collision probability, first, the collision position calculation unit 21 outputs the own vehicle speed output from the own vehicle speed calculation unit 13, the opponent vehicle speed output from the opponent vehicle speed calculation unit 14, and further output from the own vehicle track calculation unit 12. The collision position of the opponent vehicle with respect to the width direction of the own vehicle is included in any of a plurality of divisions divided in advance based on the own vehicle track and the opponent vehicle track output from the opponent vehicle track calculation unit 17. Calculate. Next, a section including the collision position of the opponent vehicle is calculated through a similar process after a predetermined time, for example, 10 ms.

以後、同様に相手車両の衝突位置が含まれる区画を算出し、相手車両の衝突位置が含まれる区画を複数求める。次に、衝突位置分布演算部22において、衝突位置演算部21で求めた相手車両の衝突位置が含まれる区画に衝突位置計数値を加算して、衝突位置分布を算出する。   Thereafter, similarly, a section including the collision position of the opponent vehicle is calculated, and a plurality of sections including the collision position of the opponent vehicle are obtained. Next, the collision position distribution calculation unit 22 calculates the collision position distribution by adding the collision position count value to the section including the collision position of the opponent vehicle obtained by the collision position calculation unit 21.

ここで、図3に衝突位置分布の例を示す。図3に示す例では、自車両Xに対して、15個の衝突位置計数値が加算されており、第1区画D1〜第5区画D5のうち、第2区画D3に3個の衝突位置計数値が加算され、第3区画D3の8個の衝突位置計数値が加算され、第4区画D4に4個の衝突位置計数値が加算されている。   Here, FIG. 3 shows an example of the collision position distribution. In the example shown in FIG. 3, 15 collision position count values are added to the host vehicle X, and among the first section D1 to the fifth section D5, three collision position meters are arranged in the second section D3. Numerical values are added, eight collision position count values of the third section D3 are added, and four collision position count values are added to the fourth section D4.

こうして衝突位置分布を算出したら、衝突位置分布に基づいて衝突確率を算出する。ここで算出する衝突確率は、衝突位置計数値が大きい区画ほど、衝突確率が高くなる数値として算出する。   After the collision position distribution is calculated in this way, the collision probability is calculated based on the collision position distribution. The collision probability calculated here is calculated as a numerical value that increases the collision probability in a section having a larger collision position count value.

衝突確率の算出が済んだら、衝突確率演算部18は、自車両軌道、相手車両軌道、および相手車速に基づいて、相手車両横速度を算出し、衝突確率補正・演算部20に出力する。その後、衝突確率補正・演算部20において、衝突確率演算部18で算出した衝突確率を補正する(S7)。衝突確率の補正を行う際には、衝突確率演算部18から出力される衝突確率に対して、相手車両横位置演算部16から出力される相手車両横位置および画像処理部19から出力される相手車両エッジ、さらには衝突確率演算部18から出力される相手車両横速度等から算出される相手車両横位置と相手車両エッジとの相対位置関係に基づく補正処理を行う。補正処理については後に説明する。   After the calculation of the collision probability, the collision probability calculation unit 18 calculates the partner vehicle lateral speed based on the host vehicle track, the partner vehicle track, and the partner vehicle speed, and outputs it to the collision probability correction / calculation unit 20. Thereafter, the collision probability correction / calculation unit 20 corrects the collision probability calculated by the collision probability calculation unit 18 (S7). When correcting the collision probability, the opponent vehicle lateral position output from the opponent vehicle lateral position calculator 16 and the opponent output from the image processor 19 are compared with the collision probability output from the collision probability calculator 18. A correction process is performed based on the relative positional relationship between the opponent vehicle lateral position and the opponent vehicle edge calculated from the vehicle edge and, further, the opponent vehicle lateral velocity output from the collision probability calculation unit 18. The correction process will be described later.

補正処理が済んだら、自車両が相手車両に衝突するか否かを判断する(S8)。この判断は、各区画にそれぞれ設定された所定のしきい値を、各区画における衝突位置計数値が超えているか否かによって行われる。ただし、この衝突判定は種々の態様で行うことができる。また、衝突位置計数値によって衝突位置をも判断している。   When the correction process is completed, it is determined whether or not the own vehicle collides with the opponent vehicle (S8). This determination is made based on whether or not the collision position count value in each section exceeds a predetermined threshold value set in each section. However, this collision determination can be performed in various ways. Further, the collision position is also determined from the collision position count value.

その結果、自車両が相手車両に衝突すると判断した場合には、衝突対応作動信号を衝突回避デバイスに送信して、衝突回避デバイスを作動させる(S9)。衝突対応作動信号には、衝突位置情報が添付されている。衝突回避デバイスを作動させるにあたり、具体的には、衝突位置情報に対応する区画に衝突するという警報を警報装置31から発生させたり、衝突位置情報に対応する区画に近い側のシートベルトの締付力が強くなるようにシートベルト制御装置33を作動させたりする。そして、衝突予測装置による処理を終了する。一方、ステップS8において、自車両が相手車両に衝突しないと判断した場合には、そのまま衝突予測装置による処理を終了する。   As a result, when it is determined that the host vehicle collides with the opponent vehicle, a collision response operation signal is transmitted to the collision avoidance device to activate the collision avoidance device (S9). Collision position information is attached to the collision response operation signal. Specifically, when the collision avoidance device is operated, an alarm is issued from the alarm device 31 that the vehicle collides with the section corresponding to the collision position information, or the seat belt on the side close to the section corresponding to the collision position information is tightened. The seat belt control device 33 is operated so that the force becomes stronger. And the process by a collision prediction apparatus is complete | finished. On the other hand, if it is determined in step S8 that the host vehicle does not collide with the opponent vehicle, the process by the collision prediction device is terminated as it is.

それでは、ステップS7における相手車両横位置と相手車両エッジとの相対位置関係に基づく補正処理について図4〜図6を参照して説明する。図4(a)〜(c)、および図5(a),(b)は、いずれも自車両と相手車両との位置関係およびミリ波レーダセンサ5と画像センサ6とのそれぞれにおける検出結果を模式的に示す図である。また、図6(a)〜(c)は、いずれも衝突確率の補正を行う際の補正割合を示すマップである。   Now, the correction process based on the relative positional relationship between the opponent vehicle lateral position and the opponent vehicle edge in step S7 will be described with reference to FIGS. 4 (a) to 4 (c) and FIGS. 5 (a) and 5 (b) show the positional relationship between the own vehicle and the partner vehicle and the detection results in the millimeter wave radar sensor 5 and the image sensor 6, respectively. It is a figure shown typically. FIGS. 6A to 6C are maps each showing a correction ratio when the collision probability is corrected.

補正処理を行うにあたり、相手車両エッジの位置である相手車両エッジ位置および幅方向長さである相手車両エッジ幅を算出する。次に、相手車両横位置と相手車両エッジとを比較し、相手車両エッジに対する相手車両横位置の位置を算出する。この相手車両エッジに対する相手車両横位置の位置と、相手車両エッジ幅とに基づいて、衝突確率の補正を行う。衝突確率の補正は、具体的には以下のように行われる。   In performing the correction process, the opponent vehicle edge position that is the position of the opponent vehicle edge and the opponent vehicle edge width that is the length in the width direction are calculated. Next, the opponent vehicle lateral position is compared with the opponent vehicle edge, and the position of the opponent vehicle lateral position with respect to the opponent vehicle edge is calculated. The collision probability is corrected based on the position of the opponent vehicle lateral position with respect to the opponent vehicle edge and the opponent vehicle edge width. Specifically, the collision probability is corrected as follows.

図4(a)に示すように、画像センサ6で検出される相手車両エッジEが自車両Xの正面に検出され、ミリ波レーダセンサ5で検出される相手車両横位置Pが、相手車両エッジEの幅方向略中央に位置していたとする。この場合には、ミリ波レーダセンサ5および画像センサ6によって、相手車両Yを正確に検出できていると考えられる。また、相手車両横位置Pが、相手車両エッジEの中央に近いほど、画像センサ6による検出精度が高いと考えられる。したがって、自車両Xに対する相手車両Yの衝突確率が高くなると考えられるので、衝突確率が高くなるように補正する。   As shown in FIG. 4A, the opponent vehicle edge E detected by the image sensor 6 is detected in front of the host vehicle X, and the opponent vehicle lateral position P detected by the millimeter wave radar sensor 5 is the opponent vehicle edge. It is assumed that it is located at approximately the center in the width direction of E. In this case, it is considered that the opponent vehicle Y can be accurately detected by the millimeter wave radar sensor 5 and the image sensor 6. Further, it is considered that the detection accuracy by the image sensor 6 is higher as the opponent vehicle lateral position P is closer to the center of the opponent vehicle edge E. Therefore, since it is considered that the collision probability of the opponent vehicle Y with respect to the own vehicle X is increased, the correction is performed so that the collision probability is increased.

ここで、衝突確率を補正する際には、図6(a)に示すマップを用いることができる。図6(a)に示すマップは、相手車両横位置の相手車両エッジEにおける幅方向の位置と、衝突確率補正値との関係を示している。このマップでは、相手車両横位置が相手車両エッジにおける中央からその近傍範囲において、衝突確率上げ幅を大きくしている。この範囲よりも左右外側の一部の範囲では、端部に移行するほど徐々に上げ幅が小さくなるように衝突確率上げ幅を規定している。さらに、この範囲よりも左右外側の範囲では、衝突確率上げ幅を所定の基準値とするようにしている。このように衝突確率上げ幅を規定することにより、精度の高い衝突確率を算出することができる。   Here, when correcting the collision probability, a map shown in FIG. 6A can be used. The map shown in FIG. 6A shows the relationship between the position in the width direction of the opponent vehicle edge E at the opponent vehicle lateral position and the collision probability correction value. In this map, the collision probability increase range is increased in the range from the center of the opponent vehicle edge to the vicinity of the opponent vehicle edge. In a part of the range on the outer left and right sides of this range, the collision probability increase width is defined so that the increase width gradually decreases as it moves to the end. Further, in the range on the left and right sides of this range, the collision probability increase width is set to a predetermined reference value. By defining the collision probability increase range in this way, a highly accurate collision probability can be calculated.

また、図4(b)に示すように、画像センサ6による検出の際、相手車両Yのほか、相手車両Yと自車両Xとの間にある物体Zを含めて、相手車両Yと物体Zとで一体の物体であると誤検出することがある。この誤検出の例では、画像センサ6によって相手車両Yと物体Zとで一体の物体と検出するとともに、ミリ波レーダセンサ5で物体Zを相手車両Yと誤検出している。   In addition, as shown in FIG. 4B, in the detection by the image sensor 6, in addition to the opponent vehicle Y, the opponent vehicle Y and the object Z including the object Z between the opponent vehicle Y and the own vehicle X are included. May be erroneously detected as an integrated object. In this example of erroneous detection, the image sensor 6 detects that the opponent vehicle Y and the object Z are an integrated object, and the millimeter wave radar sensor 5 erroneously detects the object Z as the opponent vehicle Y.

相手車両Yと物体Zとで一体の物体であると誤検出した場合、相手車両エッジEの端部に相手車両横位置Pが検出された状態となっている。このような状況となる例としては、たとえば自車両がカーブを走行中に道路の側方に位置する建物や標識などを相手車両と一体物として判断する状況などがある。   When the partner vehicle Y and the object Z are erroneously detected as an integrated object, the partner vehicle lateral position P is detected at the end of the partner vehicle edge E. As an example of such a situation, there is, for example, a situation in which a building or a sign located on the side of the road is judged as an integrated object with the opponent vehicle while the host vehicle is traveling on a curve.

この場合、相手車両エッジEが相手車両Yと異なる位置に発生してしまう。この際、実際には相手車両Yに衝突するまでにはまだ距離があるにもかかわらず、衝突確率が高いと判断されてしまうこととなる。その結果、実際には相手車両Yとの衝突確率が高くないものの、衝突回避デバイスが作動してしまうこととなる。   In this case, the opponent vehicle edge E occurs at a position different from that of the opponent vehicle Y. At this time, it is determined that the collision probability is high even though there is still a distance until the vehicle actually collides with the opponent vehicle Y. As a result, although the collision probability with the opponent vehicle Y is not actually high, the collision avoidance device is activated.

そこで、図4(b)に示すような誤検出の可能性がある場合には、衝突確率を低くするように補正する。このように、相手車両エッジEの端部に相手車両横位置Pが検出された状態となっている場合に衝突確率が低くなるように補正することにより、衝突回避デバイスの早期作動を防止することができる。   Therefore, when there is a possibility of erroneous detection as shown in FIG. 4B, the collision probability is corrected to be lowered. In this way, when the opponent vehicle lateral position P is detected at the end of the opponent vehicle edge E, the collision avoidance device is prevented from operating early by correcting the collision probability to be low. Can do.

さらに、図4(c)に示すように、画像センサ6による検出の際、自車両Xの前方両側方にある物体Z1,Z2を相手車両Yと誤検出することがある。この誤検出の例では、画像センサ6によって物体Z1,Z2を相手車両と誤検出するとともに、ミリ波レーダセンサ5で第1物体Z1を相手車両と誤検出している。   Further, as shown in FIG. 4C, the objects Z1 and Z2 on both sides of the front side of the host vehicle X may be erroneously detected as the partner vehicle Y when detected by the image sensor 6. In this erroneous detection example, the image sensor 6 erroneously detects the objects Z1 and Z2 as the counterpart vehicle, and the millimeter wave radar sensor 5 erroneously detects the first object Z1 as the counterpart vehicle.

自車両Xの前方両側方の物体Z1,Z2を相手車両と誤検出した場合、実際には相手車両が存在しないものの、相手車両エッジEが物体Z1,Z2の間に発生してしまう。この場合には、実際には衝突の対象となる相手車両Yが存在しない。また、物体Z1,Z2との関係においても、自車両Xが物体Z1,Z2の間を通り抜けることができるにもかかわらず、衝突確率が高いと判断されてしまうこととなる。その結果、実際には相手車両Yとの衝突確率が高くないものの、衝突回避デバイスが作動してしまうこととなる。   When the objects Z1 and Z2 on both front sides of the host vehicle X are erroneously detected as the partner vehicle, the partner vehicle edge E is generated between the objects Z1 and Z2, although the partner vehicle does not actually exist. In this case, there is actually no opponent vehicle Y to be a collision target. Further, regarding the relationship with the objects Z1 and Z2, even though the host vehicle X can pass between the objects Z1 and Z2, it is determined that the collision probability is high. As a result, although the collision probability with the opponent vehicle Y is not actually high, the collision avoidance device is activated.

そこで、図4(c)に示すような誤検出の可能性がある場合には、衝突確率を低くするように補正する。このように、自車両Xの前方両側方の物体Z1,Z2を相手車両と誤検出した場合に衝突確率が低くなるように補正することにより、衝突回避デバイスの早期作動を防止することができる。   Therefore, when there is a possibility of erroneous detection as shown in FIG. 4C, correction is performed so as to reduce the collision probability. In this way, by correcting the collision probability of the objects Z1 and Z2 on both sides ahead of the host vehicle X so that the collision probability is low when the vehicle is erroneously detected, the early operation of the collision avoidance device can be prevented.

さらに、図4(a)の例のように、相手車両横位置Pが相手車両エッジEの中央に近い場合には、複数のエッジが同一の物体の属する確度であるエッジ確度が高くなる。その一方、図4(b),(c)の例に見られるように、相手車両横位置Pが相手車両エッジEの中央から遠い(端部に近い)場合には、複数のエッジが同一の物体の属する確度であるエッジ確度が低くなる。そこで、たとえば相手車両横位置Pが相手車両エッジEの中央からの離反距離をエッジ確度とし、このエッジ確度に応じて衝突確率を補正することもできる。かかる補正態様によっても、自車両Xに対する相手車両Yの衝突確率を算出するにあたり、精度の高い衝突確率を算出することができる。   Furthermore, when the opponent vehicle lateral position P is close to the center of the opponent vehicle edge E as in the example of FIG. 4A, the edge accuracy, which is the accuracy to which the same object belongs, is increased. On the other hand, as shown in the examples of FIGS. 4B and 4C, when the opponent vehicle lateral position P is far from the center of the opponent vehicle edge E (close to the end), the plurality of edges are the same. The edge accuracy, which is the accuracy to which the object belongs, is lowered. Therefore, for example, the distance from the center of the opponent vehicle edge E to the opponent vehicle lateral position P can be used as the edge accuracy, and the collision probability can be corrected according to the edge accuracy. According to such a correction mode, when calculating the collision probability of the opponent vehicle Y with respect to the host vehicle X, it is possible to calculate a highly accurate collision probability.

また、図5(a)に示すように、相手車両Yが自車両Xの前側方に位置することがあり、この場合には、自車両Xに対して相手車両Yがオフセット衝突をする可能性が高い場合がある。図5(a)に示す例では自車両Xの左前方に相手車両Yが位置しており、画像センサ6で検出される相手車両エッジEには、自車両Xに近い側の端部(以下「近側端部」という)と遠い側の端部(以下「遠側端部」という)がある。また、相手車両横位置Pは相手車両エッジEの上に位置しており、ミリ波レーダセンサ5および画像センサ6における検出は正常であったと考えられる。   In addition, as shown in FIG. 5A, the opponent vehicle Y may be located in front of the host vehicle X. In this case, the opponent vehicle Y may have an offset collision with the host vehicle X. May be expensive. In the example shown in FIG. 5 (a), the opponent vehicle Y is located on the left front side of the host vehicle X. The opponent vehicle edge E detected by the image sensor 6 has an end portion on the side close to the host vehicle X (hereinafter, referred to as the partner vehicle Y). There is a “near end” and a far end (hereinafter “far end”). Further, the opponent vehicle lateral position P is located on the opponent vehicle edge E, and it is considered that the detection by the millimeter wave radar sensor 5 and the image sensor 6 was normal.

この場合、相手車両横位置Pが相手車両エッジEの近側端部の近傍に位置する場合、相手車両エッジEの遠側端部に位置する場合よりも衝突する可能性は高いと考えられる。また、相手車両横位置Pが相手車両エッジEの遠側端部の近傍に位置する場合には、相手車両Yは、自車両Xとの衝突しない位置を走行している可能性も高くなると考えられる。そこで、本実施形態では、相手車両横位置Pが相手車両エッジEの近側端部の近傍に位置する場合、相手車両エッジEの遠側端部に位置する場合よりも衝突確率が高くなるように衝突確率を補正する。   In this case, when the opponent vehicle lateral position P is located in the vicinity of the near-side end portion of the opponent vehicle edge E, it is considered that the possibility of a collision is higher than that in the case of being located at the far-side end portion of the opponent vehicle edge E. Further, when the opponent vehicle lateral position P is located in the vicinity of the far end of the opponent vehicle edge E, it is considered that the opponent vehicle Y is more likely to travel in a position where it does not collide with the own vehicle X. It is done. Therefore, in the present embodiment, when the opponent vehicle lateral position P is located in the vicinity of the near end of the opponent vehicle edge E, the collision probability is higher than when it is located at the far end of the opponent vehicle edge E. The collision probability is corrected.

さらに、図4(b)に示すように、自車両Xの前側方に物体Zが存在する場合、物体Zを相手車両Yとして誤検出し、図5(a)に示すように、相手車両エッジEを検出してしまうことが考えられる。ただし、この場合には、ミリ波レーダセンサ5は、物体Zを検出することから、相手車両横位置Pが相手車両エッジEの近側端部の近傍以外の位置に検出されることもあると考えられる。このため、相手車両横位置Pが相手車両エッジEの遠側端部の近傍に位置する場合、衝突確率上げ幅が所定の基準値よりも小さくなるように衝突確率を補正する。   Further, as shown in FIG. 4B, when the object Z is present on the front side of the host vehicle X, the object Z is erroneously detected as the partner vehicle Y, and as shown in FIG. It is conceivable that E is detected. However, in this case, since the millimeter wave radar sensor 5 detects the object Z, the opponent vehicle lateral position P may be detected at a position other than the vicinity of the near end of the opponent vehicle edge E. Conceivable. For this reason, when the opponent vehicle lateral position P is located in the vicinity of the far end of the opponent vehicle edge E, the collision probability is corrected so that the collision probability increase width is smaller than a predetermined reference value.

具体的に、衝突確率を補正する際のマップとして、たとえば図6(b)に示すマップを用いることができる。図6(b)に示すマップでは、相手車両横位置が相手車両エッジEにおける幅方向中央からその近傍範囲において衝突確率上げ幅を大きくしている。また、この範囲よりも近側端部側および遠側端部側の一部の範囲では、端部に移行するほど徐々に上げ幅が小さくなるように衝突確率上げ幅を規定している。さらに、この範囲よりも近外側端部側の範囲では、衝突確率上げ幅を所定の基準値とするようにしている。   Specifically, for example, a map shown in FIG. 6B can be used as a map for correcting the collision probability. In the map shown in FIG. 6B, the collision probability increase range is increased in the range from the center in the width direction of the opponent vehicle edge E to the vicinity thereof. Further, in a partial range on the near side end portion side and the far side end portion side than this range, the collision probability increase width is defined so that the increase width gradually decreases as the position shifts to the end portion. Further, in the range closer to the outer end than this range, the collision probability increase width is set to a predetermined reference value.

また、衝突確率上げ幅を大きくしている範囲よりも遠側端部側では、近側端部側よりも衝突確率の上げ幅が徐々に小さくなる範囲が広くされている。さらには、遠側端部側の一部の範囲では、衝突確率上げ幅が所定の基準値よりも小さくなる値とされている。このように衝突確率上げ幅を規定することによって、さらに精度の高い衝突確率を算出することができる。しかも、オフセット衝突を生じる可能性がある場合に、衝突確率を低く見積もりすぎることを防止することができる。   Further, the far end end side is wider in the range where the collision probability increase range is gradually smaller than the near end side than the range in which the collision probability increase range is increased. Further, in a part of the range on the far end side, the collision probability increase width is set to a value smaller than a predetermined reference value. By defining the collision probability increase range in this way, it is possible to calculate a collision probability with higher accuracy. In addition, when there is a possibility of causing an offset collision, it is possible to prevent the collision probability from being estimated too low.

さらに、図5(b)に示すように、相手車両Yが自車両Xの前側方に位置することがあり、また、相手車両Yが自車両Xの方向に向けた横速度成分を有している場合がある。この場合、図5(b)に示す例では自車両Xの左方向から相手車両Yが横速を持って接近しており、相手車両エッジEには、近側端部と遠側端部とがある。ここで、相手車両横位置Pが相手車両エッジEにおける遠側端部に位置するとき、図5(b)に示すように、相手車両Yが横速度成分を有して自車両Xに接近している場合と、図4(b)に示すように、自車両Xの側方における不動の物体Zを相手車両Yと誤検出してしまう場合とがある。ここのとき、検出された相手車両Yに対応する相手車両横位置Pが横速度成分を有している場合には相手車両Yであり、相手車両横位置Pが横速度成分を有していない場合には相手車両Yと誤検出された物体Zであると考えられる。   Further, as shown in FIG. 5B, the opponent vehicle Y may be located in front of the host vehicle X, and the opponent vehicle Y has a lateral velocity component directed toward the host vehicle X. There may be. In this case, in the example shown in FIG. 5B, the opponent vehicle Y approaches from the left direction of the host vehicle X with a lateral speed, and the opponent vehicle edge E includes a near end and a far end. There is. Here, when the opponent vehicle lateral position P is located at the far end of the opponent vehicle edge E, the opponent vehicle Y approaches the host vehicle X with a lateral velocity component as shown in FIG. In some cases, the stationary object Z on the side of the host vehicle X is erroneously detected as the opponent vehicle Y, as shown in FIG. At this time, if the partner vehicle lateral position P corresponding to the detected partner vehicle Y has a lateral speed component, it is the partner vehicle Y, and the partner vehicle lateral position P does not have a lateral speed component. In this case, it is considered that the object Z is erroneously detected as the opponent vehicle Y.

そこで、相手車両横位置Pが相手車両エッジEの遠側端部の近傍に位置するとき、相手車両横位置Pが横速度成分を有している場合には、横速度成分を有していない場合よりも衝突確率が高くなるように衝突確率を補正する。具体的に、衝突確率を補正する際には、相手車両横位置Pが横速度成分を有していないときには図6(a)に示すマップを参照するとした場合、相手車両横位置Pが横速度成分を有しているときには図6(c)に示す
マップを参照するようにする。
Therefore, when the opponent vehicle lateral position P is located in the vicinity of the far side end of the opponent vehicle edge E, the opponent vehicle lateral position P does not have a lateral velocity component if it has a lateral velocity component. The collision probability is corrected so that the collision probability is higher than the case. Specifically, when correcting the collision probability, if the opponent vehicle lateral position P does not have a lateral velocity component and the map shown in FIG. When it has a component, the map shown in FIG. 6C is referred to.

図6(c)に示すマップでは、相手車両横位置が相手車両エッジEにおける幅方向中央からその近傍範囲において衝突確率上げ幅を大きくしている。また、この範囲よりも近側端部側および遠側端部側の一部の範囲では、端部に移行するほど徐々に上げ幅が小さくなるように衝突確率上げ幅を規定している。さらに、この範囲よりも近外側端部側の範囲では、衝突確率上げ幅を所定の基準値とするようにしている。   In the map shown in FIG. 6C, the collision probability increase range is increased in the range from the center in the width direction of the opponent vehicle edge E to the vicinity of the opponent vehicle edge E. Further, in a partial range on the near side end portion side and the far side end portion side than this range, the collision probability increase width is defined so that the increase width gradually decreases as the position shifts to the end portion. Further, in the range closer to the outer end than this range, the collision probability increase width is set to a predetermined reference value.

また、衝突確率上げ幅を大きくしている範囲よりも遠側端部側では、近側端部側よりも衝突確率の上げ幅が徐々に小さくなる範囲が狭くされている。さらには、遠側端部側の一部の範囲では、衝突確率上げ幅が所定の基準値よりも大きくなる値とされている。このように衝突確率上げ幅を規定することによって、相手車両横位置Pが相手車両エッジEにおける遠側端部に位置する場合における自車両Xに対する相手車両Yの衝突確率を低く見積もりすぎることを防止することができる。そして、自車両Xに対する相手車両Yの衝突確率をさらに精度よく判定することができる。   Further, the far side end portion side is narrower in the range where the collision probability increase width is gradually smaller than the near side end portion side than the range in which the collision probability increase width is increased. Furthermore, in a part of the range on the far side end side, the collision probability increase width is set to a value larger than a predetermined reference value. By defining the collision probability increase range in this way, it is possible to prevent the collision probability of the opponent vehicle Y against the own vehicle X from being excessively low when the opponent vehicle lateral position P is located at the far end of the opponent vehicle edge E. be able to. And the collision probability of the other vehicle Y with respect to the own vehicle X can be determined still more accurately.

以上、本発明の好適な実施形態について説明したが、本発明は上記実施形態に限定されるものではない。たとえば、上記実施形態では、レーダセンサとしてミリ波レーダセンサを用いているが、レーザレーダセンサなど、他のレーダセンサを用いることができる。また、上記実施形態では、衝突位置の判定を行う際に衝突位置の判定も行っているが、単に衝突判定のみを行う態様とすることもできる。   The preferred embodiment of the present invention has been described above, but the present invention is not limited to the above embodiment. For example, in the above embodiment, a millimeter wave radar sensor is used as the radar sensor, but other radar sensors such as a laser radar sensor can be used. In the above-described embodiment, the collision position is also determined when the collision position is determined. However, it is also possible to simply perform the collision determination.

本発明に係る衝突予測装置の構成を示すブロック構成図である。It is a block block diagram which shows the structure of the collision prediction apparatus which concerns on this invention. 衝突予測装置の制御手順を示すフローチャートである。It is a flowchart which shows the control procedure of a collision prediction apparatus. 自車両における衝突位置分布を示す模式的平面図である。It is a typical top view which shows the collision position distribution in the own vehicle. (a)〜(c)とも、自車両と相手車両との位置関係およびミリ波レーダセンサと画像センサのそれぞれにおける検出結果を模式的に示す図である。(A)-(c) is a figure which shows typically the positional relationship of the own vehicle and the other party vehicle, and the detection result in each of a millimeter wave radar sensor and an image sensor. (a),(b)とも、自車両と相手車両との位置関係およびミリ波レーダセンサと画像センサのそれぞれにおける検出結果を模式的に示す図である。(A), (b) is a figure which shows typically the positional relationship of the own vehicle and the other party vehicle, and the detection result in each of a millimeter wave radar sensor and an image sensor. (a)〜(c)は、いずれも衝突確率の補正を行う際の補正割合を示すマップである。(A)-(c) is a map which shows the correction | amendment ratio at the time of performing correction | amendment of a collision probability all.

符号の説明Explanation of symbols

1…衝突予測ECU、2…操舵角センサ、3…ヨーレートセンサ、4…車輪速センサ、5…ミリ波レーダセンサ、6…画像センサ、11…推定カーブ半径演算部、12…自車両軌道演算部、13…自車速演算部、14…相手車速演算部、15…相手車両移動距離演算部、16…相手車両横位置演算部、17…相手車両軌道演算部、18…衝突確率演算部、19…画像処理部、20…衝突確率補正・演算部、21…衝突位置演算部、22…衝突位置分布演算部、31…警報装置、32…衝突回避支援装置、33…シートベルト制御装置、34…シート位置制御装置、35…ブレーキ制御装置、36…エアバッグ制御装置、E…相手車両エッジ、P…相手車両横位置、X…自車両、Y…相手車両、Z(Z1,Z2)…物体。   DESCRIPTION OF SYMBOLS 1 ... Collision prediction ECU, 2 ... Steering angle sensor, 3 ... Yaw rate sensor, 4 ... Wheel speed sensor, 5 ... Millimeter wave radar sensor, 6 ... Image sensor, 11 ... Estimated curve radius calculation part, 12 ... Own vehicle track | orbit calculation part , 13 ... Own vehicle speed calculation unit, 14 ... Counter vehicle speed calculation unit, 15 ... Counter vehicle movement distance calculation unit, 16 ... Counter vehicle lateral position calculation unit, 17 ... Counter vehicle trajectory calculation unit, 18 ... Collision probability calculation unit, 19 ... Image processing unit, 20 ... collision probability correction / calculation unit, 21 ... collision position calculation unit, 22 ... collision position distribution calculation unit, 31 ... alarm device, 32 ... collision avoidance support device, 33 ... seat belt control device, 34 ... seat Position control device, 35 ... Brake control device, 36 ... Airbag control device, E ... Counter vehicle edge, P ... Counter vehicle lateral position, X ... Host vehicle, Y ... Counter vehicle, Z (Z1, Z2) ... Object.

Claims (5)

レーダによって対象物体を検出するレーダ検出手段と、
撮像手段によって撮像した画像からエッジを検出し、検出したエッジに基づいて前記対象物体を検出する画像検出手段と、
前記対象物体と自車両との関係に基づいて、前記対象物体と前記自車両との衝突確率を算出する衝突確率算出手段と、
前記レーダ検出手段で検出した前記対象物体の前記自車両における車幅方向に対する位置であるレーダ横位置と、前記画像検出手段で検出した前記対象物体に対応するエッジである対象物体対応エッジにおけるエッジ幅方向位置との相対位置関係を検出する相対位置関係検出手段と、
前記レーダ横位置と前記対象物体対応エッジにおけるエッジ幅方向位置との相対位置関係に基づいて、前記対象物体と自車両との衝突確率を補正する衝突確率補正手段と、
を備えることを特徴とする衝突予測装置。
Radar detecting means for detecting a target object by radar;
An image detecting means for detecting an edge from an image picked up by the image pickup means and detecting the target object based on the detected edge;
A collision probability calculating means for calculating a collision probability between the target object and the host vehicle based on the relationship between the target object and the host vehicle;
A radar lateral position that is a position in the vehicle width direction of the target object detected by the radar detection unit and an edge width at a target object corresponding edge that is an edge corresponding to the target object detected by the image detection unit A relative positional relationship detecting means for detecting a relative positional relationship with the direction position;
Collision probability correction means for correcting the collision probability between the target object and the host vehicle based on the relative positional relationship between the radar lateral position and the edge width direction position at the target object corresponding edge;
A collision prediction apparatus comprising:
前記衝突確率補正手段は、
前記レーダ横位置が前記対象物体対応エッジにおけるエッジ幅方向の端部に位置する場合は、前記対象物体対応エッジにおけるエッジ幅方向の中央部に位置する場合に比べて、前記衝突確率が相対的に低くなるように補正する請求項1に記載の衝突予測装置。
The collision probability correcting means includes
When the radar lateral position is located at the edge of the target object corresponding edge in the edge width direction, the collision probability is relatively smaller than when the radar is positioned at the center of the target object corresponding edge in the edge width direction. The collision prediction apparatus according to claim 1, wherein the collision prediction apparatus corrects to be low.
前記衝突確率補正手段は、
前記レーダ横位置が、前記対象物体対応エッジにおけるエッジ幅方向の前記自車両に近い側の端部に位置する場合には、前記対象物体対応エッジにおけるエッジ幅方向の前記自車両に遠い側の端部に位置する場合に比べて、前記衝突確率が相対的に高くなるように補正する請求項1または請求項2に記載の衝突予測装置。
The collision probability correcting means includes
When the radar lateral position is located at an end of the target object-corresponding edge on the side close to the host vehicle in the edge width direction, an end of the target object-corresponding edge on the side far from the host vehicle in the edge width direction The collision prediction apparatus according to claim 1, wherein the collision prediction apparatus corrects the collision probability so as to be relatively higher than a case where the collision probability is relatively high.
前記対象物体が前記自車両進行方向に対して直交する方向に沿った速度成分である横速度成分を有して前記自車両に接近しているか否かを検出する横速度検出手段を備え、
前記衝突確率補正手段は、前記対象物体が前記横速度成分を有して接近している場合は、前記対象物体が前記横速度成分を有して接近していない場合に比べて前記対象物体対応エッジにおけるエッジ幅方向の前記自車両に遠い側の端部に位置する場合の前記衝突確率が相対的に高くなるように前記衝突確率を補正する請求項1〜請求項3のうちのいずれか1項に記載の衝突予測装置。
A lateral speed detection means for detecting whether the target object has a lateral speed component that is a speed component along a direction orthogonal to the traveling direction of the host vehicle and detects whether the target object is approaching the host vehicle;
The collision probability correcting means is more suitable for the target object when the target object is approaching with the lateral velocity component than when the target object is not approaching with the lateral velocity component. 4. The collision probability according to claim 1, wherein the collision probability is corrected so that the collision probability is relatively high when the edge is located at an end of the edge in the edge width direction far from the host vehicle. The collision prediction apparatus according to item.
レーダによって対象物体を検出するレーダ検出手段と、
撮像手段によって撮像した画像から複数のエッジを検出し、検出した複数のエッジに基づいて前記対象物体を検出する画像検出手段と、
前記レーダ検出手段および前記画像検出手段でそれぞれ検出された前記対象物体と、自車両との関係に基づいて、前記対象物体と前記自車両との衝突確率を算出する衝突確率算出手段と、
前記複数のエッジが同一の物体に属する確度であるエッジ確度を検出するエッジ確度検出手段と、
前記エッジ確度に応じて前記衝突確率を補正する衝突確率補正手段と、
を備えることを特徴とする衝突予測装置。
Radar detecting means for detecting a target object by radar;
Image detecting means for detecting a plurality of edges from an image captured by the imaging means and detecting the target object based on the detected plurality of edges;
A collision probability calculating means for calculating a collision probability between the target object and the host vehicle based on a relationship between the target object detected by the radar detecting unit and the image detecting unit and the host vehicle;
Edge accuracy detection means for detecting edge accuracy, which is the accuracy that the plurality of edges belong to the same object;
Collision probability correcting means for correcting the collision probability according to the edge accuracy;
A collision prediction apparatus comprising:
JP2008278581A 2008-10-29 2008-10-29 Collision prediction device Active JP5083172B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008278581A JP5083172B2 (en) 2008-10-29 2008-10-29 Collision prediction device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008278581A JP5083172B2 (en) 2008-10-29 2008-10-29 Collision prediction device

Publications (2)

Publication Number Publication Date
JP2010108168A true JP2010108168A (en) 2010-05-13
JP5083172B2 JP5083172B2 (en) 2012-11-28

Family

ID=42297571

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008278581A Active JP5083172B2 (en) 2008-10-29 2008-10-29 Collision prediction device

Country Status (1)

Country Link
JP (1) JP5083172B2 (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8838372B2 (en) 2011-05-02 2014-09-16 Denso Corporation Collision probability calculation apparatus for vehicle
US20150183431A1 (en) * 2012-08-08 2015-07-02 Toyota Jidosha Kabushiki Kaisha Collision prediction apparatus
WO2015174178A1 (en) * 2014-05-15 2015-11-19 本田技研工業株式会社 Movement-assisting device
JP2018052448A (en) * 2016-09-30 2018-04-05 株式会社Subaru Vehicle occupant protection device
JP2018147157A (en) * 2017-03-03 2018-09-20 株式会社豊田中央研究所 Movable matter quantity-of-state prediction unit and program
CN117635010A (en) * 2023-10-25 2024-03-01 北京汇通天下物联科技有限公司 Vehicle accident identification method and device, electronic equipment and storage medium

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9989963B2 (en) 2016-02-25 2018-06-05 Ford Global Technologies, Llc Autonomous confidence control
US10026317B2 (en) 2016-02-25 2018-07-17 Ford Global Technologies, Llc Autonomous probability control
US10289113B2 (en) 2016-02-25 2019-05-14 Ford Global Technologies, Llc Autonomous occupant attention-based control

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08329393A (en) * 1995-05-29 1996-12-13 Daihatsu Motor Co Ltd Preceding vehicle detector
JP2007226680A (en) * 2006-02-24 2007-09-06 Toyota Motor Corp Object detection system
JP2007279892A (en) * 2006-04-04 2007-10-25 Honda Motor Co Ltd Control device for collision prediction system, collision prediction method and occupant protection system

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08329393A (en) * 1995-05-29 1996-12-13 Daihatsu Motor Co Ltd Preceding vehicle detector
JP2007226680A (en) * 2006-02-24 2007-09-06 Toyota Motor Corp Object detection system
JP2007279892A (en) * 2006-04-04 2007-10-25 Honda Motor Co Ltd Control device for collision prediction system, collision prediction method and occupant protection system

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8838372B2 (en) 2011-05-02 2014-09-16 Denso Corporation Collision probability calculation apparatus for vehicle
US20150183431A1 (en) * 2012-08-08 2015-07-02 Toyota Jidosha Kabushiki Kaisha Collision prediction apparatus
US9440650B2 (en) * 2012-08-08 2016-09-13 Toyota Jidosha Kabushiki Kaisha Collision prediction apparatus
WO2015174178A1 (en) * 2014-05-15 2015-11-19 本田技研工業株式会社 Movement-assisting device
JP2018052448A (en) * 2016-09-30 2018-04-05 株式会社Subaru Vehicle occupant protection device
JP2018147157A (en) * 2017-03-03 2018-09-20 株式会社豊田中央研究所 Movable matter quantity-of-state prediction unit and program
CN117635010A (en) * 2023-10-25 2024-03-01 北京汇通天下物联科技有限公司 Vehicle accident identification method and device, electronic equipment and storage medium

Also Published As

Publication number Publication date
JP5083172B2 (en) 2012-11-28

Similar Documents

Publication Publication Date Title
JP5083172B2 (en) Collision prediction device
US11001258B2 (en) Lane keeping assist system and method for improving safety in preceding vehicle follower longitudinal control
US9896129B2 (en) Driving assistant system of vehicle and method for controlling the same
US9731728B2 (en) Sensor abnormality detection device
CN109891262B (en) Object detecting device
JP5532124B2 (en) Vehicle collision determination device
JP4558758B2 (en) Obstacle recognition device for vehicles
JP6443318B2 (en) Object detection device
JP5410730B2 (en) Automobile external recognition device
WO2017111135A1 (en) Travel assistance device and travel assistance method
JP6855776B2 (en) Object detection device and object detection method
JP2006240453A (en) Sensor failure detector and detection method of sensor failure
JP2010271788A (en) Object detection device
JP6747389B2 (en) Collision estimating device and collision estimating method
JP2011164989A (en) Apparatus for determining unstable state
JP2012089114A (en) Obstacle recognition device
WO2017145845A1 (en) Collision prediction apparatus
KR102115905B1 (en) Driver assistance system and control method for the same
US11420624B2 (en) Vehicle control apparatus and vehicle control method
JP4872517B2 (en) Obstacle recognition device
JP5166975B2 (en) Vehicle periphery monitoring device and vehicle periphery monitoring method
JP5098370B2 (en) Collision prediction device
JP4941265B2 (en) Obstacle determination device
JP4823282B2 (en) Perimeter monitoring sensor
JP6354646B2 (en) Collision avoidance support device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20101206

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20120521

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20120529

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120717

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

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

R151 Written notification of patent or utility model registration

Ref document number: 5083172

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

Year of fee payment: 3