JP5496242B2 - Driving assistance device - Google Patents

Driving assistance device Download PDF

Info

Publication number
JP5496242B2
JP5496242B2 JP2012085434A JP2012085434A JP5496242B2 JP 5496242 B2 JP5496242 B2 JP 5496242B2 JP 2012085434 A JP2012085434 A JP 2012085434A JP 2012085434 A JP2012085434 A JP 2012085434A JP 5496242 B2 JP5496242 B2 JP 5496242B2
Authority
JP
Japan
Prior art keywords
detection area
outside
detection
time
unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2012085434A
Other languages
Japanese (ja)
Other versions
JP2013214263A (en
Inventor
祐太 小松
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP2012085434A priority Critical patent/JP5496242B2/en
Publication of JP2013214263A publication Critical patent/JP2013214263A/en
Application granted granted Critical
Publication of JP5496242B2 publication Critical patent/JP5496242B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Description

この発明は、運転支援装置に関するものである。 The present invention relates to a driving support device .

近年、車両運転時の事故防止の観点から、車両の周辺に位置する人や自転車等の障害物をレーダや撮像したカメラの画像等によって検出し、運転者に対して警告を行う運転支援装置を搭載する車両が増加している。その際、単に障害物の有無やその位置を特定するのみでなく、現在の状況からその後の自車両の動きや障害物の動きを予測して警告を発生するものがある。   In recent years, from the viewpoint of preventing accidents when driving a vehicle, a driving support device that detects obstacles such as people and bicycles located around the vehicle by using a radar or an image of a captured camera and warns the driver. The number of vehicles on board is increasing. At this time, there are those that not only specify the presence or absence of an obstacle and its position, but also generate a warning by predicting the subsequent movement of the vehicle and the movement of the obstacle from the current situation.

例えば下記特許文献1には、地図データと車両の現在地、車速、及び進行方向等の現在の状況を特定する複数の情報に基づいて車両及び障害物が移動する軌跡を推定することにより、運転者に警告を行うことを特徴とした運転支援装置について記載されている。   For example, in Patent Document 1 below, a driver is estimated by estimating a trajectory in which a vehicle and an obstacle move based on a plurality of pieces of information specifying current conditions such as map data and the current position of the vehicle, vehicle speed, and traveling direction. Describes a driving assistance device characterized by warning.

特開2006−309445号公報JP 2006-309445 A

しかしながら、上述の特許文献1に記載された運転支援装置では、カメラの検出領域から外れた障害物が、交差点右左折時や店舗進入時等に、自車両近辺に再び接近するような状況を考えると、前記障害物の検出が右左折時等の直前となり、自車両の運転者への警告タイミングが遅れ、衝突の危険を伴う可能性がある。   However, in the driving assistance apparatus described in Patent Document 1 described above, a situation is considered in which an obstacle that has deviated from the detection area of the camera again approaches the vicinity of the host vehicle when turning left or right at an intersection or entering a store. Then, the detection of the obstacle is immediately before turning right or left, and the warning timing to the driver of the host vehicle is delayed, which may cause a collision risk.

これを抑制するためには、カメラ等のセンサを前方だけではなく、側方または後側方にも設置する等、複数のセンサによる周辺監視が必要となり、高コストな構成となる。上記特許文献1の実施の形態にも記載の通り、2台のカメラを障害物検出に利用するため、装置が高コストとなる懸念がある。特に、赤外線カメラを用いる場合、一般的に、ミリ波レーダ等の電波レーダやCCDカメラと比較すると高コストとなることは避けられない。   In order to suppress this, it is necessary to monitor the surroundings with a plurality of sensors, such as installing a sensor such as a camera not only in the front, but also in the side or the rear side, resulting in an expensive configuration. As described in the embodiment of Patent Document 1, since two cameras are used for obstacle detection, there is a concern that the cost of the apparatus becomes high. In particular, when an infrared camera is used, the cost is generally unavoidable as compared with a radio wave radar such as a millimeter wave radar or a CCD camera.

さらに、推定した自車両と障害物の移動軌跡が交差すると判断された場合、両者の衝突地点への到達時間算出のために、予め記憶した速度範囲決定テーブル及び速度係数テーブルの参照を行うことや、2台のカメラを障害物検出に利用することにより、装置の構成(データ処理方法)が複雑になり、処理時間が長くなり、CPUへの処理負荷も大きくなる。   Further, when it is determined that the estimated own vehicle and the movement trajectory of the obstacle cross each other, the speed range determination table and the speed coefficient table stored in advance are referred to in order to calculate the arrival time at the collision point between the two. By using two cameras for obstacle detection, the configuration of the apparatus (data processing method) becomes complicated, the processing time becomes longer, and the processing load on the CPU also increases.

この発明は、前記のような課題を解決するためになされたものであり、センサの検出領域外の物体との自車両との衝突も考慮した、より簡素な構成でかつ低コストな運転支援装置等を提供することを目的とする。   The present invention has been made in order to solve the above-described problems, and has a simpler configuration and a lower cost in consideration of a collision with an own vehicle with an object outside the detection area of the sensor. The purpose is to provide.

この発明は、自車両前方の物体を検出する物体検出手段と、自車両の少なくとも車速を検出する車両状態検出手段と、自車両が物体と衝突する危険度を判定する衝突判定手段と、前記衝突判定手段の判定結果に基づいて警告を行う警告手段と、を備える運転支援装置において、前記物体検出手段の検出領域内に存在していたときの前記物体の位置と速度とに基づき前記物体検出手段の検出領域外に存在する検出領域外物体の位置を、所定の間、推定し続ける検出領域外物体推定手段を備え、前記衝突判定手段により、自車両が、前記検出領域外物体推定手段により推定した検出領域外物体と衝突する危険度を判定し、前記警告手段により自車両が前記検出領域外物体と衝突する可能性があることを警告し、さらに、前記物体検出手段で検出した物体のうち、相対速度が(−自車速)<相対速度<0、かつ水平角度が所定値以上である物体を検出領域外物体候補として抽出する検出領域外物体候補抽出手段を備え、前記検出領域外物体推定手段は、前記検出領域外物体候補の位置と速度に基づいて、検出領域外物体の位置を推定し続け、さらに、前記検出領域外物体候補抽出手段により検出領域外物体候補と判定され抽出された時の物体の位置と速度とを所定の間、記憶する検出領域外物体候補記憶手段と、前記検出領域外物体候補抽出手段により検出領域外物体候補として抽出された時刻を初期時刻とし、所定の間、時間計測を行う時間計測手段と、を備え、前記検出領域外物体推定手段は、前記検出領域外物体候補記憶手段に記憶された、検出領域外物体候補の抽出された時の位置と速度と、前記時間計測手段が計測した対応する抽出された前記初期時刻からの時間とに基づいて検出領域外物体候補が等速直線運動するものとして検出領域外物体の位置を推定し続ける、ことを特徴とする運転支援装置にある。 The present invention includes an object detection unit that detects an object ahead of the host vehicle, a vehicle state detection unit that detects at least the vehicle speed of the host vehicle, a collision determination unit that determines a risk of collision of the host vehicle with the object, and the collision A warning means for giving a warning based on a determination result of the determination means, and the object detection means based on the position and speed of the object when present in the detection region of the object detection means. A detection area outside object estimation unit that continuously estimates a position of the detection area outside object existing outside the detection area for a predetermined period, and the vehicle is estimated by the collision determination unit by the detection area outside object estimation unit. The degree of risk of collision with an object outside the detection area is determined, the warning means warns that the vehicle may collide with the object outside the detection area, and further, the object detection means detects Among the object, the relative speed is - provided with a (vehicle speed) <relative speed <0, and the detection area outside the object candidate extraction means for the horizontal angle is extracted as the detection region outside object candidate objects is not less than a predetermined value, the detection area The external object estimation means continues to estimate the position of the detection area outside object based on the position and speed of the detection area outside object candidate, and is further determined as the detection area outside object candidate by the detection area outside object candidate extraction means. The detection area outside object candidate storage means for storing the position and speed of the object at the time of extraction for a predetermined time, and the time extracted as the detection area outside object candidate by the detection area outside object candidate extraction means as the initial time A time measuring means for measuring time for a predetermined time, and the detection area outside object estimation means stores the detection area outside object candidate stored in the detection area outside object candidate storage means when the detection area outside object candidate is extracted. location and Continuing to estimate the position of the object outside the detection area based on the speed and the corresponding extracted time from the initial time measured by the time measuring means as the object outside the detection area moving at a constant linear velocity. There is a driving support device characterized by the above.

この発明では、センサの検出領域外の物体との自車両との衝突も考慮した、より簡素な構成でかつ低コストな運転支援装置等を提供できる。   According to the present invention, it is possible to provide a driving support device and the like that have a simpler configuration and a lower cost in consideration of a collision with an own vehicle with an object outside the detection region of the sensor.

この発明の実施の形態1に係る運転支援装置の構成を示すブロック図である。It is a block diagram which shows the structure of the driving assistance apparatus which concerns on Embodiment 1 of this invention. この発明の実施の形態1に係る検出領域外物体候補抽出部が抽出する検出領域外物体候補の抽出条件を説明するための図である。It is a figure for demonstrating the extraction conditions of the detection area outside object candidate which the detection area outside object candidate extraction part which concerns on Embodiment 1 of this invention extracts. この発明の実施の形態1に係る検出領域外物体推定部が推定する検出領域外物体の推定方法を説明するための図である。It is a figure for demonstrating the estimation method of the detection area outside object which the detection area outside object estimation part which concerns on Embodiment 1 of this invention estimates. この発明の実施の形態1に係る衝突判定部が衝突危険度の判定に用いる衝突危険度判定テーブルの一例を示した図である。It is the figure which showed an example of the collision risk determination table which the collision determination part which concerns on Embodiment 1 of this invention uses for determination of a collision risk. この発明の実施の形態1に係る運転支援装置の動作を示すフローチャートである。It is a flowchart which shows operation | movement of the driving assistance apparatus which concerns on Embodiment 1 of this invention. この発明の実施の形態2に係る運転支援装置の構成を示すブロック図である。It is a block diagram which shows the structure of the driving assistance device which concerns on Embodiment 2 of this invention. この発明の実施の形態2に係る検出領域外物体判定部が検出領域外物体を判定するための判定方法を説明するための図である。It is a figure for demonstrating the determination method for the detection area outside object determination part which concerns on Embodiment 2 of this invention to determine an object outside a detection area. この発明の実施の形態2に係る運転支援装置の動作を示すフローチャートである。It is a flowchart which shows operation | movement of the driving assistance apparatus which concerns on Embodiment 2 of this invention.

この発明では、センサの検出領域内で検出した物体の位置等の情報に基づいて、追い越した物体等、センサの検出領域外の物体の位置等の情報を、所定の間、推定し続け、自車両が推定した前記物体と衝突する危険度を判定し、自車両の運転者に対して警告を行う運転支援装置を、簡素な構成でかつ低コストで実現する。   In this invention, based on information such as the position of an object detected in the detection area of the sensor, information such as the position of an object outside the sensor detection area, such as an overtaken object, is continuously estimated for a predetermined period. A driving support device that determines a risk of collision with the object estimated by the vehicle and warns the driver of the host vehicle is realized with a simple configuration and at a low cost.

この発明による運転支援装置によれば、センサの検出領域内で検出した物体の位置等の情報に基づいて、追い越した物体等、センサの検出領域外の物体の位置等の情報を、所定の間、推定し続けることで、検出領域外の物体に対しても衝突判定を行い、自車両の運転者に対して衝突警告を行う。センサ(車載レーダ)1台により、検出領域外の物体に関しても衝突警告を行う。従来の運転支援装置と比べ、装置の構成が簡素で低コストである。   According to the driving support device of the present invention, based on the information on the position of the object detected in the detection region of the sensor, the information on the position of the object outside the detection region of the sensor, such as the overtaking object, By continuing the estimation, the collision determination is also made on the object outside the detection area, and the collision warning is given to the driver of the host vehicle. A single sensor (on-vehicle radar) also issues a collision warning for objects outside the detection area. Compared to a conventional driving support device, the configuration of the device is simple and low cost.

また、センサ検出領域のある領域に存在する物体の情報に基づいて、検出領域外の物体に対して位置の推定処理を行うことで、CPUの処理負荷を軽減する。さらにメモリの削減によりコストの低減にもなる。   Further, the processing load of the CPU is reduced by performing position estimation processing on an object outside the detection area based on information on the object existing in a certain area of the sensor detection area. Further, the cost can be reduced by reducing the memory.

また、停止物を検出領域外物体の位置の推定処理対象から除外し(停止物以外を抽出)、CPUの処理負荷を軽減する。さらに、メモリの削減によりコストの低減にもなる。   In addition, the stationary object is excluded from the object of the estimation process of the position of the object outside the detection area (excluding the stationary object is extracted), thereby reducing the processing load on the CPU. Further, the cost can be reduced by reducing the memory.

また、センサの検出領域内から検出領域外へと外れたと推定される物体に対して、位置の推定処理を行うことにより、検出領域外の物体の位置を正確に推定できる。そして、センサの検出領域外において、検出領域外物体の位置の推定処理を開始するため、推定処理を行う対象の数、推定処理時間を削減し、CPUの処理負荷を軽減する。さらに、メモリの削減によりコストの低減にもなる。   In addition, the position of the object outside the detection area can be accurately estimated by performing the position estimation process on the object estimated to be out of the detection area from the detection area of the sensor. And since the estimation process of the position of the object outside the detection area is started outside the detection area of the sensor, the number of targets to be estimated and the estimation process time are reduced, and the processing load of the CPU is reduced. Further, the cost can be reduced by reducing the memory.

また、衝突判定部が、ウィンカー点灯を検出した場合に、自車両と検出領域外物体とが衝突する危険度を判定し、自車両の運転者に警告を行うことで、車線変更時や交差点での右左折時等に、現在の状況を考慮した必要なタイミングで警告を行う。   When the collision determination unit detects blinker lighting, it determines the risk of collision between the host vehicle and an object outside the detection area, and warns the driver of the host vehicle when changing lanes or at intersections. Warnings are made at necessary timing in consideration of the current situation when turning right or left.

また、衝突判定部が、操舵角が操舵角閾値以上となった場合に、自車両と検出領域外物体とが衝突する危険度を判定し、自車両の運転者に警告を行うことで、車線変更時や交差点での右左折時等、現在の状況を考慮した必要なタイミングで警告を行う。   The collision determination unit determines the risk of collision between the host vehicle and an object outside the detection area when the steering angle is equal to or greater than the steering angle threshold, and warns the driver of the host vehicle. Warnings are made when necessary, taking into account the current situation, such as when changing or turning right or left at an intersection.

以下、この発明による運転支援装置等を各実施の形態に従って図面を用いて説明する。なお、各実施の形態において、同一もしくは相当部分は同一符号で示し、重複する説明は省略する。   Hereinafter, a driving support device and the like according to the present invention will be described with reference to the drawings according to each embodiment. In each embodiment, the same or corresponding parts are denoted by the same reference numerals, and redundant description is omitted.

実施の形態1.
図1は、この発明の実施の形態1に係る運転支援装置の構成を示すブロック図である。図示の通り、運転支援装置101は、大別して、ミリ波レーダ103と、車速センサ104と、操舵角センサ105と、スピーカ106で構成されている。
Embodiment 1 FIG.
FIG. 1 is a block diagram showing the configuration of the driving support apparatus according to Embodiment 1 of the present invention. As shown in the figure, the driving support apparatus 101 is roughly composed of a millimeter wave radar 103, a vehicle speed sensor 104, a steering angle sensor 105, and a speaker 106.

車速センサ104は、自車両の車輪の回転速度を検出する。検出した回転速度がミリ波レーダ103に出力され、CPU109により、自車両の車速が算出される。   The vehicle speed sensor 104 detects the rotational speed of the wheels of the host vehicle. The detected rotational speed is output to the millimeter wave radar 103, and the CPU 109 calculates the vehicle speed of the host vehicle.

操舵角センサ105は、自車両のステアリングコラムシャフトの回転量を検出する。検出した回転量がミリ波レーダ103に出力され、CPU109により、自車両の操舵角が算出される。   The steering angle sensor 105 detects the amount of rotation of the steering column shaft of the host vehicle. The detected amount of rotation is output to the millimeter wave radar 103, and the CPU 109 calculates the steering angle of the host vehicle.

なお、以下では説明を簡単にするために、車速センサ104で車速が、操舵角センサ105で操舵角がそれぞれ検出されるものとする。   In the following, for the sake of simplicity, it is assumed that the vehicle speed sensor 104 detects the vehicle speed, and the steering angle sensor 105 detects the steering angle.

スピーカ106は、後述のように物体102との衝突の恐れを警告音により、運転者等に警告するものである。   As will be described later, the speaker 106 warns the driver or the like with a warning sound of the possibility of collision with the object 102.

ミリ波レーダ103は、(前方)物体102に向けて電波を送信し、物体102から反射した電波を受信する送受信部107と、その受信した電波を受信信号に変換する変換部108と、変換部108からの信号に基づいて前方物体102を検出したり、ミリ波レーダ103の各構成部の制御を行うCPU109と、CPU109で演算されたデータや、ミリ波レーダ103の各構成部やスピーカ106の制御必要な各種プログラム等を記憶しておく記憶部110とによって構成されている。   The millimeter wave radar 103 transmits / receives radio waves to the (front) object 102, receives a radio wave reflected from the object 102, a conversion unit 108 that converts the received radio wave into a reception signal, and a conversion unit CPU 109 that detects the forward object 102 based on the signal from 108 and controls each component of the millimeter wave radar 103, data calculated by the CPU 109, each component of the millimeter wave radar 103, and the speaker 106 The storage unit 110 stores various programs necessary for control.

そして、CPU109には、物体検出部111、検出領域外物体候補抽出部112、時間計測部113、検出領域外物体推定部114、衝突判定部115を備え、車速センサ104や操舵角センサ105から取得した情報に基づいて、自車両と物体102との接触の警告を、スピーカ106を制御して行う。   The CPU 109 includes an object detection unit 111, a detection area outside object candidate extraction unit 112, a time measurement unit 113, a detection area outside object estimation unit 114, and a collision determination unit 115, which are obtained from the vehicle speed sensor 104 and the steering angle sensor 105. Based on the information, warning of contact between the host vehicle and the object 102 is performed by controlling the speaker 106.

また、物体検出部111は、変換部108から入力された受信信号を信号処理し、前方の所定範囲内に存在する物体の距離、相対速度、角度を検出する。そして、これら極座標系情報は直交座標系情報に変換され、CPU109の制御により、記憶部110へ出力され、記憶部110はCPU109の制御により所定の記憶領域にこれらを記憶する。   In addition, the object detection unit 111 performs signal processing on the reception signal input from the conversion unit 108, and detects the distance, relative speed, and angle of an object existing within a predetermined range ahead. These polar coordinate system information is converted into orthogonal coordinate system information and output to the storage unit 110 under the control of the CPU 109. The storage unit 110 stores them in a predetermined storage area under the control of the CPU 109.

ここで、記憶部110は、少なくとも、物体検出部111において検出された物体の極座標系のデータである距離、相対速度、角度を記憶する領域と、該データと車速センサ104が検出した自車両の車速とに基づき算出された直交座標系のデータである位置、速度を記憶する領域とを、下記の通り備える。   Here, the storage unit 110 stores at least an area for storing distance, relative speed, and angle, which are polar coordinate data of the object detected by the object detection unit 111, and the vehicle and the vehicle speed sensor 104 detected by the vehicle speed sensor 104. An area for storing the position and speed, which are data in the Cartesian coordinate system calculated based on the vehicle speed, is provided as follows.

・極座標系
・物体検出部111で検出された物体のデータの記憶領域S01
・直交座標系
・物体検出部111で検出された物体のデータの記憶領域S10
・検出領域外物体候補抽出部112で抽出された検出領域外物体候補のデータの記憶領域S11
・検出領域外物体推定部114で推定された検出領域外物体のデータの記憶領域S12
Polar coordinate system Data storage area S01 of the object detected by the object detection unit 111
Cartesian coordinate system Data storage area S10 of the object detected by the object detection unit 111
A storage area S11 for data of candidate objects outside the detection area extracted by the detection object candidate outside the detection area 112
A storage area S12 for data of an object outside the detection area estimated by the detection object outside detection area 114

なお、本ミリ波レーダにおける距離と相対速度の検出方式については、公知であるFM−CW方式等を利用するので、詳細な説明は割愛する。角度検出方式については、公知である位相モノパルス方式等を利用するので詳細な説明は割愛する。   In addition, since the known FM-CW system etc. are utilized about the detection method of the distance and relative velocity in this millimeter wave radar, detailed description is omitted. As for the angle detection method, a known phase monopulse method or the like is used, and a detailed description thereof will be omitted.

検出領域外物体候補抽出部112は、物体検出部111で検出した物体のうち、所定の条件を満足する物体を、検出領域外物体候補として抽出する。ここで、図2は検出領域外物体候補の抽出条件について示した図である。図示した通り、点線内の領域はミリ波レーダ103の検出領域201を、実線は検出した物体を検出領域外物体候補として抽出するための角度閾値(例えば自車両の前方の正面方向を基準の0°として右回転で360°、または基準の0°の右を+、左を−とした180°〜−180°とした水平角の水平角領域を規定する角度)による物体抽出境界202を、丸印(白色、黒色の両方を指す)はミリ波レーダ103により検出された物体203を、丸印(黒色)は検出領域外物体候補抽出部112により検出領域外物体候補として抽出された物体204を示している。   The detection area outside object candidate extraction unit 112 extracts an object that satisfies a predetermined condition from the objects detected by the object detection unit 111 as a detection area outside object candidate. Here, FIG. 2 is a diagram showing the extraction condition of the object outside the detection area. As shown in the figure, the area within the dotted line is the detection area 201 of the millimeter wave radar 103, and the solid line is the angle threshold value for extracting the detected object as a candidate outside the detection area (for example, 0 based on the front direction in front of the host vehicle). The object extraction boundary 202 is 360 ° by right rotation as an angle or an angle defining a horizontal angle region of 180 ° to −180 °, where the right of 0 ° of the reference is + and the left is −. The mark (points to both white and black) indicates the object 203 detected by the millimeter wave radar 103, and the circle (black) indicates the object 204 extracted as a detection area outside object candidate by the detection area outside object candidate extraction unit 112. Show.

検出領域外物体候補抽出部112は、物体検出部111で検出した物体203のうち、物体抽出境界202よりも外側に存在する(角度が角度閾値よりも大きい)、かつ、相対速度が負となる、物体に対して、検出領域外物体候補として抽出する。そして、該物体の位置と速度を初期値として記憶部110に記憶しておく。なお、角度閾値に関しては、例えば、検出領域が30[deg]である場合、検出領域−10%=27[deg]と設定し、記憶部110に記憶させておく。   Out-of-detection-area object candidate extraction unit 112 exists outside object extraction boundary 202 among objects 203 detected by object detection unit 111 (the angle is larger than the angle threshold), and the relative speed is negative. The object is extracted as a candidate outside the detection area. Then, the position and speed of the object are stored in the storage unit 110 as initial values. Regarding the angle threshold, for example, when the detection area is 30 [deg], the detection area is set to −10% = 27 [deg] and is stored in the storage unit 110.

検出領域外物体候補抽出部112は、前記条件に加えて、(−自車速)<相対速度<0を条件に加えても良い。このように条件を変更することによって、検出領域外物体候補の中から停止物以外を抽出することができ、メモリ削減、信号処理負荷の軽減ができることは言うまでも無い。   The detection area outside object candidate extraction unit 112 may add (−own vehicle speed) <relative speed <0 to the condition in addition to the above condition. It goes without saying that by changing the conditions in this manner, it is possible to extract objects other than the stationary object from the detection object candidates outside the detection area, thereby reducing the memory and the signal processing load.

次に、時間計測部113は前記検出領域外物体候補抽出部112により、検出領域外物体候補として抽出された時間を初期時間として、所定の間、時間計測を行う。時間計測部113は、後述の通り、衝突判定部115により、自車両と検出領域外物体候補との衝突の危険度が判定され、警告が行われた後、時間計測を終了する。また、警告が行われない場合は、所定の時間経過すると、時間計測を終了する。   Next, the time measurement unit 113 performs time measurement for a predetermined period using the time extracted as the detection region outside object candidate by the detection region outside object candidate extraction unit 112 as an initial time. As will be described later, the time measurement unit 113 ends the time measurement after the collision determination unit 115 determines the risk of collision between the host vehicle and the object outside the detection area and gives a warning. If no warning is given, the time measurement ends when a predetermined time has elapsed.

検出領域外物体推定部114は、記憶部110に記憶された、検出領域外物体候補として抽出された物体の、位置と速度と、時間計測部113により計測された時間と、車速センサ104により計測された自車速とに基づいて、該物体が検出領域外となった後、すなわち、検出領域外物体の位置についても推定を行う。ここで、図3は検出領域外物体の推定方法について示した図である。   The detection area outside object estimation unit 114 measures the position and speed of the object extracted as the detection area outside object candidate stored in the storage unit 110, the time measured by the time measurement unit 113, and the vehicle speed sensor 104. Based on the measured vehicle speed, the position of the object outside the detection area is also estimated after the object is out of the detection area, that is, the position of the object outside the detection area. Here, FIG. 3 is a diagram illustrating a method for estimating an object outside the detection area.

検出領域外物体推定部114は、検出領域外物体候補抽出部112によりサンプリング時刻T=0において検出領域外物体候補として抽出された物体301が、それ以降、等速直線運動をすると仮定し、サンプリング時刻T=N (N ≧ 1)における該物体の位置(XN[m], YN[m])を、
サンプリング時刻T=0での位置(X0[m], Y0[m])と速度VB0[m/s]と、
時間計測部113により計測された時間TMと、
車速センサ104により計測されたサンプリング時刻T=Nでの自車速VAN[m/s]と、
サンプリング周期TS[s]と、
に基づいて、下記の式(1)の通り推定する。
The detection area outside object estimation unit 114 assumes that the object 301 extracted as the detection area outside object candidate at the sampling time T = 0 by the detection area outside object candidate extraction unit 112 thereafter performs a constant velocity linear motion, and performs sampling. The position (XN [m], YN [m]) of the object at time T = N (N ≧ 1)
Position at sampling time T = 0 (X0 [m], Y0 [m]) and speed VB0 [m / s]
Time TM measured by the time measuring unit 113,
The vehicle speed VAN [m / s] at the sampling time T = N measured by the vehicle speed sensor 104,
Sampling period TS [s],
Based on the above, the following estimation (1) is performed.

(XN, YN) = (X(N−1), Y(N−1)) − (0, (VAN − VB0) × TM × TS) (1)   (XN, YN) = (X (N−1), Y (N−1)) − (0, (VAN − VB0) × TM × TS) (1)

したがって、本実施の形態に係る運転支援装置は、ミリ波レーダの検出領域内において検出領域外物体の位置の推定処理を開始する。   Therefore, the driving support apparatus according to the present embodiment starts the process of estimating the position of the object outside the detection area within the detection area of the millimeter wave radar.

次に、衝突判定部115は、操舵角センサ105の出力信号に基づいて検出した自車両の操舵角が操舵角閾値以上となった場合、検出領域外物体推定部114により推定された検出領域外物体の距離(物体の位置より求まる)に応じて、衝突危険度を判定し、スピーカ106から運転者(同乗者も含む)に対して所定の間、警告を行う。ここで、図4に、衝突危険度判定テーブルの一例を示す。衝突判定部115は、検出領域外物体の距離と、記憶部110に記憶された衝突危険度判定テーブルとを比較し、該テーブルに基づいて、スピーカ106より警告を行う。   Next, when the steering angle of the host vehicle detected based on the output signal of the steering angle sensor 105 exceeds the steering angle threshold, the collision determination unit 115 is outside the detection region estimated by the detection region outside object estimation unit 114. The collision risk is determined according to the distance of the object (determined from the position of the object), and a warning is given to the driver (including passengers) from the speaker 106 for a predetermined time. Here, FIG. 4 shows an example of the collision risk determination table. The collision determination unit 115 compares the distance of the object outside the detection area with the collision risk determination table stored in the storage unit 110, and issues a warning from the speaker 106 based on the table.

図4に示した通り、
該物体の距離≧5mの場合は、衝突危険度を0と判定し、スピーカ106からの警告を行わず、
3m≦該物体の距離<5mの場合は、衝突危険度を1と判定し、「ピッ」(短い音)という警告音をスピーカ106より出力することで運転手に警告を行う。
1m≦該物体の距離<3mの場合は、衝突危険度を2と判定し、「ピ、ピッ」(連続音)という警告音により警告を行い、
該物体の距離<1mの場合は、衝突危険度を3と判定し、「ピー」(長い音)という警告音により警告を行う。
なお、操舵角閾値については、例えば、15°と設定し、記憶部110に記憶しておく。
As shown in FIG.
If the distance of the object is ≧ 5 m, the collision risk is determined to be 0, no warning is given from the speaker 106,
If 3 m ≦ the distance of the object <5 m, the collision risk is determined to be 1, and a warning sound “beep” (short sound) is output from the speaker 106 to warn the driver.
If 1m ≦ distance of the object <3m, the collision risk is determined to be 2, and a warning sound is given with a beeping sound (continuous sound).
When the distance of the object is less than 1 m, the collision risk is determined to be 3, and a warning is given by a warning sound “Peep” (long sound).
For example, the steering angle threshold is set to 15 ° and stored in the storage unit 110.

図1のブロック図の操舵角センサ105をウィンカーセンサに変更することも可能である。この場合、衝突判定部115は、外部からウィンカーセンサ(図示省略)の出力がミリ波レーダ103に入力され、ウィンカーの点灯または操作を検出すると、検出領域外物体推定部114により推定された検出領域外物体の距離に応じて、衝突危険度を判定し、スピーカ106から運転者に対して所定の間、警告を行う。また、図1のブロック図にウィンカーセンサを追加することも可能である。この場合、例えば、衝突判定部115は、ウィンカーの点灯と操舵角が所定値以上となったことをCPU109により検出した際(いずれか一方の条件、または双方の条件が成立した場合)、検出領域外物体推定部114により推定された検出領域外物体の距離に応じて、衝突危険度を判定し、スピーカ106から運転者に対して所定の間、警告を行う。   It is also possible to change the steering angle sensor 105 in the block diagram of FIG. 1 to a blinker sensor. In this case, when the output of the winker sensor (not shown) is input from the outside to the millimeter wave radar 103 and the collision determination unit 115 detects lighting or operation of the winker, the detection region estimated by the detection region outside object estimation unit 114 is detected. The collision risk is determined according to the distance of the external object, and a warning is given to the driver from the speaker 106 for a predetermined period. It is also possible to add a blinker sensor to the block diagram of FIG. In this case, for example, when the collision determination unit 115 detects that the turn-on of the blinker and the steering angle are equal to or greater than a predetermined value by the CPU 109 (when one or both of the conditions are satisfied), the detection area The collision risk is determined according to the distance of the object outside the detection area estimated by the external object estimation unit 114, and a warning is given from the speaker 106 to the driver for a predetermined period.

続いて、本実施の形態に係る運転支援装置の動作について図5に基づいて説明する。図5は、本実施の形態に係る運転支援装置の動作を示すフローチャートである。   Next, the operation of the driving support apparatus according to the present embodiment will be described with reference to FIG. FIG. 5 is a flowchart showing the operation of the driving support apparatus according to the present embodiment.

まずステップS101では、物体検出部111において物体が検出されたかどうか判定する。物体が検出された場合、ステップS102へ、物体が検出されない場合はスタートへ戻る。   First, in step S101, it is determined whether or not an object is detected by the object detection unit 111. If an object is detected, the process returns to step S102, and if no object is detected, the process returns to START.

ステップS102では、物体検出部111において、検出された物体の距離、相対速度、角度を算出する。また、算出した値は、記憶部110の記憶領域S01に記憶される。   In step S102, the object detection unit 111 calculates the distance, relative speed, and angle of the detected object. The calculated value is stored in the storage area S01 of the storage unit 110.

次に、ステップS103では、物体検出部111において、ステップS102で算出された距離、相対速度、角度と、車速センサ104が検出した自車両の車速とに基づいて、検出した物体の位置と速度を算出する。そして、算出された値は、記憶部110の記憶領域S10に記憶される。   Next, in step S103, the object detection unit 111 calculates the position and speed of the detected object based on the distance, relative speed, and angle calculated in step S102 and the vehicle speed of the host vehicle detected by the vehicle speed sensor 104. calculate. The calculated value is stored in the storage area S10 of the storage unit 110.

ステップS104では、検出領域外物体候補抽出部112において、記憶部110の記憶領域S01に記憶されている物体のデータのうち、相対速度が相対速度<0、かつ角度が角度≧角度閾値である物体が存在するかどうかを判定する。本条件式を満足する物体が存在する場合は、ステップS105へ、満足する物体が存在しない場合は、ステップS107へ進む。   In step S104, out-of-detection region object candidate extraction unit 112, among the object data stored in storage region S01 of storage unit 110, the relative speed is relative speed <0 and the angle is angle ≧ angle threshold. Determine if exists. If there is an object that satisfies this conditional expression, the process proceeds to step S105. If there is no object that satisfies the conditional expression, the process proceeds to step S107.

ステップS105では、ステップS104の判定条件を満足する物体が、検出領域外物体候補抽出部112により検出領域外物体候補として抽出される。   In step S105, an object that satisfies the determination condition in step S104 is extracted as a detection area outside object candidate by the detection area outside object candidate extraction unit 112.

ステップS106では、ステップS105で抽出した検出領域外物体候補の位置と速度が記憶部110の記憶領域S11に記憶される。   In step S <b> 106, the position and speed of the object outside the detection area extracted in step S <b> 105 are stored in the storage area S <b> 11 of the storage unit 110.

ステップS107では、検出領域外物体推定部114により、記憶部110の記憶領域S12の値が0でないかどうかが判定される。記憶領域S12の値が0でない場合はステップS108へ、記憶領域S12の値が0の場合はステップS109へ進む。   In step S107, the detection area outside object estimation unit 114 determines whether the value of the storage area S12 of the storage unit 110 is not zero. If the value of the storage area S12 is not 0, the process proceeds to step S108. If the value of the storage area S12 is 0, the process proceeds to step S109.

ステップS108では、時間計測部113により、計測時間がインクリメントされ、ステップS110へ進む。   In step S108, the time measurement unit 113 increments the measurement time, and the process proceeds to step S110.

ステップS110では、検出領域外物体推定部114により、検出領域外物体の位置の推定が上述の式(1)に基づいて行われる。   In step S110, the detection area outside object estimation unit 114 estimates the position of the detection area outside object based on the above-described equation (1).

続いて、ステップS111では、推定した検出領域外物体の位置が、記憶部110の記憶領域S12に記憶される。   Subsequently, in step S <b> 111, the estimated position of the object outside the detection area is stored in the storage area S <b> 12 of the storage unit 110.

ステップS112では、操舵角センサ105により検出された自車両の操舵角が操舵角閾値以上であるかどうか判定される。条件式(操舵角≧操舵角閾値)を満足する場合はステップS113へ、満足しない場合はS114へ進む。   In step S112, it is determined whether the steering angle of the host vehicle detected by the steering angle sensor 105 is equal to or greater than a steering angle threshold. If the conditional expression (steering angle ≧ steering angle threshold) is satisfied, the process proceeds to step S113. If not satisfied, the process proceeds to S114.

ステップS113では、衝突判定部115において、前記推定された検出領域外物体の位置に基づく自車両との距離と図4に示した衝突危険度判定テーブルとを比較する。   In step S113, the collision determination unit 115 compares the distance to the host vehicle based on the estimated position of the object outside the detection area and the collision risk determination table shown in FIG.

一方、ステップS114では、時間計測部113にて計測された時間が時間閾値以上かどうかを判定する。条件(時間≧時間閾値)を満足する場合は、ステップS117へ、条件を満たさない場合はステップS120へ進む。   On the other hand, in step S114, it is determined whether the time measured by the time measuring unit 113 is equal to or greater than the time threshold. If the condition (time ≧ time threshold) is satisfied, the process proceeds to step S117. If the condition is not satisfied, the process proceeds to step S120.

ステップS115では、衝突判定部115において、ステップS113における比較結果に基づき、衝突危険度が0でないかどうかを判定する。衝突危険度が0でない場合はステップS116へ、衝突危険度が0である場合はステップS117へ進む。   In step S115, the collision determination unit 115 determines whether the collision risk is not 0 based on the comparison result in step S113. If the collision risk is not 0, the process proceeds to step S116, and if the collision risk is 0, the process proceeds to step S117.

ステップS116では、衝突判定部115が図4に示したテーブルに基づいて、警告音を決定し、スピーカ106より自車両の運転者に警告を行う。   In step S116, the collision determination unit 115 determines a warning sound based on the table shown in FIG. 4 and issues a warning to the driver of the host vehicle through the speaker 106.

次に、ステップS117では、時間計測部113にて計測された時間をリセットする(TM=0)。   Next, in step S117, the time measured by the time measuring unit 113 is reset (TM = 0).

ステップS118では、記憶領域S12の値をリセットする(S12=0)。   In step S118, the value of the storage area S12 is reset (S12 = 0).

また、ステップS109では、検出領域外物体推定部114により、ステップS106で算出した前方物体のデータS11をS12にコピーする(記憶領域S12=記憶領域S11)。   In step S109, the detection object outside detection area 114 copies the forward object data S11 calculated in step S106 to S12 (storage area S12 = storage area S11).

ステップS119では、ステップS105にて、検出領域外物体候補として抽出された時刻を初期時刻(TM = 0)として、時間計測部113が時間計測を開始する。   In step S119, the time measurement unit 113 starts time measurement with the time extracted as the detection object outside detection area in step S105 as the initial time (TM = 0).

最後に、ステップS120では、衝突判定部115において、記憶部110の記憶領域S01、S11に記憶された前方物体のデータをリセットし(S01=S11=0)、スタートへ戻る。   Finally, in step S120, the collision determination unit 115 resets the forward object data stored in the storage areas S01 and S11 of the storage unit 110 (S01 = S11 = 0), and returns to the start.

以上のようにして、この発明の実施の形態1に係る運転支援装置101では、検出領域外物体候補抽出部112が、物体検出部111で検出した物体のうち、所定の条件を満足する物体を検出領域外物体候補として抽出し、検出領域外物体推定部114が、該候補の位置と速度と、時間計測部113により計測された時間と、車速センサ104により計測された自車速とに基づいて、ミリ波レーダの検出領域内において検出領域外物体の位置の推定処理を開始し、所定の時間、推定処理を続けることで、自車両と検出領域外物体とが衝突する危険度を判定し、自車両の運転者に警告を行うことができる。   As described above, in the driving support apparatus 101 according to Embodiment 1 of the present invention, the object outside the detection region candidate extraction unit 112 selects an object that satisfies the predetermined condition among the objects detected by the object detection unit 111. The detection object outside detection area 114 is extracted as a detection object outside detection area, and the detection area outside object estimation unit 114 is based on the position and speed of the candidate, the time measured by the time measurement unit 113, and the own vehicle speed measured by the vehicle speed sensor 104. , By starting the estimation process of the position of the object outside the detection area within the detection area of the millimeter wave radar, and continuing the estimation process for a predetermined time, determine the risk of collision between the host vehicle and the object outside the detection area, A warning can be given to the driver of the host vehicle.

なお、ミリ波レーダ1台により、自車両と検出領域外物体との衝突の警告を運転者に行うため、従来の運転支援装置よりも、装置の構成を簡素に、かつ、低コストにすることができる。また、ミリ波レーダの検出領域のある領域に存在する物体の情報に基づいて、検出領域外の物体に対して位置の推定処理を行うことにより、CPUの処理負荷を軽減することができる。さらに、メモリ(記憶部110)の削減によりコストを低減することができる。加えて、操舵角が操舵角閾値以上となった場合に、衝突判定部115が、自車両と検出領域外物体とが衝突する危険度を判定し、自車両の運転者に警告を行うことで、車線変更時や交差点での右左折時等、現在の状況を考慮した必要なタイミングで警告を行うことができる。   Since a single millimeter wave radar warns the driver of a collision between the host vehicle and an object outside the detection area, the configuration of the device is simpler and less expensive than the conventional driving support device. Can do. Further, the processing load of the CPU can be reduced by performing position estimation processing on an object outside the detection area based on information on the object existing in a certain area of the detection area of the millimeter wave radar. Further, the cost can be reduced by reducing the memory (storage unit 110). In addition, when the steering angle is equal to or greater than the steering angle threshold, the collision determination unit 115 determines the risk of collision between the host vehicle and an object outside the detection area, and warns the driver of the host vehicle. Warnings can be given at the necessary timing in consideration of the current situation, such as when changing lanes or turning left and right at intersections.

実施の形態2.
図6は、この発明の実施の形態2に係る運転支援装置の構成を示すブロック図である。本実施の形態に係る運転支援装置101の構成は、実施の形態1に係る運転支援装置101に、検出領域外物体判定部601が加わったものである。
Embodiment 2. FIG.
FIG. 6 is a block diagram showing the configuration of the driving support apparatus according to Embodiment 2 of the present invention. The configuration of the driving assistance apparatus 101 according to the present embodiment is obtained by adding a detection area outside object determination unit 601 to the driving assistance apparatus 101 according to the first embodiment.

検出領域外物体判定部601は、検出領域外物体候補抽出部112が前サンプリング時刻において抽出した検出領域外物体候補(抽出方法については、実施の形態1にて説明済みであるため説明を省略する)の情報(位置と速度)に対応できる、現サンプリング時刻において検出した物体の情報(位置と速度)が無い場合、前サンプリング時刻の検出領域外物体候補を検出領域外物体と判定する。   The detection area outside object determination unit 601 omits the detection area outside object candidate extracted by the detection area outside object candidate extraction unit 112 at the previous sampling time (the extraction method has already been described in Embodiment 1, and thus the description thereof is omitted. If there is no information (position and speed) of the object detected at the current sampling time that can correspond to the information (position and speed), the object outside the detection area at the previous sampling time is determined as an object outside the detection area.

ここで、図7に検出領域外物体判定方法について示す。まず、前サンプリング時刻T=0で抽出された検出領域外物体候補が等速直線運動をすると仮定して、現サンプリング時刻T=1における該物体の位置は、検出領域外物体判定部601により、下記の式(2)の通り推定される。   Here, FIG. 7 shows a detection area outside object determination method. First, assuming that the object candidate outside the detection area extracted at the previous sampling time T = 0 has a uniform linear motion, the position of the object at the current sampling time T = 1 is determined by the object detection part outside detection area 601. It is estimated as the following equation (2).

(B’X1, B’Y1) = (BX0, BY0) − (0, (VA1 − VB0) × TS) (2)   (B’X1, B’Y1) = (BX0, BY0) − (0, (VA1 − VB0) × TS) (2)

ここで、
前サンプリング時刻T=0で抽出された検出領域外物体候補Bの位置を(BX0[m], BY0[m])、速度をVB0[m/s]、
現サンプリング時刻T=1において推定される該物体B’の位置を(B’X1[m], B’Y1[m])、
現サンプリング時刻T=1において検出される自車速をVA1[m/s]、サンプリング周期をTS[s]とする。
here,
The position of the detection object outside object candidate B extracted at the pre-sampling time T = 0 is (BX0 [m], BY0 [m]), the speed is VB0 [m / s],
The position of the object B ′ estimated at the current sampling time T = 1 is (B′X1 [m], B′Y1 [m]),
The vehicle speed detected at the current sampling time T = 1 is VA1 [m / s], and the sampling period is TS [s].

そして、現サンプリング時刻T=1において検出された物体Cの位置を(CX1[m], CY1[m])、速度をVC1[m/s]とすると、物体B’と物体Cとの位置の差(X方向の差Xdif、Y方向の差Ydif)、そして速度の差Vdifはそれぞれ下記の式(3)(4)と(5)の通りとなる。   If the position of the object C detected at the current sampling time T = 1 is (CX1 [m], CY1 [m]) and the speed is VC1 [m / s], the position of the object B ′ and the object C The difference (difference Xdif in the X direction, difference Ydif in the Y direction) and the difference Vdif in speed are as shown in the following equations (3), (4), and (5), respectively.

Xdif = |(B’X1 − CX1)| (3)
Ydif = |(B’Y1 − CY1)| (4)
Vdif = |(VB0 − VC1)| (5)
Xdif = | (B'X1 − CX1) | (3)
Ydif = | (B'Y1 − CY1) | (4)
Vdif = | (VB0 − VC1) | (5)

そして、これらの値が所定の検出領域外判定閾値を満足しない場合、検出領域外物体判定部601は、前サンプリング時刻T=0で抽出された検出領域外物体候補がT=1において、検出領域外に外れた、すなわち、検出領域外物体となったと判定する。なお、前記検出領域外判定閾値については、例えば、Xdif = Ydif = 1[m]未満、Vdif = 1[m/s]未満と設定し、記憶部110に記憶しておく。   If these values do not satisfy the predetermined detection area outside determination threshold, the detection area outside object determination unit 601 determines that the detection area outside object candidate extracted at the previous sampling time T = 0 is T = 1 and the detection area It is determined that the object has fallen outside, that is, an object outside the detection area. The out-of-detection-area determination threshold is set, for example, as less than Xdif = Ydif = 1 [m] and less than Vdif = 1 [m / s], and is stored in the storage unit 110.

また、時間計測部113は前記検出領域外物体判定部601により、検出領域外物体と判定された時間を初期時間として、所定の間、時間計測を行う。時間計測部113は、実施の形態1で説明した通り、衝突判定部115により、自車両と検出領域外物体との衝突の危険度が判定され、警告が行われた後、時間計測を終了する。また、警告が行われない場合は、所定の時間経過すると、時間計測を終了する。   In addition, the time measuring unit 113 performs time measurement for a predetermined time using the time determined as an object outside the detection region by the detection region outside object determination unit 601 as an initial time. As described in the first embodiment, the time measurement unit 113 ends the time measurement after the collision determination unit 115 determines the risk of collision between the host vehicle and the object outside the detection area and gives a warning. . If no warning is given, the time measurement ends when a predetermined time has elapsed.

検出領域外物体推定部114は、サンプリング時刻T=N(N≧1)における検出領域外物体の位置(XN[m], YN[m])を、
検出領域外物体判定部601において判定された検出領域外物体候補の位置(X0[m], Y0[m])と速度VB0[m/s]と、
時間計測部113により計測された時間TMと、
車速センサ104により計測されたサンプリング時刻T=Nでの自車速VAN[m/s]と、
サンプリング周期TS[s]と、
に基づいて、下記の式(6)の通り推定する。
The detection area outside object estimation unit 114 calculates the position (XN [m], YN [m]) of the detection area outside object at the sampling time T = N (N ≧ 1).
The position (X0 [m], Y0 [m]) of the detection object outside detection area determined by the detection object outside detection area 601 and the velocity VB0 [m / s],
Time TM measured by the time measuring unit 113,
The vehicle speed VAN [m / s] at the sampling time T = N measured by the vehicle speed sensor 104,
Sampling period TS [s],
Based on the above, it is estimated as the following formula (6).

(XN, YN) = (X(N−1), Y(N−1)) − (0, (VAN − VB0) × (TM + 1) × TS) (6)   (XN, YN) = (X (N−1), Y (N−1)) − (0, (VAN − VB0) × (TM + 1) × TS) (6)

したがって、本実施の形態に係る運転支援装置は、ミリ波レーダの検出領域外において検出領域外物体の位置の推定処理を開始する。   Therefore, the driving assistance apparatus according to the present embodiment starts the process of estimating the position of the object outside the detection area outside the detection area of the millimeter wave radar.

また、記憶部110は、少なくとも、物体検出部111において検出された物体の極座標系のデータである距離、相対速度、角度を記憶する領域と、該データと車速センサ104が検出した自車速の車速とに基づき算出された直交座標系のデータである位置、速度を記憶する領域とを、下記の通り備える。   Further, the storage unit 110 stores at least an area for storing distance, relative speed, and angle, which are data in the polar coordinate system of the object detected by the object detection unit 111, and the vehicle speed of the host vehicle speed detected by the vehicle speed sensor 104. And an area for storing the position and speed, which are data of the orthogonal coordinate system calculated based on the following.

・極座標系
・現サンプリング時刻における物体検出部111で検出された物体のデータの記憶領域S01
・直交座標系
・前サンプリング時刻における検出領域外物体候補抽出部112で抽出された物体のデータの記憶領域S10
・現サンプリング時刻における物体検出部111で検出された物体のデータの記憶領域S11
・検出領域外物体推定部114で推定されたデータの記憶領域S12
Polar coordinate system Data storage area S01 of the object detected by the object detection unit 111 at the current sampling time
Cartesian coordinate system Storage area S10 for object data extracted by the detection object candidate outside detection area 112 at the previous sampling time
-Data storage area S11 of the object detected by the object detection unit 111 at the current sampling time
The data storage area S12 estimated by the detection area outside object estimation unit 114

なお、その他の機能ブロックについては実施の形態1と同様であるため、説明を省略する。   Since other functional blocks are the same as those in the first embodiment, description thereof is omitted.

続いて、本実施の形態に係る運転支援装置の動作について図8に基づいて説明する。図8は、本実施の形態に係る運転支援装置の動作を示すフローチャートである。   Subsequently, the operation of the driving support apparatus according to the present embodiment will be described with reference to FIG. FIG. 8 is a flowchart showing the operation of the driving support apparatus according to the present embodiment.

まずステップS201では、物体検出部111において物体が検出されたかどうか判定する。物体が検出された場合、ステップS202へ、物体が検出されない場合はスタートへ戻る。   First, in step S201, it is determined whether or not an object is detected by the object detection unit 111. If an object is detected, the process returns to step S202. If no object is detected, the process returns to START.

ステップS202では、物体検出部111において、検出された物体の距離、相対速度、角度を算出する。また、算出した値は、記憶部110の記憶領域S01に記憶される。   In step S202, the object detection unit 111 calculates the distance, relative speed, and angle of the detected object. The calculated value is stored in the storage area S01 of the storage unit 110.

次に、ステップS203では、物体検出部111において、ステップS202で算出された距離、相対速度、角度と、車速センサ104が検出した自車両の車速とに基づいて、検出した物体の位置と速度を算出する。そして、算出された値は、記憶部110の記憶領域S11に記憶される。   Next, in step S203, the object detection unit 111 calculates the position and speed of the detected object based on the distance, relative speed, angle calculated in step S202, and the vehicle speed of the host vehicle detected by the vehicle speed sensor 104. calculate. The calculated value is stored in the storage area S11 of the storage unit 110.

ステップS204では、検出領域外物体判定部601において、前サンプリング時刻において、検出領域外物体候補抽出部112により抽出された物体が存在するかどうかの判定を行う。すなわち、記憶部110の記憶領域S10の値が0でないかどうかの判定を行う。記憶領域S10の値が0でなければステップS205へ、記憶領域S10の値が0であればステップS206へ進む。   In step S204, the detection area outside object determination unit 601 determines whether or not the object extracted by the detection area outside object candidate extraction unit 112 exists at the previous sampling time. That is, it is determined whether the value of the storage area S10 of the storage unit 110 is not zero. If the value of the storage area S10 is not 0, the process proceeds to step S205. If the value of the storage area S10 is 0, the process proceeds to step S206.

次に、ステップS205では、検出領域外物体判定部601において、上述の式(2)〜(5)に基づいて、記憶領域S11に記憶された値が、記憶領域S10に記憶された値から推定されるかどうかの判断を行う。そして、記憶領域S11の値が記憶領域S10より推定される場合はステップS206へ、推定されない場合はステップS207へ進む。   Next, in step S205, the detection area outside object determination unit 601 estimates the value stored in the storage area S11 from the value stored in the storage area S10 based on the above-described equations (2) to (5). Judge whether or not. If the value of the storage area S11 is estimated from the storage area S10, the process proceeds to step S206. If not, the process proceeds to step S207.

ステップS207では、検出領域外物体判定部601が、ステップS205における条件を満足する検出領域外物体候補を検出領域外物体であると判定する。   In step S207, the detection area outside object determination unit 601 determines that a detection area outside object candidate that satisfies the condition in step S205 is a detection area outside object.

続いて、ステップS208において、検出領域外物体と判定された時間を初期時間として、時間計測部113により時間計測が開始される(TM = 0)。   Subsequently, in step S208, time measurement is started by the time measurement unit 113 with the time determined as an object outside the detection area as the initial time (TM = 0).

ステップS209では、検出領域外物体推定部114により、検出領域外物体の位置の推定が上述の式(6)に基づいて行われる。   In step S209, the detection area outside object estimation unit 114 estimates the position of the detection area outside object based on the above equation (6).

続いて、ステップS210では、推定した検出領域外物体の位置が、記憶部110の記憶領域S12に記憶される。   Subsequently, in step S <b> 210, the estimated position of the object outside the detection area is stored in the storage area S <b> 12 of the storage unit 110.

ステップS211では、操舵角センサ105により検出された自車両の操舵角が操舵角閾値以上であるかどうか判定される。条件式(操舵角≧操舵角閾値)を満足する場合はステップS212へ、満足しない場合はS213へ進む。操舵角閾値に関しては、実施の形態1と同様であるので説明を省略する。   In step S211, it is determined whether or not the steering angle of the host vehicle detected by the steering angle sensor 105 is equal to or greater than a steering angle threshold. If the conditional expression (steering angle ≧ steering angle threshold) is satisfied, the process proceeds to step S212. If not satisfied, the process proceeds to S213. Since the steering angle threshold is the same as that of the first embodiment, the description thereof is omitted.

ステップS212では、衝突判定部115において、前記推定された検出領域外物体の位置に基づく自車両との距離と図4に示した衝突危険度判定テーブルとを比較する。   In step S212, the collision determination unit 115 compares the distance from the host vehicle based on the estimated position of the object outside the detection area with the collision risk determination table shown in FIG.

一方、ステップS213では、時間計測部113にて計測された時間が時間閾値以上かどうかを判定する。条件(時間≧時間閾値)を満足する場合は、ステップS216へ、条件を満たさない場合はステップS222へ進む。なお、時間閾値に関しては、実施の形態1と同様であるため説明を省略する。   On the other hand, in step S213, it is determined whether the time measured by the time measuring unit 113 is equal to or greater than the time threshold. If the condition (time ≧ time threshold) is satisfied, the process proceeds to step S216. If the condition is not satisfied, the process proceeds to step S222. Since the time threshold is the same as that in the first embodiment, the description thereof is omitted.

ステップS214では、衝突判定部115において、ステップS212における比較結果に基づき、衝突危険度が0でないかどうかを判定する。衝突危険度が0でない場合はステップS215へ、衝突危険度が0である場合はステップS216へ進む。   In step S214, the collision determination unit 115 determines whether the collision risk is not 0 based on the comparison result in step S212. If the collision risk is not 0, the process proceeds to step S215. If the collision risk is 0, the process proceeds to step S216.

ステップS215では、衝突判定部115が図4に示したテーブルに基づいて、警告音を決定し、スピーカ106より自車両の運転者に警告を行う。   In step S215, the collision determination unit 115 determines a warning sound based on the table shown in FIG. 4 and issues a warning to the driver of the host vehicle through the speaker 106.

次に、ステップS216では、時間計測部113にて計測された時間をリセットする(TM=0)。   Next, in step S216, the time measured by the time measuring unit 113 is reset (TM = 0).

ステップS217では、記憶領域S12の値をリセットする(S12=0)。   In step S217, the value in the storage area S12 is reset (S12 = 0).

一方、ステップS206では、検出領域外物体候補抽出部112において、記憶部110の記憶領域S01に記憶されている物体のデータのうち、相対速度が相対速度<0、かつ角度が角度≧角度閾値である物体が存在するかどうかを判定する。本条件式を満足する物体が存在する場合は、ステップS218へ、満足する物体が存在しない場合は、ステップS220へ進む。   On the other hand, in step S206, out-of-detection object candidate extraction unit 112, among the object data stored in storage region S01 of storage unit 110, the relative speed is <0 and the angle is angle ≧ angle threshold. It is determined whether or not an object exists. If there is an object that satisfies this conditional expression, the process proceeds to step S218. If there is no object that satisfies the conditional expression, the process proceeds to step S220.

そして、ステップS218では、ステップS206の判定条件を満足する物体が、検出領域外物体候補抽出部112により検出領域外物体候補として抽出される。   In step S218, an object that satisfies the determination condition in step S206 is extracted as a detection area outside object candidate by the detection area outside object candidate extraction unit 112.

ステップS219では、ステップS218で抽出した検出領域外物体候補の位置と速度が記憶部110の記憶領域S10に記憶される。   In step S219, the position and speed of the object outside the detection area extracted in step S218 are stored in the storage area S10 of the storage unit 110.

ステップS220では、検出領域外物体推定部114により、記憶領域S12の値が0でないかどうかが判定される。記憶領域S12の値が0でない場合はステップS221へ、記憶領域S12の値が0の場合はステップS222へ進む。   In step S220, the detection area outside object estimation unit 114 determines whether the value of the storage area S12 is not zero. If the value of the storage area S12 is not 0, the process proceeds to step S221. If the value of the storage area S12 is 0, the process proceeds to step S222.

ステップS221では、時間計測部113により、計測時間がインクリメントされ、ステップS209へ進む。   In step S221, the time measurement unit 113 increments the measurement time, and the process proceeds to step S209.

最後に、ステップS222では、衝突判定部115において、記憶部110の記憶領域S01、S11に記憶された前方物体のデータをリセットし(S01=S11=0)、スタートへ戻る。   Finally, in step S222, the collision determination unit 115 resets the forward object data stored in the storage areas S01 and S11 of the storage unit 110 (S01 = S11 = 0), and returns to the start.

以上のようにして、この発明の実施の形態2に係る運転支援装置101では、検出領域外物体判定部601が、検出領域外物体候補抽出部112が前サンプリング時刻において抽出した検出領域外物体候補の情報(位置と速度)に対応できる、現サンプリング時刻において検出した物体の情報(位置と速度)が無い場合、前サンプリング時刻の検出領域外物体候補を検出領域外物体と判定し、検出領域外物体推定部114が、該物体の位置と速度と、時間計測部113により計測された時間と、車速センサ104により計測された自車速とに基づいて、ミリ波レーダの検出領域外において検出領域外物体の位置の推定処理を開始し、所定の時間、推定処理を続けることで、自車両と検出領域外物体とが衝突する危険度を判定し、自車両の運転者に警告を行うことができる。   As described above, in the driving assistance apparatus 101 according to Embodiment 2 of the present invention, the detection area outside object determination unit 601 detects the detection area outside object candidate extracted by the detection area outside object candidate extraction unit 112 at the previous sampling time. If there is no information (position and speed) of the object detected at the current sampling time that can correspond to the information (position and speed), the candidate outside the detection area at the previous sampling time is determined to be an object outside the detection area and out of the detection area. Based on the position and speed of the object, the time measured by the time measurement unit 113, and the own vehicle speed measured by the vehicle speed sensor 104, the object estimation unit 114 is outside the detection region outside the detection region of the millimeter wave radar. By starting the object position estimation process and continuing the estimation process for a predetermined time, the risk of collision between the vehicle and the object outside the detection area is determined, and the driver of the vehicle is warned. You can make a notification.

なお、ミリ波レーダ1台により、自車両と検出領域外物体との衝突の警告を運転者に行うため、従来の運転支援装置よりも、装置の構成を簡素に、かつ、低コストにすることができる。また、ミリ波レーダの検出領域内から検出領域外へと外れたと推定される物体に対して、位置の推定処理を行うため、検出領域外の物体の位置を正確に推定できる。そして、ミリ波レーダの検出領域外において、検出領域外物体の位置の推定処理を開始するため、推定処理を行う対象、時間を削減し、CPUの処理負荷を軽減することができる。さらに、メモリ(記憶部110)の削減によりコストを低減することができる。加えて、操舵角が操舵角閾値以上となった場合に、衝突判定部が、自車両と検出領域外物体とが衝突する危険度を判定し、自車両の運転者に警告を行うことで、車線変更時や交差点での右左折時等、現在の状況を考慮した必要なタイミングで警告を行うことができる。   Since a single millimeter wave radar warns the driver of a collision between the host vehicle and an object outside the detection area, the configuration of the device is simpler and less expensive than the conventional driving support device. Can do. In addition, since the position estimation process is performed on an object that is estimated to be out of the detection area from the detection area of the millimeter wave radar, the position of the object outside the detection area can be accurately estimated. And since the estimation process of the position of the object outside the detection area is started outside the detection area of the millimeter wave radar, it is possible to reduce the target and time for the estimation process and reduce the processing load on the CPU. Further, the cost can be reduced by reducing the memory (storage unit 110). In addition, when the steering angle is equal to or greater than the steering angle threshold, the collision determination unit determines the risk of collision between the host vehicle and an object outside the detection area, and warns the driver of the host vehicle. Warnings can be given at the necessary timing in consideration of the current situation, such as when changing lanes or turning left and right at intersections.

なお、上記各実施の形態において、送受信部107、変換部108、物体検出部111で物体検出手段を構成し、
車速センサ104、操舵角センサ105、外部からのウィンカーの点灯または操作を示す信号で車両状態検出手段を構成し、
衝突判定部115で衝突判定手段を構成し、
スピーカ106で警告手段を構成し、
検出領域外物体推定部114で検出領域外物体推定手段を構成し、
検出領域外物体候補抽出部112が検出領域外物体候補抽出手段を構成し、
記憶部110が検出領域外物体候補記憶手段、検出領域外物体記憶手段を構成し、
時間計測部113が時間計測手段を構成し、
検出領域外物体判定部601が検出領域外物体判定手段を構成する。
In each of the above embodiments, the transmission / reception unit 107, the conversion unit 108, and the object detection unit 111 constitute an object detection unit,
The vehicle state detection means is composed of a vehicle speed sensor 104, a steering angle sensor 105, and a signal indicating the turn-on or operation of the blinker from the outside,
The collision determination unit 115 constitutes a collision determination means,
The speaker 106 constitutes a warning means,
The detection area outside object estimation unit 114 constitutes a detection area outside object estimation means,
The detection area outside object candidate extraction unit 112 constitutes a detection area outside object candidate extraction means,
The storage unit 110 constitutes a detection area outside object candidate storage means and a detection area outside object storage means,
The time measuring unit 113 constitutes a time measuring means,
The detection area outside object determination unit 601 constitutes a detection area outside object determination means.

またこの発明は、上記各実施の形態に限定されるものではなく、これらの実施の形態の可能な組み合わせを全て含むことは云うまでもない。   Further, the present invention is not limited to the above embodiments, and it is needless to say that all possible combinations of these embodiments are included.

101 運転支援装置、102 前方物体、103 ミリ波レーダ、104 車速センサ、105 操舵角センサ、106 スピーカ、107 送受信部、108 変換部、109 CPU、110 記憶部、111 物体検出部、112 検出領域外物体候補抽出部、113 時間計測部、114 検出領域外物体推定部、115 衝突判定部、601 検出領域外物体判定部。   DESCRIPTION OF SYMBOLS 101 Driver assistance apparatus, 102 Front object, 103 Millimeter wave radar, 104 Vehicle speed sensor, 105 Steering angle sensor, 106 Speaker, 107 Transmission / reception part, 108 Conversion part, 109 CPU, 110 Storage part, 111 Object detection part, 112 Out of detection area Object candidate extraction unit, 113 time measurement unit, 114 detection area outside object estimation unit, 115 collision determination unit, 601 detection area outside object determination unit.

Claims (3)

自車両前方の物体を検出する物体検出手段と、
自車両の少なくとも車速を検出する車両状態検出手段と、
自車両が物体と衝突する危険度を判定する衝突判定手段と、
前記衝突判定手段の判定結果に基づいて警告を行う警告手段と、
を備える運転支援装置において、
前記物体検出手段の検出領域内に存在していたときの前記物体の位置と速度とに基づき前記物体検出手段の検出領域外に存在する検出領域外物体の位置を、所定の間、推定し続ける検出領域外物体推定手段を備え、
前記衝突判定手段により、自車両が、前記検出領域外物体推定手段により推定した検出領域外物体と衝突する危険度を判定し、前記警告手段により自車両が前記検出領域外物体と衝突する可能性があることを警告し、さらに、
前記物体検出手段で検出した物体のうち、相対速度が(−自車速)<相対速度<0、かつ水平角度が所定値以上である物体を検出領域外物体候補として抽出する検出領域外物体候補抽出手段を備え、
前記検出領域外物体推定手段は、前記検出領域外物体候補の位置と速度に基づいて、検出領域外物体の位置を推定し続け、さらに、
前記検出領域外物体候補抽出手段により検出領域外物体候補と判定され抽出された時の物体の位置と速度とを所定の間、記憶する検出領域外物体候補記憶手段と、
前記検出領域外物体候補抽出手段により検出領域外物体候補として抽出された時刻を初期時刻とし、所定の間、時間計測を行う時間計測手段と、
を備え、
前記検出領域外物体推定手段は、前記検出領域外物体候補記憶手段に記憶された、検出領域外物体候補の抽出された時の位置と速度と、前記時間計測手段が計測した対応する抽出された前記初期時刻からの時間とに基づいて検出領域外物体候補が等速直線運動するものとして検出領域外物体の位置を推定し続ける、
ことを特徴とする運転支援装置。
Object detection means for detecting an object in front of the host vehicle;
Vehicle state detection means for detecting at least the vehicle speed of the host vehicle;
A collision determination means for determining a risk of collision of the host vehicle with an object;
Warning means for giving a warning based on the determination result of the collision determination means;
In a driving support device comprising:
Based on the position and speed of the object when existing in the detection area of the object detection means, the position of the object outside the detection area existing outside the detection area of the object detection means is continuously estimated for a predetermined period. A detection area outside object estimation means,
The collision determination means determines a risk of collision of the own vehicle with an object outside the detection area estimated by the detection area outside object estimation means, and the warning means may cause the own vehicle to collide with the object outside the detection area. Warning that there is, and
Out-of-detection area object candidate extraction for extracting an object whose relative speed is (−own vehicle speed) <relative speed <0 and the horizontal angle is equal to or greater than a predetermined value from the objects detected by the object detection means With means,
The detection region outside the object estimating means based on the position and velocity of the detection area outside the object candidate continues to estimate the position of the detection area outside the object, further,
An out-of-detection area object candidate storage means for storing the position and speed of the object for a predetermined period when it is determined to be an out-of-detection area object candidate and extracted by the out-of-detection area object candidate extraction means;
Time measurement means for measuring the time for a predetermined time, with the time extracted as the detection area outside object candidate by the detection area outside object candidate extraction means as an initial time;
With
The detection area outside object estimation means is stored in the detection area outside object candidate storage means, the position and speed when the detection area outside object candidate is extracted, and the corresponding extracted by the time measurement means. Based on the time from the initial time, continue to estimate the position of the object outside the detection region as a candidate outside the detection region linearly moves at a constant speed,
A driving support device characterized by that.
前記衝突判定手段は、前記車両状態検出手段により外部からのウィンカーの点灯または操作を示す信号を検出した場合、前記検出領域外物体推定手段により推定した検出領域外物体が、自車両と衝突する危険度を判定することを特徴とする請求項1に記載の運転支援装置。 The collision determination means may detect that the detection object outside the detection area estimated by the detection area outside object estimation means collides with the host vehicle when the vehicle state detection means detects a signal indicating turn-on or operation of an external blinker. The driving support device according to claim 1 , wherein the degree is determined. 前記衝突判定手段は、前記車両状態検出手段により操舵角が所定値以上であることを検出した場合、前記検出領域外物体推定手段により推定した検出領域外物体が自車両と衝突する危険度を判定することを特徴とする請求項1に記載の運転支援装置。 When the vehicle state detection unit detects that the steering angle is equal to or greater than a predetermined value, the collision determination unit determines a risk of collision of an object outside the detection area estimated by the detection area outside object estimation unit with the host vehicle. The driving support apparatus according to claim 1 , wherein:
JP2012085434A 2012-04-04 2012-04-04 Driving assistance device Active JP5496242B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012085434A JP5496242B2 (en) 2012-04-04 2012-04-04 Driving assistance device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012085434A JP5496242B2 (en) 2012-04-04 2012-04-04 Driving assistance device

Publications (2)

Publication Number Publication Date
JP2013214263A JP2013214263A (en) 2013-10-17
JP5496242B2 true JP5496242B2 (en) 2014-05-21

Family

ID=49587532

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012085434A Active JP5496242B2 (en) 2012-04-04 2012-04-04 Driving assistance device

Country Status (1)

Country Link
JP (1) JP5496242B2 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105575183A (en) * 2014-01-26 2016-05-11 浙江吉利控股集团有限公司 Vehicle travel early-warning method
KR101583928B1 (en) * 2014-05-12 2016-01-11 현대자동차주식회사 Method for unfolding external air bag
JP2021071969A (en) * 2019-10-31 2021-05-06 ダイハツ工業株式会社 Driving support device

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4604691B2 (en) * 2004-12-07 2011-01-05 日産自動車株式会社 Alarm device for vehicle, alarm method of vehicle surrounding situation
JP4678247B2 (en) * 2005-06-23 2011-04-27 マツダ株式会社 Vehicle control device
JP5049853B2 (en) * 2008-04-08 2012-10-17 本田技研工業株式会社 Vehicle object detection device

Also Published As

Publication number Publication date
JP2013214263A (en) 2013-10-17

Similar Documents

Publication Publication Date Title
US9714034B2 (en) Vehicle control device
JP5971341B2 (en) Object detection device and driving support device
JP5505427B2 (en) Collision position prediction device
JP5345350B2 (en) Vehicle driving support device
US10836388B2 (en) Vehicle control method and apparatus
US20140333467A1 (en) Object detection device
JP4442520B2 (en) Course estimation device for vehicle
JP6614359B2 (en) Obstacle determination method, parking support method, exit support method, and obstacle determination device
WO2017111135A1 (en) Travel assistance device and travel assistance method
US11351997B2 (en) Collision prediction apparatus and collision prediction method
KR20140144470A (en) Parking control method, device and system
JP2011073529A (en) Vehicle controller
US20190073540A1 (en) Vehicle control device, vehicle control method, and storage medium
JP2012089114A (en) Obstacle recognition device
KR20190056977A (en) Vehicle control device
JP2011123535A (en) Obstacle detection device
JP5496242B2 (en) Driving assistance device
JP4864450B2 (en) Vehicle driving support device
JP6193177B2 (en) Motion support system and object recognition device
US20230347939A1 (en) Driving assistance device
JP4872517B2 (en) Obstacle recognition device
JP2007128232A (en) Obstacle detection device
JP2020107115A (en) Driving assist system
JP6455292B2 (en) Object detection apparatus and object detection method
JP6550887B2 (en) Vehicle control apparatus and vehicle control method

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130808

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20131015

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20131209

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140304

R150 Certificate of patent or registration of utility model

Ref document number: 5496242

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250