JP2012118867A - Road shape estimation apparatus - Google Patents

Road shape estimation apparatus Download PDF

Info

Publication number
JP2012118867A
JP2012118867A JP2010269465A JP2010269465A JP2012118867A JP 2012118867 A JP2012118867 A JP 2012118867A JP 2010269465 A JP2010269465 A JP 2010269465A JP 2010269465 A JP2010269465 A JP 2010269465A JP 2012118867 A JP2012118867 A JP 2012118867A
Authority
JP
Japan
Prior art keywords
road
vehicle
blank
detection
ecu
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
JP2010269465A
Other languages
Japanese (ja)
Other versions
JP5594102B2 (en
Inventor
Koji Suzuki
浩二 鈴木
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 JP2010269465A priority Critical patent/JP5594102B2/en
Publication of JP2012118867A publication Critical patent/JP2012118867A/en
Application granted granted Critical
Publication of JP5594102B2 publication Critical patent/JP5594102B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • G01S13/726Multiple target tracking
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9327Sensor installation details
    • G01S2013/93271Sensor installation details in the front of the vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Image Analysis (AREA)
  • Image Processing (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a road shape estimation apparatus which is capable of accurately estimating a road shape.SOLUTION: A road shape estimation apparatus is provided which is mounted in a vehicle and estimates a shape of a road on which the vehicle travels. The road shape estimation apparatus includes an object detection section which detects positions at which stationary objects are present around the vehicle as a plurality of detection points, a traveling lane recognition section which recognizes a traveling lane indicating the road shape on the basis of the detection points, an empty zone detection section which detects a position where the traveling lane is intercepted as an empty zone on the basis of intervals of the detection points, and a shape estimation section in which, when the blank band is detected, while excluding a recognition result of the traveling lane farther than the empty zone, the shape of the road on which the vehicle travels is estimated on the basis of a traveling lane recognized in the area from the vehicle to the empty zone.

Description

本発明は、道路形状推定装置に関し、より特定的には、車両に搭載され、当該車両が走行している道路の形状を推定する道路形状推定装置に関する。   The present invention relates to a road shape estimation apparatus, and more particularly to a road shape estimation apparatus that is mounted on a vehicle and estimates the shape of a road on which the vehicle is traveling.

従来、車両が走行する道路の形状を推定し、当該道路形状に応じて車両の操舵を制御したり、車両の衝突の危険を報知したりする車載システムが開発されている。上記のような車載システムでは、適切に車両を制御するために道路の形状を正確に推定する必要がある。このような道路の形状を推定するための装置が、例えば、特許文献1に開示されている。   2. Description of the Related Art Conventionally, an in-vehicle system has been developed that estimates the shape of a road on which a vehicle travels, controls the steering of the vehicle according to the road shape, and notifies the danger of a vehicle collision. In the in-vehicle system as described above, it is necessary to accurately estimate the shape of the road in order to appropriately control the vehicle. An apparatus for estimating such a road shape is disclosed in, for example, Patent Document 1.

特許文献1に開示される車両用道路形状認識装置は、ガードレール等の路側静止物の位置および形状を、電波レーダーから得られる複数の検出点に基づいて検出する。具体的には、車両用道路形状認識装置は、電波レーダーにより得られた複数の検出点のうち近接する検出点同士から成る検出点グループを抽出し、当該検出点グループをガードレール等の路側静止物として検出する。一般的に、ガードレール等の路側静止物は、車両が走行する道路に沿って配置され、当該道路と相似した形状を成している。したがって、車両用道路形状認識装置は、上記のようにして検出したガードレール等の路側静止物を表す検出点グループの形状に基づいて道路形状を推定算出することができる。   The vehicle road shape recognition device disclosed in Patent Document 1 detects the position and shape of a roadside stationary object such as a guardrail based on a plurality of detection points obtained from a radio wave radar. Specifically, the vehicle road shape recognition device extracts a detection point group composed of adjacent detection points among a plurality of detection points obtained by a radio wave radar, and the detection point group is used as a roadside stationary object such as a guardrail. Detect as. Generally, a roadside stationary object such as a guardrail is arranged along a road on which a vehicle travels, and has a shape similar to the road. Therefore, the vehicle road shape recognition device can estimate and calculate the road shape based on the shape of the detection point group representing the roadside stationary object such as the guardrail detected as described above.

特開2007−161162号公報JP 2007-161162 A

しかしながら、上記特許文献1のような車両用道路形状認識装置のようなロジックによって道路形状を推定した場合、自車両が進行する道路の形状を正確に推定できないおそれがあった。   However, when the road shape is estimated by logic such as the vehicle road shape recognition device as in Patent Document 1, there is a possibility that the shape of the road on which the host vehicle travels cannot be estimated accurately.

例えば、図11のように自車両が進行する道路形状が突然形状が大きく変化している(例えばT字路になっている)場合を想定する。図11は、従来の技術で道路の形状を推定した結果の例を示す図である。なお、図11において、レーダーで検出された検出点P111〜137の位置を黒丸印で示す。また、当該検出点に基づき従来の技術で道路形状を推定した結果を、太線で示す。太線で示すように、従来の技術では、自車両が進行している道路を示す検出点P111〜116と、T字路の突き当たりを示す検出点P121〜126とを同一のグループとしてグルーピングしてしまう場合がある。すなわち、従来の技術では、自車両が走行する道路が実際には前方の交差路との合流部において終端を迎えているにも拘わらず(図11の点線)、カーブ路として続いているものとして誤認識してしまうおそれがあった(図11の太線)。このように、従来の技術では、T字路等において自車両が走行する道路の形状を正確に推定できない場合があった。   For example, a case is assumed in which the shape of the road on which the host vehicle travels suddenly changes greatly (for example, a T-shaped road) as shown in FIG. FIG. 11 is a diagram illustrating an example of a result of estimating the shape of a road by a conventional technique. In FIG. 11, the positions of the detection points P111 to 137 detected by the radar are indicated by black circles. Moreover, the result of having estimated the road shape by the conventional technique based on the said detection point is shown by a thick line. As shown by the thick line, in the conventional technique, the detection points P111 to 116 indicating the road on which the host vehicle is traveling and the detection points P121 to 126 indicating the end of the T-junction are grouped as the same group. There is a case. In other words, in the conventional technology, the road on which the host vehicle is traveling continues as a curved road even though the road actually ends at the junction with the front intersection (dotted line in FIG. 11). There was a risk of misrecognition (thick line in FIG. 11). As described above, in the conventional technique, the shape of the road on which the vehicle travels on a T-shaped road or the like cannot be accurately estimated.

そして、自車両に搭載された車両制御装置がこのように誤って認識された道路形状に基づいて車両制御を行うと、不適切な車両制御が実行され、ドライバに煩わしさを感じさせてしまう場合があった。   And, when the vehicle control device mounted on the host vehicle performs vehicle control based on the road shape that is erroneously recognized in this way, inappropriate vehicle control is executed, and the driver feels bothered was there.

本発明は上記の課題を鑑みて成されたものであり、道路形状を正確に推定可能とする道路形状推定装置を提供することを目的とする。   The present invention has been made in view of the above problems, and an object of the present invention is to provide a road shape estimation device capable of accurately estimating a road shape.

上記の課題を解決するため、本願は以下の構成を採用した。すなわち、第1の発明は、
車両に搭載され、当該車両が走行する道路の形状を推定する道路形状推定装置であって、車両周囲の静止物の存在位置を複数の検出点として検出する物体検出部と、検出点に基づいて道路形状を示す走路線を認識する走路線認識部と、検出点の間隔に基づいて走路線が途切れている箇所を空白帯として検出する空白帯検出部と、空白帯が検出された場合、車両から空白帯までの領域において認識された走路線に基づいて車両が走行する道路の形状を推定する形状推定部とを備えることを特徴とする、道路形状推定装置である。
In order to solve the above problems, the present application adopts the following configuration. That is, the first invention is
A road shape estimation device that is mounted on a vehicle and estimates the shape of a road on which the vehicle travels, and an object detection unit that detects the positions of stationary objects around the vehicle as a plurality of detection points, and based on the detection points A road line recognition unit for recognizing a road line indicating a road shape, a blank band detection unit for detecting a point where the road line is interrupted based on the interval between detection points, and a blank band are detected. And a shape estimation unit for estimating the shape of the road on which the vehicle travels based on the travel route recognized in the region from the blank zone to the blank zone.

第2の発明は、第1の発明において、空白帯検出部において空白帯を検出するための空白帯検出閾値を車両から空白帯の開始位置を示す検出点までの距離に基づいて算出する閾値算出手段をさらに備え、空白帯検出部は、検出点の間隔が空白帯検出閾値より長い場合、当該検出点の間の領域を空白帯として検出することを特徴とする。   According to a second invention, in the first invention, a threshold calculation for calculating a blank band detection threshold for detecting a blank band in the blank band detection unit based on a distance from the vehicle to a detection point indicating a start position of the blank band. And a blank band detection unit that detects a region between the detection points as a blank band when the interval between the detection points is longer than a blank band detection threshold.

第3の発明は、第1および2の発明において、走路線算出部は、走路線として、道路の左端形状を示す左側走路線、および道路の右端形状を示す右側走路線を算出し、空白帯検出部は、左側走路線および右側走路線の各々について空白帯を検出し、左側走路線における空白帯の検出結果、および右側走路線における空白帯の検出結果に基づいて、車両の進行先における道路の接続状況を判定する道路接続判定部をさらに備えることを特徴とする。   According to a third invention, in the first and second inventions, the runway line calculation unit calculates a left runway line indicating the left end shape of the road and a right runway line indicating the right end shape of the road as the runway line. The detection unit detects a blank band for each of the left and right lane lines, and based on the detection result of the blank band on the left lane line and the detection result of the blank band on the right lane line, the road in the destination of the vehicle It further comprises a road connection determination unit for determining the connection status of the vehicle.

第4の発明は、第3の発明において、道路接続判定部は、左側走路線および右側走路線の双方において空白帯が検出され、且つ、車両から左側走路線の空白帯までの距離と、車両から右側走路線の空白帯までの距離との差が予め定められた閾値以下である場合、車両の進行先に交差道路が存在すると判定することを特徴とする。   In a fourth aspect based on the third aspect, the road connection determination unit detects a blank zone on both the left lane line and the right lane line, and detects the distance from the vehicle to the blank zone on the left lane line, When the difference from the distance from the blank line on the right lane to the blank zone is equal to or less than a predetermined threshold value, it is determined that an intersection road exists at the destination of the vehicle.

第5の発明は、第3および4の発明において、道路接続判定部は、左側走路線および右側走路線の何れか一方において空白帯が検出された場合、車両の進行先に合流路が存在すると判定することを特徴とする。   According to a fifth aspect of the present invention, in the third and fourth aspects of the present invention, the road connection determination unit determines that there is a combined flow path at the destination of the vehicle when a blank zone is detected on either the left lane line or the right lane line. It is characterized by determining.

第6の発明は、第1から5の発明において、空白帯検出部は、走路線認識部によって車両を基準に所定距離内に始点を有する走路線が認識されていない場合、車両の前端位置から車両に最も近い検出点までの間隔に基づいて、当該車両から当該検出点までの領域を空白帯として検出することを特徴とする。   According to a sixth aspect of the present invention, in the first to fifth aspects of the present invention, the blank band detection unit starts from the front end position of the vehicle when the travel line having a start point within a predetermined distance with respect to the vehicle is not recognized by the travel line recognition unit. A region from the vehicle to the detection point is detected as a blank band based on an interval to the detection point closest to the vehicle.

第1の発明によれば、車両が走行する道路の形状を正確に検出することができる。空白帯は車両が走行する道路と交差する交差路を示し、例えばT字路等である可能性が高い。すなわち、空白帯以遠は道路形状が大きく変化している可能性が高い。つまり、空白帯以遠の走路線の認識結果は、車両が走行する道路の形状示すものである可能性が比較的が低いと考えられる。その点、本発明では、例えば空白帯以遠の走路線の認識結果を除外するなどして、車両から空白帯までの走路線に基づいて道路形状を推定することによって、車両が走行する道路の形状を示すものであると考えられる情報のみに基づいて道路形状を推定することができる。故に、道路の形状を正確に検出することができるのである。   According to the first invention, the shape of the road on which the vehicle is traveling can be accurately detected. The blank zone indicates an intersection that intersects with the road on which the vehicle travels, and is likely to be a T-junction, for example. That is, it is highly possible that the road shape has changed greatly beyond the blank zone. In other words, it is considered that there is a relatively low possibility that the recognition result of the travel route beyond the blank zone indicates the shape of the road on which the vehicle travels. In that respect, in the present invention, the shape of the road on which the vehicle travels is estimated by estimating the road shape based on the route line from the vehicle to the blank zone, for example, by excluding the recognition result of the route line beyond the blank zone. The road shape can be estimated based only on the information that is considered to indicate the above. Therefore, the shape of the road can be accurately detected.

第2の発明によれば、検出点の間隔が比較的大きい箇所を空白帯として、閾値を用いた簡単な処理で検出することができる。また、車両から遠方になるほど検出点の位置がばらつくと考えられるため、空白帯の開始位置に応じて閾値の大きさを変更することによって、このようなばらつきの影響を抑制し、空白帯を正確に検出することができる。   According to the second invention, it is possible to detect a portion having a relatively large interval between detection points as a blank band by a simple process using a threshold value. In addition, the position of the detection point is likely to vary as the distance from the vehicle increases.Therefore, by changing the threshold size according to the start position of the blank band, the influence of such variations can be suppressed, and the blank band can be accurately detected. Can be detected.

第3の発明によれば、カメラ装置やナビゲーション装置を用いることなく、車両の進行先の道路の接続状況を判定することができる。そして、このような判定結果を用いれば、車両を適切に制御することができる。例えば、前方に交差路が存在すると判定された場合には、交差路から進入してくる他車両に注意するよう車両のドライバに警告音を発したり、車両の速度を自動的に低減したりする制御を行うことができる。   According to the third aspect, it is possible to determine the connection status of the road on which the vehicle is traveling without using a camera device or a navigation device. And if such a determination result is used, a vehicle can be controlled appropriately. For example, if it is determined that there is a crossroad ahead, a warning sound is issued to the vehicle driver to pay attention to other vehicles entering from the crossroad, or the vehicle speed is automatically reduced. Control can be performed.

第4の発明によれば、車両の進行先に交差路が存在するか否かを判定することができる。   According to the fourth aspect of the invention, it can be determined whether or not an intersection exists at the destination of the vehicle.

第5の発明によれば、車両の進行先に合流路が存在するか否かを判定することができる。   According to the fifth aspect, it is possible to determine whether or not there is a junction path at the destination of the vehicle.

第6の発明によれば、車両が走行する道路の形状を、より正確に推定することができる。車両近傍から延びていない走路線は、当該車両が走行する道路を示すものである可能性が低いと考えられる。したがって、このような走路線が認識されていない場合には、先ず車両の位置を基準として空白帯を検出することで、車両が走行する道路を示すものである可能性が低いと考えられる走路線情報を、より確実に除外することができる。故に、車両が走行する道路の形状を、より正確に推定することができるのである。   According to the sixth aspect, the shape of the road on which the vehicle travels can be estimated more accurately. A travel route that does not extend from the vicinity of the vehicle is considered to be less likely to indicate a road on which the vehicle travels. Therefore, when such a route line is not recognized, a route line that is considered unlikely to indicate a road on which the vehicle travels by first detecting a blank zone based on the position of the vehicle. Information can be excluded more reliably. Therefore, the shape of the road on which the vehicle travels can be estimated more accurately.

第1の実施形態に係る道路形状推定装置1の構成の一例を示すブロック図The block diagram which shows an example of a structure of the road shape estimation apparatus 1 which concerns on 1st Embodiment. レーダー装置11が検出した検出点の一例を示す図The figure which shows an example of the detection point which the radar apparatus 11 detected 第1の実施形態に係るECU12が実行する処理の詳細を示すフローチャートの一例An example of a flowchart showing details of processing executed by the ECU 12 according to the first embodiment 走路線が認識された状況下で空白帯が認識される様子を示す図The figure which shows a mode that a blank belt is recognized under the situation where a runway is recognized ECU12が実行する不連続走路領域判定処理を示すフローチャートの一例An example of a flowchart showing discontinuous track area determination processing executed by the ECU 12 検出点が比較的長い間隔を隔てて点在している状況において空白帯が認識される様子を示す図The figure which shows a mode that a blank zone is recognized in the condition where the detection points are scattered at a relatively long interval. 自車両から比較的遠方にのみ検出点が検出されている状況において空白帯が認識される様子を示す図The figure which shows a mode that a blank zone is recognized in the condition where the detection point is detected only comparatively far from the own vehicle 空白帯検出閾値Wthを算出するための関数を表すグラフの一例An example of a graph representing a function for calculating the blank band detection threshold Wth 第2の実施形態に係るECU12が実行する処理の詳細を示すフローチャートの一例An example of a flowchart showing details of processing executed by the ECU 12 according to the second embodiment 第2の実施形態に係るECU12が実行する道路接続判定処理を示すフローチャートの一例An example of a flowchart showing a road connection determination process executed by the ECU 12 according to the second embodiment 従来の技術で道路の形状を推定した結果の例を示す図The figure which shows the example of the result of estimating the shape of the road with the conventional technology

(第1の実施形態)
以下、本発明の実施形態に係る道路形状推定装置1について説明する。本発明に係る道路形状推定装置1は、自車両100に搭載され、自車両100が走行する道路の形状を推定する装置である。なお、以下では自車両100が走行する道路を自車走行道路と称する。
(First embodiment)
Hereinafter, a road shape estimation apparatus 1 according to an embodiment of the present invention will be described. The road shape estimation device 1 according to the present invention is a device that is mounted on the host vehicle 100 and estimates the shape of the road on which the host vehicle 100 travels. Hereinafter, the road on which the host vehicle 100 travels is referred to as the host vehicle traveling road.

先ず、図1を参照して道路形状推定装置1のハードウェア構成について説明する。なお、図1は、本発明の実施形態に係る道路形状推定装置1の構成の一例を示すブロック図である。図1に示すように、道路形状推定装置1は、レーダー装置11、およびECU12を備える。また、ECU12は、自車両100に搭載される車両制御装置50と電気的に接続される。   First, the hardware configuration of the road shape estimation apparatus 1 will be described with reference to FIG. FIG. 1 is a block diagram showing an example of the configuration of the road shape estimation apparatus 1 according to the embodiment of the present invention. As shown in FIG. 1, the road shape estimation device 1 includes a radar device 11 and an ECU 12. The ECU 12 is electrically connected to a vehicle control device 50 mounted on the host vehicle 100.

レーダー装置11は、例えば、図2に示すように自車両100の周囲に存在する静止物の位置を複数の検出点として検出する装置である。なお、図2は、レーダー装置11が検出した検出点の一例を示す図である。レーダー装置11は、自車両100の前端に搭載され、自車両100の前方に存在する物体を検出する。レーダー装置11は、典型的にはミリ波長帯の電磁波を送受信するFM−CW方式のレーダー装置である。レーダー装置11は、例えば、電磁波等の検出波信号を自車両100の前方に照射する。そして、物体に反射された当該検出波信号の反射波に基づいて当該反射点の位置を検出点として検出する。レーダー装置11は、図2に示すように、自車両100の前端Oを原点とし、自車両100の進行方向を示す軸線をY軸、当該Y軸と水平面上で垂直に交差する軸線をX軸としたXY座標系で検出点の位置情報を取得する。なお、以下の説明においては、Y軸方向を縦方向、X軸方向を横方向と称する。また、レーダー装置11は、各検出点が静止物を示すものであるか否か判定する。レーダー装置11は、従来周知の手法を用いて検出点が静止物を示すものであるか否か判定して構わない。例えば、先ず、レーダー装置11は、各検出点の自車両100に対する相対速度を検出する。そして、レーダー装置11は、相対速度と自車両100の走行速度とが略同値である場合に、当該検出点が静止物を示すものであると判定する。レーダー装置11は、このようにして静止物を示すものと判定された検出点の位置情報(XY座標)をECU12へ送信する。なお、レーダー装置11は、ノイズ等の影響により、静止物が存在しない位置において検出点を補足する場合がある。   The radar device 11 is a device that detects the positions of stationary objects existing around the host vehicle 100 as a plurality of detection points, for example, as shown in FIG. FIG. 2 is a diagram illustrating an example of detection points detected by the radar apparatus 11. The radar device 11 is mounted on the front end of the host vehicle 100 and detects an object existing in front of the host vehicle 100. The radar device 11 is typically an FM-CW radar device that transmits and receives electromagnetic waves in the millimeter wavelength band. For example, the radar device 11 irradiates a detection wave signal such as an electromagnetic wave in front of the host vehicle 100. Then, the position of the reflection point is detected as a detection point based on the reflected wave of the detection wave signal reflected by the object. As shown in FIG. 2, the radar apparatus 11 uses the front end O of the host vehicle 100 as the origin, the axis indicating the traveling direction of the host vehicle 100 as the Y axis, and the axis that intersects the Y axis perpendicularly on the horizontal plane as the X axis. The position information of the detection point is acquired in the XY coordinate system. In the following description, the Y-axis direction is referred to as the vertical direction, and the X-axis direction is referred to as the horizontal direction. Further, the radar apparatus 11 determines whether or not each detection point indicates a stationary object. The radar apparatus 11 may determine whether or not the detection point indicates a stationary object using a conventionally known method. For example, first, the radar apparatus 11 detects the relative speed of each detection point with respect to the host vehicle 100. And the radar apparatus 11 determines with the said detection point showing a stationary object, when a relative speed and the running speed of the own vehicle 100 are substantially the same value. The radar device 11 transmits the position information (XY coordinates) of the detection point determined to indicate a stationary object in this way to the ECU 12. Note that the radar device 11 may supplement the detection point at a position where no stationary object exists due to the influence of noise or the like.

ECU12は、典型的には、CPU(Central Processing Unit:中央処理装置)などの情報処理装置、メモリなどの記憶装置、およびインターフェース回路などを備える電子制御装置である。   The ECU 12 is typically an electronic control device that includes an information processing device such as a CPU (Central Processing Unit), a storage device such as a memory, an interface circuit, and the like.

車両制御装置50は、例えば、ブレーキ制御装置、ステアリング制御装置、および警報装置等の制御装置である。ブレーキ制御装置、ステアリング制御装置、および警報装置は、ECU12から取得した自車走行道路の形状に応じて、各々、自車両100の走行を制御する。例えば、ブレーキ制御装置、およびステアリング制御装置は、自車両100が自車走行道路を逸脱しないように自車両100の進行方向や走行速度を制御する。また、警報装置は、自車走行道路の端部に存在すると予想されるガードレール等の路側静止物と自車両100との衝突を予測して自車両100のドライバへ音声等により衝突の危険を知らせる警報を発する。すなわち、道路形状推定装置1が自車走行道路の形状を正しく検出することによって、車両制御装置50は、適切な車両制御を実行することができる。   The vehicle control device 50 is a control device such as a brake control device, a steering control device, and an alarm device. The brake control device, the steering control device, and the alarm device each control the travel of the host vehicle 100 according to the shape of the host vehicle travel road acquired from the ECU 12. For example, the brake control device and the steering control device control the traveling direction and traveling speed of the host vehicle 100 so that the host vehicle 100 does not deviate from the host vehicle traveling road. Further, the alarm device predicts a collision between a roadside stationary object such as a guardrail that is expected to be present at the end of the traveling road of the host vehicle and the host vehicle 100 and notifies the driver of the host vehicle 100 of the risk of the collision by voice or the like. Raise an alarm. That is, when the road shape estimation device 1 correctly detects the shape of the vehicle traveling road, the vehicle control device 50 can execute appropriate vehicle control.

次いで、図3を参照して、ECU12が実行する処理について説明する。図3は、ECU12が実行する処理の詳細を示すフローチャートの一例である。ECU12は、例えば、自車両100のIG電源がオン状態に設定された場合に図3のフローチャートの処理を開始する。ECU12は、図3のフローチャートの処理を開始すると、先ず、ステップS1の処理を実行する。   Next, a process executed by the ECU 12 will be described with reference to FIG. FIG. 3 is an example of a flowchart showing details of processing executed by the ECU 12. For example, when the IG power supply of the host vehicle 100 is set to the on state, the ECU 12 starts the process of the flowchart of FIG. When the process of the flowchart of FIG. 3 is started, the ECU 12 first executes the process of step S1.

ステップS1においてECU12は、レーダー装置11から静止物の検出点情報を取得する。ECU12は、取得した検出点の位置情報を、取得(サンプリング)した時刻と対応付けて記憶装置に記憶する。ECU12は、ステップS1の処理を完了すると、処理をステップS2へ進める。   In step S <b> 1, the ECU 12 acquires stationary object detection point information from the radar device 11. The ECU 12 stores the acquired position information of the detection points in the storage device in association with the acquired (sampled) time. When the ECU 12 completes the process of step S1, the process proceeds to step S2.

ステップS2において、ECU12は、過去に検出された検出点の履歴情報に基づいて現時点における当該検出点の位置を外挿する。外挿とは、過去のサンプリング時において捕捉された検出点の位置および相対速度等から今回のサンプリング時における検出点の位置を予測し、予測した位置近傍に検出点が捕捉されない場合に、その予測した位置に実際に検出点が存在すると仮定する技術である。ECU12は、周知の任意の技術を用いて検出点の位置を外挿して良い。以下では、レーダー装置11によって直接検出された検出点と、本ステップにおいて算出された外挿点とを総じて検出点と称するものとする。ECU12は、ステップS2の処理を完了すると、処理をステップS3へ進める。   In step S2, the ECU 12 extrapolates the current position of the detection point based on the history information of the detection points detected in the past. Extrapolation is the prediction of the position of the detection point at the current sampling from the position and relative speed of the detection point captured at the past sampling, and when the detection point is not captured near the predicted position. This is a technique that assumes that a detection point actually exists at the specified position. The ECU 12 may extrapolate the position of the detection point using any known technique. Hereinafter, the detection points directly detected by the radar device 11 and the extrapolation points calculated in this step are collectively referred to as detection points. When the ECU 12 completes the process of step S2, the process proceeds to step S3.

上記ステップS2の処理によれば、継続的に検出されていた静止物の検出点が、ノイズ等の影響で一時的に検出されなかった場合であっても、現時点における検出点の位置を推定し、検出されているものとして取り扱うことができる。したがって、路側静止物の形状を、より正確に検出することができる。なお、レーダー装置11においてノイズの影響が少なく静止物を良好に検出可能ならば、上記ステップS2に示した外挿処理は省略しても構わない。   According to the process of step S2, the position of the detection point at the present time is estimated even when the detection point of the stationary object that has been continuously detected is not temporarily detected due to noise or the like. Can be treated as being detected. Therefore, the shape of the roadside stationary object can be detected more accurately. If the radar apparatus 11 is less affected by noise and can detect a stationary object well, the extrapolation process shown in step S2 may be omitted.

ステップS3において、ECU12は、検出点に基づいて走路線を認識する。走路線は、自車走行道路の形状を示す線である。自車両100の左右前側方に検出点が連続的に検出されている場合、これらの検出点は、自車走行道路に沿って設置されたガードレール等の路側静止物を示す可能性が高いと考えられる。そして、このような路側静止物は、自車走行道路と相似した形状を成すと考えられる。したがって、ECU12は、このような検出点群を走路線として認識する。具体的には、ECU12は、自車両100の近傍に存在する検出点を開始点とし、当該開始点を基準として所定範囲内に存在する検出点を順次接続することによって、走路線を認識する。ECU12が走路線を認識する方法は、任意の方法を用いて良いが、例えば、特願2010−252989に記載のような方法を用いることができる。本ステップS3において認識された走路線の一例を図4に示す。図4は、走路線が認識された状況下で空白帯が認識される様子を示す図である。図4においては、検出点P1から検出点P6を接続して成る走路線と、検出点P11から検出点P17を接続して成る走路線が認識されている。ステップS3の処理を完了すると、ECU12は、処理をステップS4へ進める。   In step S3, the ECU 12 recognizes the travel line based on the detection point. A travel line is a line which shows the shape of the own vehicle travel road. When detection points are continuously detected on the left and right front sides of the host vehicle 100, it is considered that these detection points are likely to indicate roadside stationary objects such as guardrails installed along the vehicle traveling road. It is done. And it is thought that such a roadside stationary object has the shape similar to the own vehicle traveling road. Therefore, the ECU 12 recognizes such a detection point group as a running route. Specifically, the ECU 12 recognizes a running route by sequentially connecting detection points existing within a predetermined range with a detection point existing in the vicinity of the host vehicle 100 as a start point. Although any method may be used as a method for the ECU 12 to recognize the running route, for example, a method described in Japanese Patent Application No. 2010-252989 can be used. An example of the route line recognized in step S3 is shown in FIG. FIG. 4 is a diagram illustrating a state in which a blank band is recognized under a situation in which a running route is recognized. In FIG. 4, a track line formed by connecting the detection point P1 to the detection point P6 and a track line formed by connecting the detection point P11 to the detection point P17 are recognized. When the process of step S3 is completed, the ECU 12 advances the process to step S4.

ステップS4において、ECU12は、不連続走路領域判定処理を実行する。不連続走路領域判定処理は、走路線が途切れている箇所を空白帯として検出し、空白帯が検出された場合、当該空白帯以遠の走路線の認識結果を車両制御装置50へ出力する走路線情報から除外する処理である。図5は、ECU12が実行する不連続走路領域判定処理を示すフローチャートの一例である。ECU12は、不連続走路領域判定処理を開始すると、先ず、図5のステップS41の処理を実行する。   In step S4, the ECU 12 executes a discontinuous track area determination process. The discontinuous track area determination process detects a point where the track line is interrupted as a blank zone, and when a blank zone is detected, the track route that outputs the recognition result of the track line beyond the blank zone to the vehicle control device 50. It is a process to exclude from information. FIG. 5 is an example of a flowchart showing a discontinuous track area determination process executed by the ECU 12. When the ECU 12 starts the discontinuous track area determination process, the ECU 12 first executes the process of step S41 in FIG.

ステップS41において、ECU12は、上述ステップS3の処理において走路線が認識されているか否か判定する。ECU12は、走路線が認識されていると判定した場合、処理をステップS42へ進める。一方、ECU12は、走路線が認識されていないと判定した場合、処理をステップS44へ進める。   In step S41, the ECU 12 determines whether or not a running route is recognized in the process of step S3. If the ECU 12 determines that the travel route is recognized, the ECU 12 advances the process to step S42. On the other hand, if the ECU 12 determines that the travel line is not recognized, the ECU 12 proceeds with the process to step S44.

ステップS42において、ECU12は、走路線の始点Lsは自車両横に存在しているか否か判定する。具体的には、ECU12は、上述ステップS3において認識された走路線の始点LsのY座標が予め定められた閾値以下であるか否か判定する。例えば、図4においては、ECU12は、検出点P1を始点Lsとして認識し、自車両100の横に存在しているものとして判定する。ECU12は、走路線の始点Lsは自車両横に存在していると判定した場合、処理をステップS43へ進める。一方、ECU12は、走路線の始点Lsは自車両横に存在していないと判定した場合、処理をステップS44へ進める。   In step S <b> 42, the ECU 12 determines whether or not the starting point Ls of the route line exists beside the host vehicle. Specifically, the ECU 12 determines whether or not the Y coordinate of the starting point Ls of the track line recognized in step S3 is equal to or less than a predetermined threshold value. For example, in FIG. 4, the ECU 12 recognizes the detection point P <b> 1 as the start point Ls and determines that it is present beside the host vehicle 100. If the ECU 12 determines that the starting point Ls of the route line is present beside the host vehicle, the ECU 12 proceeds with the process to step S43. On the other hand, when the ECU 12 determines that the starting point Ls of the route line does not exist beside the host vehicle, the ECU 12 proceeds with the process to step S44.

ステップS43において、ECU12は、走路線の終点LeのY座標を空白開始位置Ksに設定する。空白開始位置Ksは、具体的には、空白帯が開始していると想定される縦方向の位置(Y座標)である。ECU12は、ステップS43の処理を完了すると、処理をステップS45へ進める。   In step S43, the ECU 12 sets the Y coordinate of the end point Le of the route line to the blank start position Ks. Specifically, the blank start position Ks is a vertical position (Y coordinate) where a blank band is assumed to start. When the ECU 12 completes the process of step S43, the process proceeds to step S45.

ステップS44において、ECU12は、自車両前端の縦位置(Y=0)を空白開始位置Ksに設定する。ECU12は、ステップS44の処理を完了すると、処理をステップS45へ進める。   In step S44, the ECU 12 sets the vertical position (Y = 0) of the front end of the host vehicle to the blank start position Ks. When the ECU 12 completes the process of step S44, the process proceeds to step S45.

上記ステップS41からステップS44の処理を、具体例を挙げて説明する。例えば、ECU12が図4のように自車両100近傍から延びる走路線を認識している場合(ステップS41および42でYes)、ECU12は、検出点P6を走路線の終点Leとして認識し、当該検出点P6のY座標位置を空白開始位置Ksとして設定する(ステップS43)。一方、図6や、図7に示すように、ECU12が自車両100近傍から延びる走路線を認識していない場合(ステップS41または42でNo)、ECU12は、自車両前端の縦位置(Y=0)を空白開始位置Ksに設定する(ステップS44)。なお、図6は、検出点が比較的長い間隔を隔てて点在している状況において空白帯が認識される様子を示す図である。また、図7は、自車両から比較的遠方にのみ検出点が検出されている状況において空白帯が認識される様子を示す図である。   The processing from step S41 to step S44 will be described with a specific example. For example, when the ECU 12 recognizes a travel route extending from the vicinity of the host vehicle 100 as shown in FIG. 4 (Yes in steps S41 and S42), the ECU 12 recognizes the detection point P6 as the end point Le of the travel route and detects the detection. The Y coordinate position of the point P6 is set as the blank start position Ks (step S43). On the other hand, as shown in FIG. 6 and FIG. 7, when the ECU 12 does not recognize the route line extending from the vicinity of the host vehicle 100 (No in step S41 or 42), the ECU 12 determines the vertical position (Y = 0) is set as the blank start position Ks (step S44). FIG. 6 is a diagram showing a state in which blank bands are recognized in a situation where detection points are scattered at a relatively long interval. FIG. 7 is a diagram illustrating a state in which a blank band is recognized in a situation where detection points are detected only relatively far from the host vehicle.

ステップS45において、ECU12は、空白開始位置Ksから縦方向の距離が最も近い検出点を空白終端位置Keに設定する。具体的には、空白開始位置Ksより自車両100から見て前方において最もY座標が小さい検出点のY座標を空白終端位置Keに設定する。例えば、図4においては、検出点P21のY座標が空白終端位置Keとして設定される。ECU12は、ステップS45の処理を完了すると、処理をステップS46へ進める。   In step S45, the ECU 12 sets the detection point having the closest vertical distance from the blank start position Ks as the blank end position Ke. Specifically, the Y coordinate of the detection point having the smallest Y coordinate ahead of the blank start position Ks when viewed from the host vehicle 100 is set as the blank end position Ke. For example, in FIG. 4, the Y coordinate of the detection point P21 is set as the blank end position Ke. When the ECU 12 completes the process of step S45, the process proceeds to step S46.

ステップS46において、ECU12は、空白開始位置Ksから空白終端位置Keまでの距離を空白帯幅Wとして算出する。具体的には、ECU12は、式(1)に基づいて空白帯幅Wを算出する。
W=|Ke−Ks| …(1)
ECU12は、ステップS46の処理を完了すると、処理をステップS47へ進める。
In step S46, the ECU 12 calculates the distance from the blank start position Ks to the blank end position Ke as the blank band width W. Specifically, the ECU 12 calculates the blank band width W based on the formula (1).
W = | Ke−Ks | (1)
When the ECU 12 completes the process of step S46, the process proceeds to step S47.

ステップS47において、ECU12は、空白開始位置Ksに基づいて空白帯検出閾値Wthを算出する。空白帯検出閾値Wthは、検出点の間隔(空白帯幅W)に基づいて、当該検出点の間が空白帯であるか否かを判定するための閾値である。ECU12は、空白開始位置Ksが自車両100より遠いほど、空白帯検出閾値Wthの値が大きくなるよう算出する。より詳細には、ECU12は、空白開始位置Ksおよび図8のように予め定められた関数に基づいて空白帯検出閾値Wthを算出する。図8は、空白帯検出閾値Wthを算出するための関数を表すグラフの一例である。なお、上記空白帯検出閾値Wthの算出方法は一例であり、ECU12は、任意の手法で空白帯検出閾値Wthを算出しても構わない。ECU12は、ステップS47の処理を完了すると、処理をステップS48へ進める。   In step S47, the ECU 12 calculates a blank band detection threshold Wth based on the blank start position Ks. The blank band detection threshold value Wth is a threshold value for determining whether or not there is a blank band between the detection points based on the detection point interval (blank band width W). The ECU 12 calculates that the blank band detection threshold value Wth increases as the blank start position Ks is farther from the host vehicle 100. More specifically, the ECU 12 calculates the blank band detection threshold value Wth based on the blank start position Ks and a predetermined function as shown in FIG. FIG. 8 is an example of a graph representing a function for calculating the blank band detection threshold Wth. The method for calculating the blank band detection threshold value Wth is an example, and the ECU 12 may calculate the blank band detection threshold value Wth by an arbitrary method. When the ECU 12 completes the process of step S47, the process proceeds to step S48.

ステップS48において、ECU12は、空白帯幅Wが空白帯検出閾値Wthより大きいか否か判定する。ECU12は、空白帯幅Wが空白帯検出閾値Wthより大きいと判定した場合、空白開始位置Ksから空白終端位置Keまでの領域を空白帯として検出し、処理をステップS49へ進める。一方、ECU12は、空白帯幅Wが空白帯検出閾値Wth以下であると判定した場合、空白帯が検出されなかったと判定し、処理をステップS50へ進める。   In step S48, the ECU 12 determines whether or not the blank band width W is larger than the blank band detection threshold Wth. If the ECU 12 determines that the blank band width W is greater than the blank band detection threshold Wth, the ECU 12 detects a region from the blank start position Ks to the blank end position Ke as a blank band, and the process proceeds to step S49. On the other hand, if the ECU 12 determines that the blank band width W is equal to or smaller than the blank band detection threshold Wth, the ECU 12 determines that no blank band has been detected, and advances the process to step S50.

ステップS49において、ECU12は、空白帯以遠の走路線情報を出力走路情報から除外する。出力走路情報は、自車走行道路の形状を示す情報であり、後述ステップS5においてECU12から車両制御装置50へ出力される情報である。出力走路情報には、本ステップの処理で除外される走路線を除き、ステップS3において認識された走路線の位置情報が含まれる。例えば、図4において、検出点P6と検出点P21との間の領域が空白帯として検出された場合、仮に、検出点P21から検出点P26までの検出点が走路線として認識されていたとしても、当該検出点P21から検出点P26までを接続して成る走路線の情報は出力走路情報から除外される。ECU12は、ステップS49の処理を完了すると、処理を図3のステップS5へ進める。   In step S49, the ECU 12 excludes the route information beyond the blank zone from the output route information. The output lane information is information indicating the shape of the host vehicle lane, and is information that is output from the ECU 12 to the vehicle control device 50 in step S5 described later. The output lane information includes the position information of the lane lines recognized in step S3 except for the lane lines excluded in the process of this step. For example, in FIG. 4, if a region between the detection point P6 and the detection point P21 is detected as a blank band, even if the detection points from the detection point P21 to the detection point P26 are recognized as a running line. The information on the route line formed by connecting the detection point P21 to the detection point P26 is excluded from the output route information. When the ECU 12 completes the process of step S49, the process proceeds to step S5 of FIG.

上記ステップS41からステップS49の処理によれば、自車走行道路の形状を示す可能性の低い走路線を出力走路情報から除外することができる。空白帯は車両が走行する道路と交差する交差路等の存在を示す可能性が高く、当該空白帯以遠においては道路形状が大きく変化している可能性が高い。すなわち、空白帯以遠の走路線の認識結果は、車両が走行する道路を示すものである可能性が比較的が低いと考えられる。そして、上記不連続走路領域判定処理によれば、空白帯以遠の走路線の認識結果を出力走路情報が除外される。そこで、ECU12は、車両から空白帯までの走路線が推定された自車走行道路の形状として出力することによって、実質的に、車両が走行する道路の形状を示すものであると考えられる情報のみに基づいて道路形状を推定することができる。   According to the processing from step S41 to step S49, it is possible to exclude the route line that is unlikely to indicate the shape of the own vehicle traveling road from the output traveling route information. The blank zone is highly likely to indicate the presence of an intersection or the like that intersects the road on which the vehicle travels, and the road shape is highly likely to change greatly beyond the blank zone. In other words, it is considered that the recognition result of the route line beyond the blank zone is relatively unlikely to indicate a road on which the vehicle travels. And according to the said discontinuous track area determination process, output track information is excluded from the recognition result of the track line beyond a blank zone. Therefore, the ECU 12 outputs only the information that is considered to substantially indicate the shape of the road on which the vehicle travels by outputting it as the shape of the own vehicle travel road from which the travel route from the vehicle to the blank zone is estimated. The road shape can be estimated based on the above.

また、上記ステップS44からステップS49の処理によれば、図8のように自車両100近傍において走路線を認識できない状況では、自車両100近傍から空白帯が開始しているものとみなすことによって、空白帯を正確に検出することができる。   Further, according to the processing from step S44 to step S49, in the situation where the running route cannot be recognized in the vicinity of the host vehicle 100 as shown in FIG. A blank band can be detected accurately.

ステップS50において、ECU12は、自車両100から見て空白帯終端位置Keより遠方に検出点があるか否か判定する。ECU12は、空白帯終端位置Ke以遠に検出点があると判定した場合、処理をステップS51へ進める。一方、ECU12は、空白帯終端位置Ke以遠に検出点が存在しないと判定した場合、処理をステップS52へ進める。   In step S50, the ECU 12 determines whether or not there is a detection point far from the blank band end position Ke when viewed from the host vehicle 100. If the ECU 12 determines that there is a detection point beyond the blank band end position Ke, the ECU 12 advances the process to step S51. On the other hand, if the ECU 12 determines that no detection point exists beyond the blank band end position Ke, the process proceeds to step S52.

ステップS51において、ECU12は、現在、空白終端位置Keとして設定されている位置を新たな空白開始位置Ksに設定する。ECU12は、ステップS51の処理を完了すると、処理をステップS45へ戻し、上述の処理を繰り返し実施する。   In step S51, the ECU 12 sets the position currently set as the blank end position Ke to a new blank start position Ks. When the ECU 12 completes the process of step S51, the process returns to step S45, and the above process is repeated.

ステップS52において、ECU12は、自車両100から見て空白終端位置Keより遠方において走路線を認識しているか否か判定する。ECU12は、空白終端位置Ke以遠で走路線を認識判定している場合、処理をステップS43へ戻し、当該空白終端位置Ke以遠に存在する走路の終点Leを新たな空白開始位置Ksとして設定して上述の処理を繰り返し実施する。一方、ECU12は、空白終端位置Ke以遠で走路線を認識していないと判定した場合、処理を図3のステップS5へ進める。   In step S52, the ECU 12 determines whether or not the route line is recognized farther from the blank end position Ke when viewed from the host vehicle 100. If the ECU 12 recognizes and determines the travel line beyond the blank end position Ke, the ECU 12 returns the process to step S43, and sets the end point Le of the runway existing beyond the blank end position Ke as a new blank start position Ks. The above process is repeated. On the other hand, if the ECU 12 determines that the travel line is not recognized beyond the blank end position Ke, the process proceeds to step S5 in FIG.

上記ステップS50からステップS52の処理によれば、空白帯が検出されるまで或いは判定の対象となる検出点が無くなるまで、繰り返し検出点の間隔に基づいた空白帯の検出処理が行われる。   According to the processing from step S50 to step S52, the blank band detection process based on the interval between the repeated detection points is performed until a blank band is detected or until there is no detection point to be determined.

例えば、図7のように、走路が認識されていない状況では、先ず、自車両前端が空白開始位置Ks1として設定され(ステップS44)、検出点P31の位置が空白終端位置Ke1として設定される(ステップS45)。次いで、空白開始位置Ks1から空白終端位置Ke1までの空白帯幅W1が空白帯検出閾値未満であった場合(ステップS48でNo)、空白終端位置Ke1以遠に検出点P32が存在することから(ステップS50でYes)、空白終端位置Ke1が新たな空白開始位置Ks2として設定される(ステップS51)。そして、検出点P32のY座標が新たな空白終端位置Ke2として設定され(ステップS45)、空白開始位置Ks2から空白終端位置Ke2までの空白帯幅W2に基づいて繰り返し空白帯の有無が判定される(ステップS48)。   For example, as shown in FIG. 7, in a situation where the road is not recognized, first, the front end of the host vehicle is set as the blank start position Ks1 (step S44), and the position of the detection point P31 is set as the blank end position Ke1 ( Step S45). Next, when the blank band width W1 from the blank start position Ks1 to the blank end position Ke1 is less than the blank band detection threshold (No in Step S48), the detection point P32 exists beyond the blank end position Ke1 (Step S48). In S50, the blank end position Ke1 is set as a new blank start position Ks2 (Step S51). Then, the Y coordinate of the detection point P32 is set as a new blank end position Ke2 (step S45), and the presence / absence of a blank band is repeatedly determined based on the blank band width W2 from the blank start position Ks2 to the blank end position Ke2. (Step S48).

このように空白帯の有無を自車両近傍から遠方へ繰り返し判定することによって、ECU12は、走路線が断続的に存在するような場合などにおいても、断線領域が短い場合には断続する一連の走路線の情報を除外することなく出力走路情報として出力することができる。   Thus, by repeatedly determining the presence or absence of the blank zone from the vicinity of the host vehicle to the far side, the ECU 12 can perform a series of intermittent runs when the disconnection area is short even when the runway line is intermittently present. The route information can be output without excluding route information.

ステップS5において、ECU12は、上述ステップS49の処理において除外されたもの以外の全ての走路線の情報を出力走路情報として車両制御装置50へ出力する。ステップS5の処理を完了すると、ECU12は、処理をステップS6へ進める。   In step S5, the ECU 12 outputs information on all the route lines other than those excluded in the process of step S49 to the vehicle control device 50 as output route information. When the process of step S5 is completed, the ECU 12 advances the process to step S6.

ステップS6において、ECU12は、車両のIG電源がオフ状態に設定されたか否か判定する。ECU12は、車両のIG電源がオフ状態に設定されたと判定した場合、図3のフローチャートの処理を終了する。一方、ECU12は、車両のIG電源がオン状態に維持されていると判定した場合、処理をステップS1へ戻し、上記の処理を繰り返し実施する。   In step S6, the ECU 12 determines whether or not the IG power source of the vehicle is set to an off state. When the ECU 12 determines that the IG power source of the vehicle is set to the off state, the ECU 12 ends the process of the flowchart of FIG. On the other hand, when the ECU 12 determines that the IG power source of the vehicle is maintained in the on state, the ECU 12 returns the process to step S1 and repeats the above process.

以上に示した通り、本発明に係る道路形状推定装置1によれば、自車走行道路の形状を示す可能性が低い走路線情報を除外し、自車走行道路の形状を示す可能性が高い走路線情報のみを出力することによって自車走行道路の形状を正確に検出することができる。   As described above, according to the road shape estimation device 1 according to the present invention, it is highly possible to exclude the route line information that is less likely to indicate the shape of the host vehicle traveling road and to indicate the shape of the host vehicle traveling road. By outputting only the travel route information, the shape of the vehicle traveling road can be accurately detected.

(第2の実施形態)
ECU12は、さらに、空白帯の検出結果に応じて、自車両100の進行先における道路の接続状況を判定しても構わない。より具体的には、ECU12は、自車両100の進行先において交差路や合流路が存在するか否か判定して構わない。以下、第2の実施形態に係る道路形状認識装置について説明する。
(Second Embodiment)
The ECU 12 may further determine the connection status of the road at the destination of the host vehicle 100 according to the detection result of the blank band. More specifically, the ECU 12 may determine whether or not there is an intersection or a junction in the destination of the host vehicle 100. Hereinafter, the road shape recognition apparatus according to the second embodiment will be described.

第2の実施形態に係る道路形状認識装置は、第1の実施形態に係る道路形状認識装置とECU12の処理が異なっている。以下、図9を参照して第2の実施形態に係るECU12が実行する処理について説明する。図9は、第2の実施形態に係るECU12が実行する処理の詳細を示すフローチャートの一例である。なお、図9において、上記第1の実施形態と同様の処理を実施するステップについては同様の符号を付し、詳細な説明は省略する。また、第2の実施形態に係る道路形状認識装置のハードウェア構成は上述第1の実施形態と同様であるため、当該ハードウェアに関する詳細な説明は省略する。   The road shape recognition apparatus according to the second embodiment differs from the road shape recognition apparatus according to the first embodiment in the processing of the ECU 12. Hereinafter, the process executed by the ECU 12 according to the second embodiment will be described with reference to FIG. FIG. 9 is an example of a flowchart showing details of processing executed by the ECU 12 according to the second embodiment. In FIG. 9, steps for performing the same processing as in the first embodiment are denoted by the same reference numerals, and detailed description thereof is omitted. Moreover, since the hardware configuration of the road shape recognition apparatus according to the second embodiment is the same as that of the first embodiment, detailed description regarding the hardware is omitted.

第2の実施形態に係るECU12は、上述ステップS4に示した不連続走路領域判定処理を完了すると、ステップS20の道路接続判定処理を実行する。以下、図10を参照して道路接続判定処理の詳細について説明する。図10は、第2の実施形態に係るECU12が実行する道路接続判定処理を示すフローチャートの一例である。ECU12は、道路接続判定処理を開始すると、先ず、図10のステップS201の処理を実行する。   ECU12 which concerns on 2nd Embodiment will perform the road connection determination process of step S20, if the discontinuous track area determination process shown to the above-mentioned step S4 is completed. Hereinafter, details of the road connection determination process will be described with reference to FIG. FIG. 10 is an example of a flowchart showing a road connection determination process executed by the ECU 12 according to the second embodiment. When the ECU 12 starts the road connection determination process, the ECU 12 first executes the process of step S201 in FIG.

ステップS201において、ECU12は、自車両の左右両側において走路線が認識されているか否か判定する。ECU12は、自車両の左右両側に走路線が認識されていると判定した場合、処理をステップS202へ進める。一方、ECU12は、自車両の左右何れか一方側において走路線が認識されていないと判定した場合、処理を図9のステップS5へ進める。   In step S201, the ECU 12 determines whether or not a running route is recognized on both the left and right sides of the host vehicle. When the ECU 12 determines that the route is recognized on both the left and right sides of the host vehicle, the ECU 12 proceeds with the process to step S202. On the other hand, when the ECU 12 determines that the travel line is not recognized on either the left or right side of the host vehicle, the ECU 12 proceeds with the process to step S5 in FIG.

ステップS202において、ECU12は、左右の走路線の双方において空白帯が認識されているか否か判定する。ECU12は、左右の走路線の双方に空白帯が認識されていると判定した場合、処理をステップS203へ進める。一方、ECU12は、左右の走路線の何れか一方において空白帯が認識されていないと判定した場合、処理をステップS205へ進める。   In step S202, the ECU 12 determines whether or not a blank zone is recognized on both the left and right lane lines. If the ECU 12 determines that a blank zone is recognized on both the left and right lane lines, the ECU 12 advances the process to step S203. On the other hand, if the ECU 12 determines that a blank zone is not recognized on either one of the left and right lane lines, the process proceeds to step S205.

ステップS203において、ECU12は、左右の走路線双方の空白帯が略同位置に存在するか否か判定する。具体的には、ECU12は、左側の走路線の空白開始位置をKsLとし、右側の走路線の空白開始位置をKsRとした場合、下式(2)によって求められる開始位置偏差ΔKを算出する。
ΔK=|KsL−KsR| …(2)
次いで、ECU12は、開始位置偏差ΔKが予め定められた閾値ΔKth未満であるか否か判定する。そして、開始位置偏差ΔKが閾値ΔKth未満である場合、左右の走路線双方の空白帯が略同位置に存在すると判定する。なお、このような判定方法は一例であり、ECU12は、左右の走路線双方の空白帯が略同位置か否かを任意の方法で判定して構わない。ECU12は、左右の走路線双方の空白帯が略同位置に存在すると判定した場合、処理をステップS204へ進める。一方、ECU12は、左右の走路線双方の空白帯が略同位置に存在していないと判定した場合、処理を図9のステップS5へ進める。
In step S203, the ECU 12 determines whether or not the blank strips on both the left and right lane lines exist at substantially the same position. Specifically, the ECU 12 calculates the start position deviation ΔK obtained by the following equation (2), where KsL is the blank start position of the left track, and KsR is the blank start position of the right track.
ΔK = | KsL−KsR | (2)
Next, the ECU 12 determines whether or not the start position deviation ΔK is less than a predetermined threshold value ΔKth. When the start position deviation ΔK is less than the threshold value ΔKth, it is determined that the blank bands on both the left and right lane lines exist at substantially the same position. Note that such a determination method is merely an example, and the ECU 12 may determine whether or not the blank zones on both the left and right lane lines are substantially located at the same position. If the ECU 12 determines that the blank strips on both the left and right lanes exist at substantially the same position, the ECU 12 advances the process to step S204. On the other hand, if the ECU 12 determines that the blank bands on both the left and right lanes do not exist at substantially the same position, the ECU 12 advances the process to step S5 in FIG.

ステップS204において、ECU12は、交差道路存在フラグを出力走路情報に追加する。交差道路存在フラグは、自車両100の進行先において自車走行道路と交差する道路が存在する旨を示すフラグデータである。ECU12は、ステップS204の処理を完了すると、処理を図9のステップS5へ進める。   In step S204, the ECU 12 adds an intersection road presence flag to the output runway information. The intersection road presence flag is flag data indicating that there is a road that intersects with the vehicle traveling road at the destination of the vehicle 100. When the ECU 12 completes the process of step S204, the process proceeds to step S5 of FIG.

ステップS205において、ECU12は、左右の走路線の一方において空白帯が認識されているか否か判定する。ECU12は、左右の走路線の一方に空白帯が認識されていると判定した場合、処理をステップS206へ進める。一方、ECU12は、左右の走路線の何れにも空白帯が認識されていないと判定した場合、処理を図9のステップS5へ進める。   In step S205, the ECU 12 determines whether or not a blank zone is recognized on one of the left and right lane lines. If the ECU 12 determines that a blank band is recognized on one of the left and right lane lines, the ECU 12 advances the process to step S206. On the other hand, if the ECU 12 determines that no blank zone is recognized on any of the left and right lane lines, the process proceeds to step S5 in FIG.

ステップS206において、ECU12は、合流路存在フラグを出力走路情報に追加する。合流路存在フラグは、自車両100の進行先において自車走行道路に合流する道路が存在する旨を示すフラグデータである。ECU12は、ステップS206の処理を完了すると、処理を図9のステップS5へ進める。   In step S206, the ECU 12 adds the combined flow path presence flag to the output travel path information. The combined flow path presence flag is flag data indicating that there is a road that merges with the traveling road of the host vehicle 100 at the destination of the host vehicle 100. When the ECU 12 completes the process of step S206, the process proceeds to step S5 of FIG.

以上に示した通り、第2の実施形態に係る道路形状推定装置によれば、カメラ装置やナビゲーション装置を用いることなく、レーダー装置11からの情報のみに基づいて車両の進行先の道路の接続状況を判定することができる。より具体的には、自車両100の進行先に交差路および合流路が存在するか否かを判定することができる。そして、車両制御装置50は、このような判定結果を用いることによって自車両100を適切に制御することができる。例えば、ECU12が自車走行道路の前方において交差路が存在すると判定した場合には、車両制御装置50は、交差路から進入してくる他車両に注意するよう車両のドライバに警告音を発したり、車両の速度を自動的に低減したりする制御を行うことができる。   As described above, according to the road shape estimation device according to the second embodiment, the connection state of the road where the vehicle is traveling is based on only the information from the radar device 11 without using a camera device or a navigation device. Can be determined. More specifically, it can be determined whether or not there is an intersection and a junction in the destination of the host vehicle 100. And the vehicle control apparatus 50 can control the own vehicle 100 appropriately by using such a determination result. For example, when the ECU 12 determines that there is an intersection in front of the own vehicle traveling road, the vehicle control device 50 generates a warning sound to the driver of the vehicle so as to pay attention to other vehicles entering from the intersection. The vehicle speed can be automatically reduced.

本発明に係る道路形状推定装置は、道路形状を正確に推定可能な道路形状推定装置などとして有用である。   The road shape estimation apparatus according to the present invention is useful as a road shape estimation apparatus that can accurately estimate the road shape.

1 道路形状推定装置
11 レーダー装置
12 ECU
50 車両制御装置
1 Road shape estimation device 11 Radar device 12 ECU
50 Vehicle control device

Claims (6)

車両に搭載され、当該車両が走行する道路の形状を推定する道路形状推定装置であって、
前記車両周囲の静止物の存在位置を複数の検出点として検出する物体検出部と、
前記検出点に基づいて前記道路形状を示す走路線を認識する走路線認識部と、
前記検出点の間隔に基づいて前記走路線が途切れている箇所を空白帯として検出する空白帯検出部と、
前記空白帯が検出された場合、前記車両から前記空白帯までの領域において認識された前記走路線に基づいて前記車両が走行する道路の形状を推定する形状推定部とを備えることを特徴とする、道路形状推定装置。
A road shape estimation device that is mounted on a vehicle and estimates a shape of a road on which the vehicle travels,
An object detection unit for detecting the presence positions of stationary objects around the vehicle as a plurality of detection points;
A travel line recognition unit for recognizing a travel line indicating the road shape based on the detection point;
A blank zone detector for detecting a location where the running line is interrupted based on the interval between the detection points as a blank zone;
A shape estimation unit configured to estimate a shape of a road on which the vehicle travels based on the route line recognized in an area from the vehicle to the blank zone when the blank zone is detected. Road shape estimation device.
前記空白帯検出部において前記空白帯を検出するための空白帯検出閾値を前記車両から前記空白帯の開始位置を示す検出点までの距離に基づいて算出する閾値算出手段をさらに備え、
前記空白帯検出部は、前記検出点の間隔が前記空白帯検出閾値より長い場合、当該検出点の間の領域を前記空白帯として検出することを特徴とする、請求項1に記載の道路形状推定装置。
A threshold calculating means for calculating a blank band detection threshold for detecting the blank band in the blank band detection unit based on a distance from the vehicle to a detection point indicating a start position of the blank band;
2. The road shape according to claim 1, wherein when the interval between the detection points is longer than the blank zone detection threshold, the blank zone detection unit detects a region between the detection points as the blank zone. Estimating device.
前記走路線算出部は、前記走路線として、前記道路の左端形状を示す左側走路線、および前記道路の右端形状を示す右側走路線を算出し、
前記空白帯検出部は、前記左側走路線および前記右側走路線の各々について空白帯を検出し、
前記左側走路線における前記空白帯の検出結果、および前記右側走路線における前記空白帯の検出結果に基づいて、前記車両の進行先における道路の接続状況を判定する道路接続判定部をさらに備えることを特徴とする、請求項1および2の何れか1項に記載の道路形状推定装置。
The travel route calculation unit calculates a left travel route indicating the left end shape of the road and a right travel route indicating the right end shape of the road as the travel route,
The blank zone detector detects a blank zone for each of the left-side lane line and the left-side lane line,
A road connection determination unit that determines a connection state of a road in a travel destination of the vehicle based on a detection result of the blank band on the left-side lane line and a detection result of the blank band on the right-side lane line; The road shape estimation apparatus according to claim 1, wherein the road shape estimation apparatus is characterized.
前記道路接続判定部は、前記左側走路線および前記右側走路線の双方において前記空白帯が検出され、且つ、前記車両から前記左側走路線の空白帯までの距離と、前記車両から前記右側走路線の空白帯までの距離との差が予め定められた閾値以下である場合、前記車両の進行先に交差道路が存在すると判定することを特徴とする、請求項3に記載の道路形状推定装置。   The road connection determination unit detects the blank zone in both the left-side lane line and the right-side lane line, and detects the distance from the vehicle to the left-side lane line, and from the vehicle to the right-side lane line. The road shape estimation apparatus according to claim 3, wherein when the difference from the distance to the blank zone is equal to or less than a predetermined threshold value, it is determined that an intersection road exists at the destination of the vehicle. 前記道路接続判定部は、前記左側走路線および前記右側走路線の何れか一方において前記空白帯が検出された場合、前記車両の進行先に合流路が存在すると判定することを特徴とする、請求項3および4の何れか1項に記載の道路形状推定装置。   The road connection determination unit determines that there is a combined flow path in the travel destination of the vehicle when the blank zone is detected in any one of the left-side lane line and the right-side lane line. Item 5. The road shape estimation device according to any one of Items 3 and 4. 前記空白帯検出部は、前記走路線認識部によって前記車両を基準に所定距離内に始点を有する前記走路線が認識されていない場合、前記車両の前端位置から前記車両に最も近い前記検出点までの間隔に基づいて、当該車両から当該検出点までの領域を空白帯として検出することを特徴とする、請求項1から5の何れか1項に記載の道路形状推定装置。   The blank zone detection unit, from the front end position of the vehicle to the detection point closest to the vehicle, when the route line having a start point within a predetermined distance with respect to the vehicle is not recognized by the route line recognition unit 6. The road shape estimation apparatus according to claim 1, wherein an area from the vehicle to the detection point is detected as a blank band based on the interval of the road.
JP2010269465A 2010-12-02 2010-12-02 Road shape estimation device Active JP5594102B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010269465A JP5594102B2 (en) 2010-12-02 2010-12-02 Road shape estimation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010269465A JP5594102B2 (en) 2010-12-02 2010-12-02 Road shape estimation device

Publications (2)

Publication Number Publication Date
JP2012118867A true JP2012118867A (en) 2012-06-21
JP5594102B2 JP5594102B2 (en) 2014-09-24

Family

ID=46501583

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010269465A Active JP5594102B2 (en) 2010-12-02 2010-12-02 Road shape estimation device

Country Status (1)

Country Link
JP (1) JP5594102B2 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017151095A (en) * 2016-02-24 2017-08-31 パナソニックIpマネジメント株式会社 Determination device, determination method, program, and recording medium recording program
JP2017215214A (en) * 2016-05-31 2017-12-07 パナソニックIpマネジメント株式会社 Moving object detection device, program and record medium
JP2021157326A (en) * 2020-03-25 2021-10-07 古河電気工業株式会社 Monitoring device and method for operating monitoring device
US11983937B2 (en) 2018-07-12 2024-05-14 Denso Corporation Intersecting road estimation device

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004271513A (en) * 2003-02-20 2004-09-30 Nissan Motor Co Ltd Device for detecting forward object and method for detecting forward object
JP2005173917A (en) * 2003-12-10 2005-06-30 Nissan Motor Co Ltd Device and method for detecting branching path
WO2006123628A1 (en) * 2005-05-17 2006-11-23 Murata Manufacturing Co., Ltd. Radar and radar system
JP2007161162A (en) * 2005-12-15 2007-06-28 Denso Corp Vehicular road shape recognition device

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004271513A (en) * 2003-02-20 2004-09-30 Nissan Motor Co Ltd Device for detecting forward object and method for detecting forward object
JP2005173917A (en) * 2003-12-10 2005-06-30 Nissan Motor Co Ltd Device and method for detecting branching path
WO2006123628A1 (en) * 2005-05-17 2006-11-23 Murata Manufacturing Co., Ltd. Radar and radar system
JP2007161162A (en) * 2005-12-15 2007-06-28 Denso Corp Vehicular road shape recognition device

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017151095A (en) * 2016-02-24 2017-08-31 パナソニックIpマネジメント株式会社 Determination device, determination method, program, and recording medium recording program
JP2017215214A (en) * 2016-05-31 2017-12-07 パナソニックIpマネジメント株式会社 Moving object detection device, program and record medium
US11983937B2 (en) 2018-07-12 2024-05-14 Denso Corporation Intersecting road estimation device
JP2021157326A (en) * 2020-03-25 2021-10-07 古河電気工業株式会社 Monitoring device and method for operating monitoring device

Also Published As

Publication number Publication date
JP5594102B2 (en) 2014-09-24

Similar Documents

Publication Publication Date Title
US11941985B2 (en) Vehicular environment estimation device
CN108694860B (en) Attention reminding device
JP5878491B2 (en) Driving assistance device
US9463796B2 (en) Driving assistance apparatus
JP6152673B2 (en) Lane change support device
US9711049B2 (en) Collision probability determination apparatus and program
KR101611242B1 (en) Vehicle-installation intersection judgement apparatus and program
US20150353078A1 (en) Driving assistance apparatus
US9171463B2 (en) Congestion estimation device
JP6022983B2 (en) Driving assistance device
EP3486132B1 (en) Vehicle control device
US9470790B2 (en) Collision determination device and collision determination method
US9102329B2 (en) Tracking control apparatus
US9002630B2 (en) Road shape estimation apparatus
JP2012089114A (en) Obstacle recognition device
JP2014115887A (en) Collision determination device for vehicle
JP6658674B2 (en) Driving support system
JP2017207973A (en) Detector and detection method
CN111052201B (en) Collision prediction device, collision prediction method, and storage medium
JP5402968B2 (en) Vehicular road shape recognition method and apparatus, and recording medium
JP5594102B2 (en) Road shape estimation device
JP2010044461A (en) Apparatus and program for collision estimation
JP2013186767A (en) Warning device for vehicle
JP2008040819A (en) Obstacle recognition device
JP2008052399A (en) Surround monitor system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130611

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20140121

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140123

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140313

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140721

R151 Written notification of patent or utility model registration

Ref document number: 5594102

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151