JP2012106735A - Fork road intrusion determination device - Google Patents

Fork road intrusion determination device Download PDF

Info

Publication number
JP2012106735A
JP2012106735A JP2012000043A JP2012000043A JP2012106735A JP 2012106735 A JP2012106735 A JP 2012106735A JP 2012000043 A JP2012000043 A JP 2012000043A JP 2012000043 A JP2012000043 A JP 2012000043A JP 2012106735 A JP2012106735 A JP 2012106735A
Authority
JP
Japan
Prior art keywords
lane
vehicle
host vehicle
road
detection means
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
JP2012000043A
Other languages
Japanese (ja)
Other versions
JP5202741B2 (en
Inventor
Toru Saito
徹 齋藤
Tadashi Maruyama
匡 丸山
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.)
Subaru Corp
Original Assignee
Fuji Heavy Industries Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fuji Heavy Industries Ltd filed Critical Fuji Heavy Industries Ltd
Priority to JP2012000043A priority Critical patent/JP5202741B2/en
Publication of JP2012106735A publication Critical patent/JP2012106735A/en
Application granted granted Critical
Publication of JP5202741B2 publication Critical patent/JP5202741B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To provide a fork road intrusion determination device which can exactly detect the existence of a fork road and can exactly determine that an own vehicle has intruded into the detected fork road.SOLUTION: The fork road intrusion determination device 1 comprises: a traffic lane detection means 2 which detects left and right traffic lanes Ll, Lr of the own vehicle MC; a length/width detection means 3 which detects a length and a width on an actual space in the intrusion direction of the own vehicle within the detected traffic lane; a traveling zone determination means 4 which determines a lane kind of the traffic lane on the basis of the detection result by the length/width detection means 3, and determines a zone of a traveling traffic lane in which the own vehicle travels; a fork road detection means 5 which detects that there exists the fork road B at the side of the traffic lane which is changed when the traffic lane being an actual lane is changed to a broken traffic lane BL having a prescribed length and a prescribed width; and a fork road intrusion determination means 6 which determines that the own vehicle moves toward the fork road during the fork road is detected, or that the own vehicle intrudes into the fork road when a winker operation is performed to the direction of the fork road.

Description

本発明は、分岐路進入判定装置に係り、特に、自車両の周囲の車線を検出して分岐路を認識し、自車両の分岐路への進入を判定する分岐路進入判定装置に関する。   The present invention relates to a branch road entry determination device, and more particularly to a branch road entry determination device that detects a lane around a host vehicle to recognize a branch road and determines whether the host vehicle enters the branch road.

近年、ステレオカメラや単眼カメラ等の撮像装置により撮像された画像の解析結果や、赤外線レーザレーダやミリ波レーダ等のレーダ装置の測定結果等から、自車両の前方やその周囲の道路状況や先行車両を認識し、それに基づいて自車両の定速走行制御を行うクルーズコントロール(Cruise Control)装置や、自車両の定速走行制御に加えて先行車両に対する追従走行制御を行う先行車追従機能付きクルーズコントロール(Adaptive Cruise Control。以下ACCと略称する)制御を行うACC装置が開発されている(例えば特許
文献1等参照)。
In recent years, based on analysis results of images captured by imaging devices such as stereo cameras and monocular cameras, and measurement results of radar devices such as infrared laser radar and millimeter wave radar, road conditions ahead of and around the vehicle A cruise control device that recognizes the vehicle and controls the vehicle at a constant speed based on it, and a cruise with a preceding vehicle tracking function that performs a tracking control on the preceding vehicle in addition to the constant speed traveling control of the vehicle. ACC devices that perform control (Adaptive Cruise Control, hereinafter abbreviated as ACC) have been developed (see, for example, Patent Document 1).

ACC装置等では、通常、自車両を設定された速度で定速走行させ、先行車両が存在する場合には自車両を先行車両に追従させるように自車両のアクセルスロットルやブレーキ機構等を自動的に適切に操作する制御が行われる。   In an ACC device or the like, usually, the host vehicle is automatically driven at a set speed, and when there is a preceding vehicle, the accelerator throttle or brake mechanism of the own vehicle is automatically operated so that the own vehicle follows the preceding vehicle. Control to operate appropriately is performed.

しかし、高速道路や自動車専用道路、一般道等で自車両が道路左右の分岐路に進入する際には、通常、減速が必要になるが、ACC装置等が作動した状態のままでは定速走行を続けてしまう。そのため、ドライバが強いブレーキ操作を行ったりACC装置等を手動で停止させるなど、ドライバが自らクルーズコントロール機能を停止させなければならなかった。   However, when the vehicle enters a branch road on the left or right side of a highway, an automobile-only road, or a general road, it is usually necessary to decelerate. Will continue. For this reason, the driver has to stop the cruise control function by himself, such as performing a strong brake operation or manually stopping the ACC device or the like.

このような問題に対処するため、特許文献2では、ナビゲーション装置の地図情報に基づいて自車両が道路の分岐点付近に位置しているか否かを判断し、道路脇の視線誘導標(デリニエータ)やガードレール等の停止している物体(停止物)を検出してそれとの位置関係から自車両が分岐路に進入しているか否か或いは分岐路に進入する可能性があるか否かを推定する分岐路進入推定装置が提案されている。   In order to cope with such a problem, in Patent Document 2, it is determined whether or not the vehicle is located near a branch point of the road based on the map information of the navigation device, and a gaze guidance mark (a delineator) beside the road. And a stationary object such as a guardrail (stopped object) is detected, and it is estimated whether or not the own vehicle has entered the branch road or whether there is a possibility of entering the branch road from the positional relationship therewith A branch approach estimation device has been proposed.

特開2005−1566号公報Japanese Patent Laid-Open No. 2005-1566 特開2004−341941号公報Japanese Patent Application Laid-Open No. 2004-319441

しかしながら、すべての分岐路に視線誘導標やガードレール等の停止物が設置されているとは限らない。また、道路面上に連続線や破線等で標示された車線で区画される走行レーンとそれらの停止物との間隔等の位置関係は必ずしも一定とは限らず、従って停止物に基づいて正確に走行レーンの数や位置を特定することは必ずしも容易ではない。さらに、道路面から棒状に立設された視線誘導標等の停止物を正しく検出できないと前記推定が正しく行われない。そのため、上記の分岐路進入推定装置は、その装置に理想的な道路環境でしか使用できず、使用に適さない環境で用いると推定を誤る可能性がある。   However, stop objects such as line-of-sight guides and guardrails are not always installed on all branch roads. Also, the positional relationship such as the distance between the running lanes marked by lanes marked with continuous lines or broken lines on the road surface and their stopping objects is not always constant, so it is accurate based on the stopping objects It is not always easy to specify the number and position of traveling lanes. Furthermore, the estimation is not performed correctly unless a stationary object such as a gaze guidance sign standing in a rod shape from the road surface cannot be detected correctly. Therefore, the above branch path approach estimation apparatus can be used only in an ideal road environment for the apparatus, and there is a possibility that the estimation is erroneous if used in an environment unsuitable for use.

なお、本発明では、追い越し禁止線等の道路中央線や車両通行帯境界線、路側帯と車道とを区画する区画線等の道路面上に標示された連続線や破線を車線という。また、後述する図5等に示すように高速道路の分岐点等に標示される通常の車線よりも車線幅が広く長さが短い車線をブロック線という。   In the present invention, a continuous line or a broken line marked on a road surface such as a road center line such as an overtaking prohibition line, a vehicle traffic zone boundary line, a lane line dividing a roadside zone and a roadway is referred to as a lane. Further, as shown in FIG. 5 and the like which will be described later, a lane having a wider lane width and a shorter length than a normal lane marked at a branch point of an expressway is called a block line.

前記のような分岐路では、例えば自車両が高速道路等を走行中にパーキングの入り口やインターチェンジ等の分岐路に進入する場合に強いブレーキ操作を行うなど比較的急激に自車両の走行状態を変化させる必要が生じるため、通常の走行レーンの走行時とは異なる制御が必要になる。また、高速道路等に限らず、国道等のバイパスから一般道への出口の分岐路や、一般道から側道への分岐等においても同様の制御が必要になる。   In such a branch road, the driving state of the host vehicle changes relatively abruptly, for example, when the host vehicle enters a branch road such as an entrance of a parking lot or an interchange while driving on an expressway. Therefore, it is necessary to perform control different from that in the normal traveling lane. Further, the same control is required not only for highways and the like, but also for a branch road from a bypass such as a national road to a general road or a branch from a general road to a side road.

そのため、この種の装置には、まず、分岐路が存在することを的確に検出可能であることが望まれる。そして、それを的確に判定したうえで自車両が分岐路に進入するか否かを的確に判定できることが望まれる。   For this reason, it is desirable that this type of apparatus can accurately detect the presence of a branch path. And it is desired to be able to accurately determine whether or not the own vehicle enters the branch road after accurately determining it.

本発明は、このような事情に鑑みてなされたものであり、分岐路が存在することを的確に検出し、自車両が検出した分岐路に進入することを的確に判定可能な分岐路進入判定装置を提供することを目的とする。   The present invention has been made in view of such circumstances, and it is possible to accurately detect the presence of a branch road, and to accurately determine that the host vehicle enters the detected branch road. An object is to provide an apparatus.

前記の問題を解決するために、第1の発明は、分岐路進入判定装置において、
自車両の左側および右側の車線を検出する車線検出手段と、
前記車線検出手段により検出された車線の自車両の進行方向の実空間上の長さと幅とを検出する長さ幅検出手段と、
前記長さ幅検出手段による検出結果に基づいて前記車線の線種を判定するとともに自車両が走行している走行レーンの区分を判定する走行区分判定手段と、
前記長さ幅検出手段による検出結果に基づいて実線であった車線が、所定の長さおよび所定の幅の破線に変化した場合に、変化した車線の側に分岐路が存在することを検出する分岐路検出手段と、
前記分岐路検出手段が前記分岐路を検出している間に、自車両が前記分岐路に向かう移動、または前記分岐路方向にウィンカ操作が行われた場合に、自車両が前記分岐路に進入すると判定する分岐路進入判定手段と、を備え、
前記分岐路進入判定手段により自車両が前記分岐路に進入すると判定されると、自車両の加速を禁止する信号を出力し、
前記分岐路進入判定手段により自車両が前記分岐路に進入すると判定された後、所定の時間が経過する間または所定の距離を走行する間、前記長さ幅検出手段により自車両の左側または右側の車線が前記所定の長さおよび所定の幅の破線である場合、前記自車両の加速を禁止する信号の出力を解除することを特徴とする。
In order to solve the above-described problem, the first invention is a branch path entry determination device,
Lane detection means for detecting the left and right lanes of the host vehicle;
A length / width detection means for detecting the length and width of the lane detected by the lane detection means in real space in the traveling direction of the host vehicle;
A travel segment determination unit that determines a line type of the lane based on a detection result by the length width detection unit and determines a segment of a travel lane in which the host vehicle is traveling;
When a lane that is a solid line is changed to a broken line having a predetermined length and a predetermined width based on a detection result by the length / width detection means, it is detected that a branch road exists on the changed lane side. A branch path detection means;
While the branch road detection means is detecting the branch road, if the host vehicle moves toward the branch road or if a winker operation is performed in the direction of the branch road, the own vehicle enters the branch road. A branch path entry judging means for judging,
When it is determined by the branch path entry determining means that the host vehicle enters the branch path, a signal for prohibiting acceleration of the host vehicle is output,
After the vehicle is determined to enter the branch road by the branch road entry determination means, the left or right side of the vehicle is left or right by the length width detection means while a predetermined time elapses or travels a predetermined distance. When the lane is a broken line having the predetermined length and the predetermined width, the output of the signal for prohibiting the acceleration of the host vehicle is canceled.

第2の発明は、第1の発明の分岐路進入判定装置において、前記信号の出力の解除とともに、自車両の定速走行制御に復帰させる旨の信号を出力することを特徴とする。   According to a second aspect of the present invention, in the branch path entry determination device according to the first aspect of the invention, a signal indicating that the vehicle is returned to the constant speed traveling control is output together with the cancellation of the output of the signal.

第3の発明は、第1又は第2の発明の分岐路進入判定装置において、
先行車両を検出する先行車両検出手段を備え、
前記先行車両検出手段により検出された前記先行車両が検出されている場合には、前記先行車両に対する追従走行制御を行う旨の信号を出力することを特徴とする。
3rd invention is the branch path approach determination apparatus of 1st or 2nd invention,
A preceding vehicle detection means for detecting the preceding vehicle;
When the preceding vehicle detected by the preceding vehicle detecting means is detected, a signal indicating that the follow-up traveling control for the preceding vehicle is performed is output.

第1の発明によれば、自車両の左右の車線の長さや幅を検出して車線の線種を判定し、車線の線種が実線であった一方の車線がブロック線に変化した場合に、変化した車線の側に分岐路が存在することを検出することで、分岐路が存在することを的確に検出することが可能となる。また、分岐路が存在することを的確に検出したうえで、自車両が分岐路に向かう移動や分岐路方向にウィンカ操作が行われた場合に自車両が分岐路に進入すると判定することで、自車両が分岐路に進入するか否かを的確に判定することが可能となる。   According to the first invention, when the lane line type is determined by detecting the lengths and widths of the left and right lanes of the host vehicle, and the lane line type is changed to a block line. By detecting that there is a branch road on the changed lane side, it is possible to accurately detect the presence of the branch road. In addition, by accurately detecting the existence of a branch road, by determining that the host vehicle enters the branch road when the host vehicle moves toward the branch road or the winker operation is performed in the direction of the branch road, It becomes possible to accurately determine whether or not the host vehicle enters the branch road.

さらに、上記のように分岐路を的確に検出し、分岐路への進入を的確に判定することができるため、例えば、自車両の加速を適切に禁止したり、ランプ路等では自車両を適切に減速させたりすることが可能となり、自車両を安定的に走行させることが可能となり、自車両の走行の安全性を向上させることが可能となる。   Furthermore, since it is possible to accurately detect the branch road as described above and accurately determine the approach to the branch road, for example, the vehicle is appropriately prohibited from accelerating or the vehicle is It is possible to decelerate the vehicle so that the host vehicle can travel stably, and the safety of the host vehicle can be improved.

また、第1の発明によれば、自車両が分岐路に進入すると判定された段階で自車両の加速を禁止する信号を出力することで、通常、減速が要求されるランプ路等への入り口である分岐路で不要な加速を禁止して、適切かつ安定的に減速を開始させることが可能となる。また、そのため、自車両の走行の安全性を向上させることが可能となる。   In addition, according to the first aspect of the present invention, it is possible to output a signal for prohibiting acceleration of the host vehicle when it is determined that the host vehicle enters the branch road, so that an entrance to a ramp road or the like that normally requires deceleration is provided. It is possible to prohibit unnecessary acceleration on the branch road and to start deceleration appropriately and stably. Therefore, it is possible to improve the traveling safety of the host vehicle.

また、第1の発明によれば、自車両がブロック線を越えて分岐路に進入したと判定されても、そのレーンが分岐路ではなく登坂路である場合があり、登坂路では自車両の加速を禁止する必要はない。そのため、自車両が分岐路に進入した後、自車両の左側または右側の車線が引き続きブロック線である場合には、分岐路ではなく登坂路を走行している可能性が高いと判断して、自車両の加速を禁止する信号の出力を解除することで自車両を適切に走行させることが可能となり、上述した効果をより有効に発揮させることが可能となる。   According to the first invention, even if it is determined that the host vehicle has entered the branch road across the block line, the lane may be an uphill road instead of a branch road. There is no need to prohibit acceleration. Therefore, after the host vehicle enters the branch road, if the left or right lane of the host vehicle is still a block line, it is determined that it is highly likely that the vehicle is traveling on an uphill road instead of a branch road. By canceling the output of the signal that prohibits the acceleration of the host vehicle, the host vehicle can travel appropriately, and the above-described effects can be more effectively exhibited.

第2の発明によれば、ランプ路等のカーブがきつい場合や自車両が登坂路を走行している可能性が高い場合に自車両の加速を禁止する信号や自車両を減速させる旨の信号の出力を解除する際に、自車両の定速走行制御に復帰させる旨の信号を出力してACC制御に復帰させることで、より適切に自車両の走行を制御することが可能となり、前記各発明の効果をより効果的に発揮させることが可能となる。   According to the second invention, when a curve such as a ramp road is tight or when it is highly likely that the host vehicle is traveling on an uphill road, a signal prohibiting acceleration of the host vehicle or a signal decelerating the host vehicle is provided. When the output of the vehicle is canceled, a signal for returning to the constant speed running control of the own vehicle is output and the ACC control is restored, so that the running of the own vehicle can be controlled more appropriately. The effects of the invention can be exhibited more effectively.

第3の発明によれば、自車両が先行車両を検出する先行車両検出手段を備えている場合には、上記各発明の制御よりも、ACC制御、特に先行車両に対する追従走行制御を優先するように構成することで、先行車両に追突する等の事態が生じることを確実に防止することが可能となり、前記各発明の効果がより適切に発揮される。   According to the third invention, when the own vehicle is provided with the preceding vehicle detecting means for detecting the preceding vehicle, priority is given to the ACC control, particularly the follow-up traveling control for the preceding vehicle, over the control of each of the above inventions. With this configuration, it is possible to reliably prevent a situation such as a collision with a preceding vehicle, and the effects of the above-described inventions are more appropriately exhibited.

本実施形態に係る分岐路進入判定装置の構成を示すブロック図である。It is a block diagram which shows the structure of the branch path approach determination apparatus which concerns on this embodiment. 本実施形態に係る車線検出手段の構成を示すブロック図である。It is a block diagram which shows the structure of the lane detection means which concerns on this embodiment. 基準画像および車線候補点を表す図である。It is a figure showing a reference image and a lane candidate point. 基準画像中に検出された左右の車線を表す図である。It is a figure showing the left and right lane detected in the standard image. 基準画像に撮像されたブロック線および分岐路を表す図である。It is a figure showing the block line and branching path which were imaged by the reference | standard image. 車線が破線からブロック線に変化する場合に分岐路を検出しない例を表す図である。It is a figure showing the example which does not detect a branch road, when a lane changes from a broken line to a block line. 実空間上に検出された立体物、先行車両、走行軌跡および自車両の進行路を説明する図である。It is a figure explaining the solid object detected in real space, a preceding vehicle, a travel locus, and the traveling path of the own vehicle. 基準画像中に検出された立体物、先行車両、走行軌跡および自車両の進行路を説明する図である。It is a figure explaining the solid object detected in the reference | standard image, a preceding vehicle, a travel locus, and the advancing path of the own vehicle. 本実施形態に係る分岐路進入判定装置の制御手段の制御構成を示すフローチャートである。It is a flowchart which shows the control structure of the control means of the branch path approach determination apparatus which concerns on this embodiment. 本実施形態に係る分岐路進入判定装置の制御手段の制御構成を示すフローチャートである。It is a flowchart which shows the control structure of the control means of the branch path approach determination apparatus which concerns on this embodiment. 本実施形態に係る分岐路進入判定装置の制御手段の制御構成を示すフローチャートである。It is a flowchart which shows the control structure of the control means of the branch path approach determination apparatus which concerns on this embodiment. 実空間上に検出されたブロック線および分岐路を表す図である。It is a figure showing the block line and branch path detected on real space. 自車両が登坂路を走行している状態を説明する図である。It is a figure explaining the state in which the own vehicle is running on the uphill road. 自車両がランプ路に進入した状態を説明する図である。It is a figure explaining the state which the own vehicle approached into the ramp path. 自車両がパーキング等に進入した状態を説明する図である。It is a figure explaining the state which the own vehicle entered parking etc.

以下、本発明に係る分岐路進入判定装置の実施の形態について、図面を参照して説明する。   Embodiments of a branch path entry determination device according to the present invention will be described below with reference to the drawings.

本実施形態に係る分岐路進入判定装置1は、図1に示すように、データ収集部2aと解析部2bとからなる車線検出手段2と、長さ幅検出手段3と、走行区分判定手段4と、分岐路検出手段5と、分岐路進入判定手段6と、先行車両検出手段7と、制御手段8と、記憶手段9とを備えている。また、本実施形態では、分岐路進入判定装置1からの信号がACC装置Aに出力されるようになっている。   As shown in FIG. 1, the branch path approach determination device 1 according to the present embodiment includes a lane detection unit 2, a length / width detection unit 3, and a travel segment determination unit 4 including a data collection unit 2 a and an analysis unit 2 b. A branch path detection means 5, a branch path entry determination means 6, a preceding vehicle detection means 7, a control means 8, and a storage means 9. Moreover, in this embodiment, the signal from the branch path approach determination apparatus 1 is output to the ACC apparatus A.

なお、本実施形態では、ACC装置Aは、ドライバにより設定された速度で自車両を定速走行させるように制御を行うとともに、先行車両が存在する場合には自車両を先行車両に追従させるように自車両のアクセルスロットルやブレーキ機構等を自動制御するための装置である。   In the present embodiment, the ACC device A performs control so that the host vehicle travels at a constant speed at a speed set by the driver, and causes the host vehicle to follow the preceding vehicle when the preceding vehicle exists. It is a device for automatically controlling the accelerator throttle and brake mechanism of the host vehicle.

分岐路進入判定装置1の車線検出手段2は、自車両の左側および右側の車線を検出するための手段である。本実施形態では、自車両の周囲を撮像する撮像手段を備え、撮像手段により撮像された画像中から車線を検出するようになっており、具体的には、本願出願人により先に提出された特開2006−331389号公報に記載の車線認識装置が用いられている。以下、簡単に説明する。   The lane detection means 2 of the branch path entry determination device 1 is means for detecting the left and right lanes of the host vehicle. In the present embodiment, an image pickup means for picking up the surroundings of the host vehicle is provided, and a lane is detected from an image picked up by the image pickup means. Specifically, it was previously filed by the applicant of the present application. A lane recognition device described in JP-A-2006-331389 is used. A brief description is given below.

車線検出手段2は、図2に示すように構成されており、データ収集部2aでは、車幅方向に一定の距離をあけて配置された一対のメインカメラ21aおよびサブカメラ21bからなる撮像手段21で自車両の周囲を撮像して得られた一対の撮像画像を変換手段22であるA/Dコンバータ22a、22bでそれぞれデジタル画像に変換し、画像補正部23でずれやノイズの除去、輝度値の補正等の画像補正を行って、画像データメモリ24に格納するとともに、解析部2bに送信する。   The lane detection means 2 is configured as shown in FIG. 2, and in the data collection unit 2a, an imaging means 21 comprising a pair of main camera 21a and sub camera 21b arranged at a certain distance in the vehicle width direction. The A / D converters 22a and 22b, which are conversion means 22, respectively convert the pair of captured images obtained by imaging the surroundings of the host vehicle to digital images, and the image correction unit 23 removes deviations and noises, and the luminance value. Are corrected and stored in the image data memory 24 and transmitted to the analysis unit 2b.

また、画像補正が行われた一対の撮像画像は、画像処理手段25に送られて、イメージプロセッサ26で、メインカメラ21aで撮像した撮像画像(以下、基準画像という。)が複数の画素ブロックに分割され、各画素ブロックについてそれぞれサブカメラ21bで撮像した撮像画像の対応する画素ブロックがステレオマッチング処理により見出され、各画素ブロックごとに視差が算出される。この視差の算出については、本願出願人により先に提出された特開平5−114099号公報等に詳述されている。   The pair of captured images subjected to the image correction is sent to the image processing means 25, and the captured images (hereinafter referred to as reference images) captured by the main camera 21a by the image processor 26 are converted into a plurality of pixel blocks. The pixel block corresponding to the captured image captured by the sub camera 21b for each pixel block is found by the stereo matching process, and the parallax is calculated for each pixel block. The calculation of the parallax is described in detail in Japanese Patent Application Laid-Open No. 5-1114099 previously filed by the applicant of the present application.

この視差と実空間上の位置とは三角測量の原理に基づいて対応付けることができ、具体的には、視差をdp、画素ブロックの基準画像上の座標を(i,j)とし、実空間上で、メインカメラ21aおよびサブカメラ21bの中央真下の道路面上の点を原点とし、自車両の車幅方向すなわち左右方向にX軸、車高方向にY軸、車長方向すなわち距離方向にZ軸を取ると、実空間上の点(X,Y,Z)と、視差dpと画素ブロックの基準画像上の座標(i,j)との関係は、
X=CD/2+Z×PW×(i−IV) …(1)
Y=CH+Z×PW×(j−JV) …(2)
Z=CD/(PW×(dp−DP)) …(3)
で表すことができる。
The disparity and the position in the real space can be associated based on the principle of triangulation. Specifically, the disparity is dp, the coordinates on the reference image of the pixel block are (i, j), and the real space Thus, with the point on the road surface directly below the center of the main camera 21a and the sub camera 21b as the origin, the vehicle width direction of the host vehicle, that is, the X axis in the left and right direction, the Y axis in the vehicle height direction, and the Z direction in the vehicle length direction, that is, the distance direction. Taking the axis, the relationship between the point (X, Y, Z) in real space, the parallax dp and the coordinates (i, j) on the reference image of the pixel block is
X = CD / 2 + Z * PW * (i-IV) (1)
Y = CH + Z × PW × (j−JV) (2)
Z = CD / (PW × (dp−DP)) (3)
Can be expressed as

ここで、CDはメインカメラ21aとサブカメラ21bとの間隔、PWは1画素当たりの視野角、CHはメインカメラ21aとサブカメラ21bの取り付け高さ、IVおよびJVは自車両正面の無限遠点のi座標およびj座標、DPは消失点視差を表す。   Here, CD is a distance between the main camera 21a and the sub camera 21b, PW is a viewing angle per pixel, CH is a mounting height of the main camera 21a and the sub camera 21b, and IV and JV are infinity points in front of the host vehicle. I coordinate and j coordinate, and DP represent vanishing point parallax.

画像処理手段25は、基準画像の各画素ブロックに視差dpを割り当てて距離データメモリ27に格納するとともに、解析部2bに送信するようになっている。なお、以下、基準画像の各画素ブロックに視差dpが割り当てられて形成された画像を距離画像という。   The image processing means 25 assigns a parallax dp to each pixel block of the reference image, stores it in the distance data memory 27, and transmits it to the analysis unit 2b. Hereinafter, an image formed by assigning the parallax dp to each pixel block of the reference image is referred to as a distance image.

車線検出手段2の解析部2bは、図示しないCPUやROM、RAM、入出力インターフェース等がバスに接続されたコンピュータより構成されている。   The analysis unit 2b of the lane detection means 2 is composed of a computer having a CPU, ROM, RAM, input / output interface, etc. (not shown) connected to the bus.

解析部2bでは、図3に示すように、基準画像Tの1画素幅の水平ラインj上を例えば基準画像Tの中央から左右方向に順次、隣接する画素間の輝度変化量を演算し、設定された閾値以上に輝度値が大きく変化する画素を車線候補点cl、crとして検出する。そして、基準画像T上の水平ラインjを1画素分ずつ上方にシフトさせながら、各水平ラインj上に車線候補点を検出していく。その際、解析部2bは、検出した車線候補点のうち、距離画像に基づいて道路面上にないと判断した車線候補点を車線候補点から除外する。   In the analysis unit 2b, as shown in FIG. 3, the luminance change amount between adjacent pixels is calculated and set on the horizontal line j of one pixel width of the reference image T, for example, sequentially from the center of the reference image T in the left-right direction. Pixels whose luminance values greatly change beyond the threshold value are detected as lane candidate points cl and cr. The lane candidate points are detected on each horizontal line j while shifting the horizontal line j on the reference image T upward by one pixel. At that time, the analysis unit 2b excludes the detected lane candidate points from the lane candidate points that are determined not to be on the road surface based on the distance image.

そして、残った車線候補点のうち、自車両に近い側の車線候補点に基づいて車線を直線で近似して自車両の左右にそれぞれ検出する。その際、直線との整合性が取れない車線候補点を除外するなどして検出の信頼性を向上させながら、自車両の一方の側(例えば右側)に複数の車線が検出される場合には自車両の他方(例えば左側)に検出した車線との整合性がある車線や前回のサンプリング周期で検出した車線との整合性がある車線を選ぶ等して、自車両の左右にそれぞれ直線を選別する。   Then, of the remaining lane candidate points, the lane is approximated by a straight line based on the lane candidate points closer to the host vehicle, and is detected on the left and right sides of the host vehicle, respectively. In this case, if multiple lanes are detected on one side (for example, the right side) of the host vehicle while improving the reliability of detection by excluding lane candidate points that cannot be consistent with the straight line Select a lane that is consistent with the lane detected on the other side of the vehicle (for example, the left side) or a lane that is consistent with the lane detected in the previous sampling cycle, etc. To do.

このようにして、自車両に近い側に車線を直線状にそれぞれ検出すると、それより遠い側ではその直線に基づいて直線との位置関係等から車線候補点を選別して結ぶことで、図4に示すように自車両の左側および右側にそれぞれ車線Ll、Lrを検出するようになっている。なお、以下、自車両の左側および右側の車線Ll、Lrをそれぞれ左車線Llおよび右車線Lrという。また、図4では基準画像T上で車線候補点cl、crが疎らに検出されるように示されているが、実際には非常に細かく多数検出される。   In this way, when the lanes are detected in a straight line on the side closer to the host vehicle, the lane candidate points are selected and connected based on the positional relationship with the straight line based on the straight line on the far side, thereby FIG. As shown in the figure, the lanes Ll and Lr are detected on the left and right sides of the host vehicle, respectively. Hereinafter, the left and right lanes Ll and Lr of the host vehicle are referred to as a left lane Ll and a right lane Lr, respectively. Further, in FIG. 4, the lane candidate points cl and cr are shown to be sparsely detected on the reference image T, but in reality, a large number are detected very finely.

なお、以上の車線検出手段2については、前述したように特開2006−331389号公報に車線認識装置として詳述されており、詳細な説明は同公報を参照されたい。   The lane detection means 2 described above is described in detail as a lane recognition device in Japanese Patent Application Laid-Open No. 2006-331389 as described above, and the detailed description is referred to the same publication.

本実施形態では、図1に示した長さ幅検出手段3、走行区分判定手段4、分岐路検出手段5、分岐路進入判定手段6、先行車両検出手段7、制御手段8および記憶手段9は、車線検出手段2の解析部2bを構成しているコンピュータと同じコンピュータに構成されている。   In the present embodiment, the length / width detection means 3, the travel segment determination means 4, the branch path detection means 5, the branch path entry determination means 6, the preceding vehicle detection means 7, the control means 8 and the storage means 9 shown in FIG. The computer is the same as the computer constituting the analysis unit 2b of the lane detection means 2.

長さ幅検出手段3は、車線検出手段2により検出された左車線Llおよび右車線Lrの自車両の進行方向の実空間上の長さと車線の実空間上の幅とをそれぞれ検出するようになっている。   The length width detection means 3 detects the length of the left lane Ll and the right lane Lr detected by the lane detection means 2 in the real space in the traveling direction of the host vehicle and the width of the lane in the real space, respectively. It has become.

具体的には、長さ幅検出手段3は、図3に示したように、車線検出手段2が基準画像Tの水平ラインj上に車線候補点cl、crを検出すると、それらの車線候補点cl、crに対応し、輝度値が隣接する画素の輝度値から設定された閾値以上に大きく減少する画素を終了点cl、crとして検出する。 Specifically, as shown in FIG. 3, when the lane detection unit 2 detects the lane candidate points cl and cr on the horizontal line j of the reference image T as shown in FIG. Corresponding to cl and cr, pixels whose luminance values are greatly reduced from the luminance values of adjacent pixels by a set threshold value or more are detected as end points cl * and cr * .

そして、車線候補点cl、crや終了点cl、crの基準画像Tの座標(i,j)と視差dpとを前記(1)〜(3)式に代入して、車線候補点clと終了点clとの実空間上のX軸方向すなわち左右方向の距離、および車線候補点crと終了点crとの実空間上のX軸方向の距離をそれぞれ算出して、自車両の左車線Ll、右車線Lrの実空間上の幅としてそれぞれ検出する。そして、この操作を、車線検出手段2が基準画像T上で水平ラインjを上方にシフトさせながら車線候補点cl、crを検出するごとに行うようになっている。 Then, the coordinates (i, j) and the parallax dp of the reference image T of the lane candidate points cl and cr and the end points cl * and cr * are substituted into the equations (1) to (3) to obtain the lane candidate point cl. an X-axis direction, that is in the left-right direction between the real space of the end point cl *, and the X-axis direction distance in the real space of the lane candidate points cr and the end point cr * is calculated respectively, of the vehicle The widths of the left lane Ll and the right lane Lr are detected as real space widths. This operation is performed each time the lane detection means 2 detects the lane candidate points cl and cr while shifting the horizontal line j upward on the reference image T.

また、長さ幅検出手段3は、水平ラインjを上方にシフトしながら検出される車線候補点cl、crのZ軸方向すなわち自車両の進行方向の距離も同様の算出により検出するようになっており、車線候補点同士のZ軸方向の距離が設定された閾値以下で近接する車線候補点同士を同じグループであるとしてグループ化していく。また、ある水平ラインj上に検出された車線候補点と既に検出されている最も近接する車線候補点とのZ軸方向の距離が前記閾値よりも大きい場合には当該車線候補点は別のグループに属するとして区別する。1つのグループは、道路面にペイントされた車線の標示部分に対応する。   Further, the length / width detecting means 3 detects the distance in the Z-axis direction of the lane candidate points cl and cr detected while shifting the horizontal line j upward, that is, the traveling direction of the host vehicle by the same calculation. The lane candidate points that are close to each other with the distance in the Z-axis direction between the lane candidate points being equal to or less than the set threshold are grouped as the same group. In addition, when the distance in the Z-axis direction between the lane candidate point detected on a certain horizontal line j and the already detected closest lane candidate point is larger than the threshold, the lane candidate point is in another group. Distinguish as belonging to. One group corresponds to the marking portion of the lane painted on the road surface.

そして、長さ幅検出手段3は、このようにして検出したグループすなわち車線の標示部分の実空間上のZ軸方向の距離を算出し、車線Ll、Lrの自車両の進行方向の実空間上の長さとしてそれぞれ検出するようになっている。複数のグループが検出された場合には、グループ間の自車両進行方向の間隔、すなわち車線の2つの標示部分の間のペイントされていない非標示部分の間隔も検出する。   Then, the length / width detection means 3 calculates the distance in the Z-axis direction in the real space of the thus detected group, that is, the marking portion of the lane, in the real space in the traveling direction of the lanes Ll and Lr. The length of each is detected. When a plurality of groups are detected, the distance between the groups in the traveling direction of the host vehicle, that is, the distance between the two unmarked portions of the lane that are not painted is also detected.

長さ幅検出手段3は、このようにして検出した車線の幅が、例えば0.2m未満であれば当該車線を通常の車線であると判断し、そのうち、グループとしてまとめられた標示部分の自車両進行方向の実空間上の長さが所定の長さ以上連続している場合には実線である車線、標示部分の長さや非標示部分の間隔が所定の長さである場合には破線である車線であると判断するようになっている。   If the width of the lane detected in this way is less than 0.2 m, for example, the length / width detection means 3 determines that the lane is a normal lane, and among these, the self-signed portion of the marking portion grouped as a group. A lane that is a solid line if the length in the real space in the vehicle traveling direction continues for a predetermined length or more, and a broken line if the length of the marking part or the interval between the non-marking parts is a predetermined length. Judging that it is a certain lane.

なお、車線検出手段2および長さ幅検出手段3は、上記の構成に限定されず、自車両の左右の車線Ll、Lrを検出でき、それらの幅や自車両の進行方向の長さを検出できるものであればよい。   The lane detection means 2 and the length / width detection means 3 are not limited to the above-described configuration, and can detect the left and right lanes Ll and Lr of the host vehicle, and detect their width and length in the traveling direction of the host vehicle. Anything is possible.

走行区分判定手段4(図1参照)は、長さ幅検出手段3による検出結果に基づいて車線の線種を判定して実線である車線が自車両の左側であるか右側であるかを判断して、自車両が走行している走行レーンの区分を判定するようになっている。   The travel segment determination means 4 (see FIG. 1) determines the line type of the lane based on the detection result by the length width detection means 3, and determines whether the lane that is a solid line is the left side or the right side of the host vehicle. Thus, the classification of the traveling lane in which the host vehicle is traveling is determined.

例えば、図3に示したように左車線Llが実線である車線であり、右車線Lrが破線である車線である場合、走行区分判定手段4は、自車両が道路の最も左側の走行レーンを走行していると判定する。また、逆に、右車線Lrが実線である車線であり、左車線Llが破線である車線である場合には、走行区分判定手段4は、自車両が道路の最も右側の走行レーンを走行していると判定する。   For example, as shown in FIG. 3, when the left lane Ll is a lane that is a solid line and the right lane Lr is a lane that is a broken line, the travel classification determination unit 4 determines that the vehicle is in the leftmost travel lane of the road. It is determined that the vehicle is running. Conversely, when the right lane Lr is a lane that is a solid line and the left lane Ll is a lane that is a broken line, the travel classification determination means 4 causes the vehicle to travel in the rightmost travel lane of the road. It is determined that

また、自車両の左右の車線Ll、Lrがともに実線である車線である場合には、走行区分判定手段4は、自車両が追い越しのためのはみ出し禁止の走行レーン(以下、はみ出し禁止レーンという。)を走行していると判定するようになっている。   When the left and right lanes Ll and Lr of the host vehicle are both solid lanes, the travel classification determination means 4 is a travel lane in which the host vehicle is not allowed to overtake (hereinafter referred to as a “protrude prohibited lane”). ) Is determined to be driving.

分岐路検出手段5(図1参照)は、長さ幅検出手段3による検出結果に基づいて、実線である車線として検出されていた車線の線種がブロック線に変化した場合に、変化した車線の側に分岐路が存在することを検出するようになっている。具体的には、実線であるとして検出されていた車線の線種が破線に変化し、長さ幅検出手段3の検出結果によりその車線の幅が0.3〜0.75mの範囲内にあり、標示部分の長さが2〜5mの範囲内にある場合に、検出した車線の線種が通常の車線よりも車線幅が広く長さが短いブロック線に変化したと判断するようになっている。   The branch road detecting means 5 (see FIG. 1) determines the changed lane when the line type of the lane detected as a solid lane changes to a block line based on the detection result by the length width detecting means 3. The presence of a branch path on the side of the is detected. Specifically, the line type of the lane detected as being a solid line changes to a broken line, and the width of the lane is within the range of 0.3 to 0.75 m based on the detection result of the length / width detection means 3. When the length of the marking portion is in the range of 2 to 5 m, it is determined that the detected lane line type has changed to a block line with a wider lane width and shorter length than a normal lane. Yes.

また、分岐路検出手段5は、車線が実線からブロック線に変化したことを検出するために、現在はブロック線として検出されている車線が以前のサンプリング周期では実線であったという履歴を保持するための手段を有している。本実施形態では、後述するように履歴を保持する手段としてカウンタ(左側レーン走行中カウンタLcount)が用いられるようになっており、カウンタは、自車両の一方の車線が実線である間に履歴であるカウント数が増加されたり一定値がセットされたりする。そして、その一方の車線としてブロック線が検出された場合にそのカウント数が参照され、以前にその車線が実線であったことを示すカウント数となっていれば車線が実線からブロック線に変化したと判断されるようになっている。   Further, the branch path detection means 5 maintains a history that the lane currently detected as a block line was a solid line in the previous sampling cycle in order to detect that the lane has changed from a solid line to a block line. Have means for. In the present embodiment, as will be described later, a counter (left lane running counter Lcount) is used as a means for holding the history, and the counter indicates the history while one lane of the host vehicle is a solid line. A certain count number is increased or a constant value is set. And when the block line is detected as one of the lanes, the count number is referred to, and if the count number indicates that the lane was a solid line before, the lane changed from a solid line to a block line It has come to be judged.

そして、例えば図3に示したように実線である車線として検出されていた左車線Llが、車線の自車両の進行方向の実空間上の長さと車線の実空間上の幅とから図5に示すようなブロック線BLに変化した場合、分岐路検出手段5は、変化した車線の側、すなわち図5の場合は自車両の左側のブロック線BLのさらに左側に分岐路Bが存在すると判断して分岐路Bを検出するようになっている。   For example, as shown in FIG. 3, the left lane L1 detected as a lane that is a solid line is shown in FIG. 5 based on the length of the lane in the traveling direction of the vehicle and the width of the lane in the real space. When the block line BL changes as shown, the branch path detection means 5 determines that the branch path B exists on the changed lane side, that is, in the case of FIG. 5, further on the left side of the block line BL on the left side of the host vehicle. Thus, the branch path B is detected.

なお、例えば図6に示すようにもともと3車線であった道路が2車線と1車線に分岐していくような場合に車線が破線である車線からブロック線BLに変化する場合があるが、このような場合、本実施形態では、分岐路検出手段5は、自車両の左側または右側の車線が破線である車線からブロック線BLに変化しても自車両から見てブロック線BLのさらに左側またはさらに右側の走行レーンを分岐路としては検出しない。   For example, as shown in FIG. 6, when a road that was originally three lanes branches into two lanes and one lane, the lane may change from a lane that is a broken line to a block line BL. In such a case, in the present embodiment, the branch path detection means 5 is configured such that even if the left or right lane of the host vehicle changes from a lane that is a broken line to a block line BL, Furthermore, the right driving lane is not detected as a branch road.

従って、分岐路検出手段5は、自車両が道路の最も左側の走行レーンを走行している場合に左車線Llが実線である車線からブロック線BLに変化した場合、自車両が道路の最も右側の走行レーンを走行している場合に右車線Lrが実線である車線からブロック線に変化した場合、および自車両がはみ出し禁止レーンを走行している場合に左右いずれかの車線Ll、Lrが実線である車線からブロック線に変化した場合に、それぞれさらにその外側に分岐路が存在すると判断して検出するようになっている。   Accordingly, the branch path detection means 5 determines that if the left lane Ll changes from a solid lane to a block line BL when the host vehicle is traveling on the leftmost lane of the road, the host vehicle is the rightmost side of the road. If the right lane Lr changes from a lane that is a solid line to a block line when the vehicle is traveling in a driving lane, and if the host vehicle is traveling on an overhang prohibition lane, one of the left and right lanes Ll and Lr is a solid line When the lane is changed from a lane to a block line, it is determined that there is a branch road outside the lane.

分岐路進入判定手段6(図1参照)は、分岐路検出手段5が分岐路Bを検出している間に、自車両が分岐路Bに向かって移動し、または分岐路方向にウィンカ操作が行われた場合に、自車両が分岐路Bに進入すると判定するようになっている。   The branch path entry determining means 6 (see FIG. 1) is configured so that the host vehicle moves toward the branch path B while the branch path detecting means 5 detects the branch path B, or the winker operation is performed in the direction of the branch path. When it is performed, it is determined that the host vehicle enters the branch road B.

本実施形態では、分岐路進入判定手段6は、図示しないターンシグナルスイッチが分岐路側に操作されたことを検出して、或いはその旨の情報を受信して、分岐路方向にウィンカ操作が行われたと判断するようになっている。従って、ウィンカ操作が行われてもターンシグナルスイッチが分岐路Bと反対側に操作された場合には、分岐路進入判定手段6は自車両が分岐路Bに進入するとは判定しない。   In the present embodiment, the branch path entry determination means 6 detects that a turn signal switch (not shown) has been operated to the branch path side or receives information to that effect and performs a winker operation in the direction of the branch path. It has come to be judged. Therefore, even if the turn signal operation is performed, if the turn signal switch is operated on the side opposite to the branch path B, the branch path entry determination means 6 does not determine that the host vehicle enters the branch path B.

また、本実施形態では、自車両の分岐路Bへの移動は、自車両の分岐路B側の車輪の位置が実空間上に換算されたブロック線の内側端部に接触したことで判断されるようになっており、その段階で、自車両が分岐路Bに向かって移動し、分岐路Bに進入すると判定するようになっている。なお、自車両の分岐路Bへの移動の判断条件は、この他にも、自車両の分岐路B側の車輪がブロック線の中央より分岐路B側に進出した場合や、ステアリングホイールを分岐路B側に所定の舵角以上に切った場合、後述する自車両の走行軌跡Lestが分岐路B側を向いた場合等とすることも可能であり、適宜設定される。   In the present embodiment, the movement of the host vehicle to the branch path B is determined by the position of the wheel on the branch path B side of the host vehicle contacting the inner end of the block line converted into the real space. At that stage, it is determined that the host vehicle moves toward the branch path B and enters the branch path B. In addition to this, other conditions for determining the movement of the host vehicle to the branch path B include the case where the wheel on the branch path B side of the host vehicle advances from the center of the block line to the branch path B side, and the steering wheel is branched. When the vehicle is turned to the road B side by a predetermined rudder angle or more, a travel locus Lest of the host vehicle, which will be described later, may face the branch road B side or the like, and is set as appropriate.

本実施形態の分岐路進入判定装置1には、図1に示したように、先行車両検出手段7が設けられている。先行車両検出手段7は、車線検出手段2のデータ収集部2aの距離データメモリ27から距離画像を読み出して、距離画像の各画素ブロックの視差dpの情報に基づいて基準画像T中から先行車両を検出するようになっている。   As shown in FIG. 1, the branch vehicle approach determination device 1 of the present embodiment is provided with a preceding vehicle detection means 7. The preceding vehicle detection means 7 reads the distance image from the distance data memory 27 of the data collection unit 2a of the lane detection means 2, and selects the preceding vehicle from the reference image T based on the information of the parallax dp of each pixel block of the distance image. It comes to detect.

本実施形態では、先行車両検出手段7は、本願出願人により先に提出された特開平10−283461号公報や特開平10−283477号公報に記載された車外監視装置をベースに構成されており、これにより、例えば図3に示した基準画像Tに基づいた場合、図7に示すように、自車両MCの前方の撮像領域内に存在し、道路面より高い位置にある立体物が検出される。このようにして検出された立体物を基準画像T中に示すと、図8に示すように、道路面より高い位置にある立体物が枠線で囲まれる状態で検出できる。なお、検出された立体物に対するSやOの符号は、立体物の側面を検出しているか背面を検出しているかの種別を示す符号である。   In the present embodiment, the preceding vehicle detection means 7 is configured based on a vehicle exterior monitoring device described in Japanese Patent Application Laid-Open No. 10-283461 and Japanese Patent Application Laid-Open No. 10-283477 previously filed by the applicant of the present application. Thus, for example, based on the reference image T shown in FIG. 3, as shown in FIG. 7, a three-dimensional object existing in the imaging region in front of the host vehicle MC and located at a position higher than the road surface is detected. The When the three-dimensional object detected in this way is shown in the reference image T, as shown in FIG. 8, the three-dimensional object at a position higher than the road surface can be detected in a state surrounded by a frame line. In addition, the code | symbol of S and O with respect to the detected solid object is a code | symbol which shows the classification whether the side surface of the solid object is detected, or the back surface is detected.

また、先行車両検出手段7は、自車両の挙動に基づいて、図7や図8に示すように自車両の走行軌跡Lestを推定するようになっている。具体的には、先行車両検出手段7は、図示しない車速センサやヨーレートセンサ、舵角センサから入力される自車両の車速Vやヨーレートγ、ステアリングホイールの舵角δ等に基づいて自車両の旋回曲率Cuaを下記(4)式や(5)、(6)式に基づいて算出する。下記の各式におけるReは旋回半径、Asfは車両のスタビリティファクタ、Lwbはホイールベースである。
Cua=γ/V …(4)
Re=(1+Asf・V)・(Lwb/δ) …(5)
Cua=1/Re …(6)
Further, the preceding vehicle detection means 7 estimates the traveling locus Lest of the own vehicle as shown in FIGS. 7 and 8 based on the behavior of the own vehicle. Specifically, the preceding vehicle detecting means 7 turns the own vehicle based on the vehicle speed V, yaw rate γ, the steering angle δ of the steering wheel, etc. inputted from a vehicle speed sensor, a yaw rate sensor, and a steering angle sensor (not shown). The curvature Cua is calculated based on the following equations (4), (5), and (6). In the following equations, Re is the turning radius, Asf is the vehicle stability factor, and Lwb is the wheelbase.
Cua = γ / V (4)
Re = (1 + Asf · V 2 ) · (Lwb / δ) (5)
Cua = 1 / Re (6)

そして、先行車両検出手段7は、算出した旋回曲率Cuaに基づいて自車両の走行軌跡Lestを算出して推定するようになっている。本実施形態では、先行車両検出手段7は、図7に示すように、走行軌跡Lestを中心とする自車両の車幅分の領域である自車両の進行路Rest上に存在する立体物の中で自車両に最も近接する立体物すなわち図7や図8の例では立体物O2であるトラックを先行車両として検出するようになっている。   And the preceding vehicle detection means 7 calculates and estimates the traveling locus Lest of the own vehicle based on the calculated turning curvature Cua. In the present embodiment, as shown in FIG. 7, the preceding vehicle detection means 7 is a three-dimensional object existing on the traveling path Rest of the own vehicle, which is an area corresponding to the vehicle width of the own vehicle with the travel locus Lest as the center. Thus, the three-dimensional object closest to the host vehicle, that is, the truck which is the three-dimensional object O2 in the example of FIGS. 7 and 8, is detected as the preceding vehicle.

なお、先行車両検出手段7は、先行車両を検出することができるものであれば、上記の構成に限定されない。   The preceding vehicle detection means 7 is not limited to the above configuration as long as the preceding vehicle can be detected.

以上の長さ幅検出手段3や走行区分判定手段4、分岐路検出手段5、分岐路進入判定手段6、先行車両検出手段7における検出結果や判定結果等は、記憶手段9に適宜記憶され、また、必要に応じて記憶手段9から読み出されるようになっている。   The above detection results and determination results in the length / width detection means 3, the travel segment determination means 4, the branch road detection means 5, the branch road entry determination means 6, and the preceding vehicle detection means 7 are appropriately stored in the storage means 9. Further, it is read from the storage means 9 as necessary.

次に、制御手段8(図1参照)の制御構成を、図9〜図11のフローチャートを用いて説明し、あわせて本実施形態に係る分岐路進入判定装置1の作用について説明する。   Next, the control configuration of the control means 8 (see FIG. 1) will be described with reference to the flowcharts of FIGS. 9 to 11 and the operation of the branch path entry determination device 1 according to this embodiment will be described.

なお、以下では、自車両が高速道路を走行中であり、ACC装置Aが作動している場合を例示して説明する。制御手段8は、先行車両検出手段7により先行車両が検出されている場合にはACC装置Aに自車両と先行車両との距離と先行車両の速度の情報を出力するようになっており、ACC装置Aは、先行車両の情報を受信していない場合には自車両の定速走行制御を行い、先行車両の情報を受信している場合には前記距離や速度に応じた自車両の先行車両追従制御と自車両の定速走行制御とを適宜選択してACC制御を行うようになっている。   Hereinafter, the case where the host vehicle is traveling on a highway and the ACC device A is operating will be described as an example. When the preceding vehicle is detected by the preceding vehicle detecting means 7, the control means 8 outputs information on the distance between the host vehicle and the preceding vehicle and the speed of the preceding vehicle to the ACC device A. The device A performs constant speed traveling control of the own vehicle when the information on the preceding vehicle is not received, and the preceding vehicle of the own vehicle according to the distance and the speed when the information on the preceding vehicle is received. The ACC control is performed by appropriately selecting the follow-up control and the constant speed traveling control of the host vehicle.

分岐路進入判定装置1の初期状態においては、後述する分岐路フラグFや左側レーン走行中カウンタLcount、登坂路カウンタScountは0にセットされる。   In the initial state of the branch road entry determination device 1, a branch road flag F, a left lane traveling counter Lcount, and an uphill road counter Scount described later are set to zero.

車線検出手段2により自車両の左右に車線Ll、Lrが検出されると(ステップS1)、制御手段8は、長さ幅検出手段3に検出された左車線Llおよび右車線Lrの自車両の進行方向の実空間上の長さと車線の実空間上の幅とを上記の要領でそれぞれ検出させる(ステップS2)。また、車線が破線である場合には、車線の非標示部分の間隔も検出する。   When the lane detection means 2 detects the lanes Ll and Lr on the left and right sides of the host vehicle (step S1), the control means 8 detects the left lane Ll and the right lane Lr of the host vehicle detected by the length width detection means 3. The length of the traveling direction in the real space and the width of the lane in the real space are detected in the above manner (step S2). Further, when the lane is a broken line, the interval between the non-labeled portions of the lane is also detected.

続いて、走行区分判定手段4は、長さ幅検出手段3による検出結果に基づいて実線である車線が自車両の左側であるか右側であるかを判断して、自車両が走行している走行レーンの区分を判定する。   Subsequently, the travel classification determination unit 4 determines whether the lane that is a solid line is the left side or the right side of the host vehicle based on the detection result by the length width detection unit 3, and the host vehicle is traveling. Determine the lane classification.

そして、制御手段8は、例えば図7に示したように、自車両の左車線Llが実線で、かつ右車線Lrが破線であり、走行区分判定手段4が、自車両が道路の最も左側の走行レーンを走行していると判定すると(図9のステップS3:YES)、続いて、長さ幅検出手段3の検出結果に基づいて破線である右車線Lrの標示部分の長さと非標示部分の間隔がそれぞれ所定の範囲内にあるか否かを判断する(ステップS4)。   Then, as shown in FIG. 7, for example, the control means 8 is such that the left lane Ll of the own vehicle is a solid line and the right lane Lr is a broken line, and the travel classification judging means 4 If it is determined that the vehicle is traveling in the travel lane (step S3 in FIG. 9: YES), then the length of the right lane Lr, which is a broken line, and the non-labeled portion based on the detection result of the length / width detection means 3 It is determined whether each of the intervals is within a predetermined range (step S4).

この左側走行レーンを走行中の右車線Lrの標示部分の長さおよび非標示部分の間隔の確認は、自車両が高速道路を走行中であるか否かを確認するためのものであり、本実施形態では、車線の標示部分の長さが8m±1m、非標示部分の間隔が12m±2mの範囲内にあれば所定の範囲内にあると判断するようになっている。なお、高速道路以外の一般道等を走行中に本実施形態の分岐路進入判定装置1を作動させる場合には、上記の判断の基準となる範囲設定は変更されてもよく、また、この確認判断の処理を行わないように構成することも可能である。   The confirmation of the length of the marking portion of the right lane Lr and the interval between the non-labeling portions that are traveling on the left lane is for confirming whether or not the host vehicle is traveling on the highway. In the embodiment, if the length of the marking portion of the lane is within the range of 8 m ± 1 m and the interval between the non-marking portions is within the range of 12 m ± 2 m, it is determined that it is within the predetermined range. In addition, when operating the branch path entry determination device 1 of the present embodiment while traveling on a general road other than an expressway, the range setting as a reference for the above determination may be changed, and this confirmation It is also possible to configure so that determination processing is not performed.

制御手段8は、右車線Lrの標示部分の長さと非標示部分の間隔が所定の範囲内にあると判断すると(ステップS4:YES)、続いて、左側レーン走行中カウンタLcountに所定のカウント数をセットする(ステップS5)。本実施形態では、左側レーン走行中カウンタLcountが前述した履歴を保持する手段であるが、その意味については後述する。   If the control means 8 determines that the length of the marking portion of the right lane Lr and the interval between the non-labeling portions are within a predetermined range (step S4: YES), then the left lane running counter Lcount has a predetermined count number. Is set (step S5). In the present embodiment, the left lane running counter Lcount is means for holding the above-described history, the meaning of which will be described later.

また、制御手段8は、走行区分判定手段4が、自車両が道路の最も左側の走行レーン以外を走行していると判定し(ステップS3:NO)、または、破線である右車線Lrの標示部分の長さと非標示部分の間隔のいずれか或いは両方が前記所定の範囲内にはないと判断すると(ステップS4:NO)、左側レーン走行中カウンタLcountのカウント数を1サンプリング周期ごとに1ずつ減算する(ステップS6)。   In addition, the control means 8 determines that the travel classification determination means 4 is traveling on a vehicle other than the leftmost travel lane of the road (step S3: NO) or indicates the right lane Lr that is a broken line If it is determined that either or both of the length of the portion and the interval of the non-labeled portion are not within the predetermined range (step S4: NO), the count number of the left lane running counter Lcount is set to 1 for each sampling period. Subtract (Step S6).

続いて、制御手段8は、左側レーン走行中カウンタLcountのカウント数が0より大きいか否かを判断し(ステップS7)、0より大きければ(ステップS7:YES)、分岐路検出手段5に前述した要領で左車線Llがブロック線に変化したか否かを判断させる(ステップS8)。   Subsequently, the control means 8 determines whether or not the count number of the left lane running counter Lcount is greater than 0 (step S7). If it is greater than 0 (step S7: YES), the branch path detection means 5 is described above. In this manner, it is determined whether or not the left lane Ll has changed to a block line (step S8).

例えば図7に示したように、自車両MCが最も左側の走行レーンを走行しており、インターチェンジやパーキング等の入り口に差し掛かっていない場合には、左車線Llは実線であり、前記判断では左車線Llはブロック線に変化していないと判断される(図9のステップS8:NO)。そして、分岐路フラグFが初期状態の0であれば、フローチャートの以下の処理は行われず、上記のルーチンが繰り返され、サンプリング周期ごとに左側レーン走行中カウンタLcountに所定のカウント数がセットされる。また、自車両が道路の最も左側の走行レーン以外を走行していると判定されるなどすれば、左側レーン走行中カウンタLcountのカウント数が1ずつ減算される。   For example, as shown in FIG. 7, when the host vehicle MC is traveling in the leftmost lane and has not reached the entrance of an interchange or parking, the left lane Ll is a solid line, and in the above determination, the left lane It is determined that the lane Ll has not changed to a block line (step S8: NO in FIG. 9). If the branch path flag F is 0 in the initial state, the following processing in the flowchart is not performed, and the above routine is repeated, and a predetermined count is set in the left lane running counter Lcount for each sampling period. . Also, if it is determined that the host vehicle is traveling on a road other than the leftmost lane on the road, the left lane traveling counter Lcount is decremented by one.

しかし、図12に示すように、自車両MCが高速道路の最も左側の走行レーンを走行している状態でインターチェンジやパーキング等の入り口に差し掛かるなどして、あるサンプリング周期で、分岐路検出手段5が、それまで実線としてラベル付けされていた左車線Llが幅0.3〜0.75m、標示部分の長さ2〜5mのブロック線BLに変化したと判断すると(図9のステップS8:YES)、分岐路検出手段5はブロック線BLのさらに左側に分岐路Bを検出し、制御手段8は、左車線Llのラベル付けを実線からブロック線に変更する。   However, as shown in FIG. 12, when the host vehicle MC is traveling on the leftmost lane of the highway, the branch road detection means is reached at a certain sampling period, for example, by approaching the entrance of an interchange or parking. 5 determines that the left lane L1 previously labeled as a solid line has changed to a block line BL having a width of 0.3 to 0.75 m and a length of the marking portion of 2 to 5 m (step S8 in FIG. 9: YES), the branch path detection means 5 detects the branch path B further to the left of the block line BL, and the control means 8 changes the labeling of the left lane Ll from the solid line to the block line.

ここで、履歴を保持する手段としての左側レーン走行中カウンタLcountの意味について説明する。高速道路の分岐路Bは、最も左側の走行レーンを走行している自車両MCの左車線Llがブロック線に変化したことを検出することで検出される。しかし、上記のように左車線Llのラベル付けが実線からブロック線に変更されただけでは、次回以降のサンプリング周期で、ステップS3の判断処理において自車両MCが最も左側の走行レーンを走行していないと判断されてしまい、実線であった左車線Llがブロック線に変化したことの履歴が残らない。   Here, the meaning of the left lane running counter Lcount as means for holding the history will be described. The branch road B of the expressway is detected by detecting that the left lane Ll of the host vehicle MC traveling in the leftmost lane has changed to a block line. However, if the labeling of the left lane Ll is only changed from the solid line to the block line as described above, the host vehicle MC is traveling in the leftmost lane in the determination process of step S3 in the sampling period after the next time. Therefore, there is no history that the left lane Ll, which was a solid line, has changed to a block line.

そこで、現在ブロック線として検出された左車線Llが少なくとも数秒前までは実線であり、それがブロック線に変化したという履歴を残すために、本実施形態では、自車両MCが最も左側の走行レーンを走行していると判定されている間(ステップS3:YES)履歴を表す左側レーン走行中カウンタLcountのカウント数に所定のカウント数をセットし(ステップS5)、左車線Llがブロック線BLに変化した後も(ステップS3:NO)、カウント数が0より大きい値を保持している間は(ステップS7:YES)そのブロック線BLとして検出されている左車線Llが以前は実線として検出されていたという履歴を残す。   Therefore, in order to leave a history that the left lane Ll detected as the current block line is a solid line at least several seconds ago and has changed to a block line, in this embodiment, the host vehicle MC is the leftmost lane. Is determined to be traveling (step S3: YES), a predetermined count is set to the count of the left lane traveling counter Lcount representing the history (step S5), and the left lane Ll is set to the block line BL. Even after the change (step S3: NO), the left lane Ll detected as the block line BL is detected as a solid line before, while the count number holds a value larger than 0 (step S7: YES). Leave a history of having been.

そして、このようにして実線であった左車線Llがブロック線BLに変化したことを検出することで(ステップS8:YES)、最も左側の走行レーンを走行していた自車両MCの左車線Llがブロック線に変化したことを保証しつつ、分岐路Bを検出するようになっている。   Then, by detecting that the left lane Ll, which has been a solid line, has changed to the block line BL in this way (step S8: YES), the left lane Ll of the host vehicle MC that has been traveling in the leftmost travel lane. The branch path B is detected while guaranteeing that has changed to a block line.

なお、履歴を保持する手段としては、本実施形態のようにステップS5の処理で自車両MCが最も左側の走行レーンを走行していることを検出する毎に左側レーン走行中カウンタLcountに所定のカウント数をセットする代わりに、左側レーン走行中カウンタLcountを1ずつ加算していき、一定の上限値になった段階で加算をやめるように構成することも可能である。また、自車両MCが高速道路の最も左側の走行レーンを走行していることを検出した段階で履歴を保持する手段としてフラグをたて、所定の時間、或いは自車両MCが所定の距離走行する間、自車両MCが最も左側の走行レーンを走行していないことが検出された段階でフラグをリセットするように構成することも可能である。   As a means for holding the history, the left lane traveling counter Lcount is set to a predetermined value every time it is detected that the host vehicle MC is traveling in the leftmost traveling lane in the process of step S5 as in the present embodiment. Instead of setting the count number, the left lane running counter Lcount may be incremented by 1 and the addition may be stopped when a certain upper limit value is reached. In addition, a flag is set as means for retaining a history when it is detected that the host vehicle MC is traveling on the leftmost lane of the expressway, and the host vehicle MC travels for a predetermined time or a predetermined distance. Meanwhile, the flag may be reset when it is detected that the host vehicle MC is not traveling in the leftmost travel lane.

制御手段8は、左車線Llがブロック線に変化したと判断すると(ステップS8:YES)、続いて、分岐路進入判定手段6に上記の要領で自車両MCが分岐路Bに進入するか否かを判定させ(ステップS9)、自車両MCが分岐路Bに進入すると判定されると(ステップS9:YES)、分岐路フラグFを1にセットする(ステップS10)。分岐路フラグFが1であることは、自車両MCが分岐路Bに進入した可能性がある状態であることを表す。   If the control means 8 determines that the left lane Ll has changed to a block line (step S8: YES), then whether or not the host vehicle MC enters the branch road B in the manner described above to the branch path entry determination means 6 If it is determined that the host vehicle MC enters the branch path B (step S9: YES), the branch path flag F is set to 1 (step S10). A branch road flag F of 1 indicates that the host vehicle MC may have entered the branch road B.

続いて、制御手段8は、分岐路フラグFが1(図10のステップS11:YES)、すなわち自車両MCが分岐路Bに進入したと判断すると、自車両MCが左側にあったブロック線BLを跨いで分岐路Bに進入することから、ブロック線BLが右車線Lrとして検出されているか否かを車線検出手段2および長さ幅検出手段3の検出結果から判断する(ステップS12)。   Subsequently, when the control unit 8 determines that the branch road flag F is 1 (step S11 in FIG. 10: YES), that is, the host vehicle MC has entered the branch path B, the block line BL where the host vehicle MC is on the left side. Therefore, it is determined from the detection results of the lane detection means 2 and the length width detection means 3 whether or not the block line BL is detected as the right lane Lr (step S12).

制御手段8は、右車線Lrがブロック線BLになったと判断すると(ステップS12:YES)、登坂路カウンタScountのカウント数を1サンプリング周期ごとに1ずつ加算する(ステップS13)。そして、登坂路カウンタScountのカウント数が予め設定された閾値Sthを超えた場合には(ステップS14:YES)、分岐路フラグFを0にリセットするようになっている(ステップS15)。   When the control means 8 determines that the right lane Lr has become the block line BL (step S12: YES), the control means 8 increments the count of the uphill road counter Scount by 1 every sampling period (step S13). When the count of the uphill road counter Scount exceeds a preset threshold value Sth (step S14: YES), the branch road flag F is reset to 0 (step S15).

上記の処理は、自車両が走行しているレーンが登坂路である場合には、引き続きACC装置Aを作動させるための処理である。すなわち、自車両MCがブロック線BLを跨いだとしても、図13に示すように、ブロック線BLの左側のレーンが実際には分岐路ではなく登坂路である場合があり、その場合にはACC装置Aを作動させた方がよい。また、自車両MCが分岐路Bに進入した状態であることを表す分岐路フラグFの1のセットは誤りであるからリセットして解除する。これにより、後述するようにACC装置Aが通常の動作に復帰する。   The above process is a process for continuously operating the ACC device A when the lane in which the host vehicle is traveling is an uphill road. That is, even if the host vehicle MC straddles the block line BL, the lane on the left side of the block line BL may actually be an uphill road instead of a branch road as shown in FIG. It is better to activate the device A. Further, since the set of 1 for the branch road flag F indicating that the host vehicle MC has entered the branch road B is an error, it is reset and released. As a result, the ACC device A returns to normal operation as will be described later.

また、自車両MCが進入したレーンが分岐路Bであれば、自車両MCの右車線Lrはブロック線BLから実線に変わるが、自車両MCが進入したレーンが登坂路Sである場合には、図13に示したように自車両MCの右車線Lrがブロック線BLである状態が比較的長時間続く。登坂路カウンタScountの加算は、このように自車両MCが走行しているレーンが分岐路Bであるか登坂路Sであるかを判断するために、自車両MCの右車線Lrがブロック線であり続ける時間経過をカウントするものである。そのため、登坂路カウンタScountのカウント数が予め設定された閾値Sthを超えないうちは(図10のステップS14:NO)、分岐路か登坂路かの判断ができず、分岐路フラグFを1に維持する。   Further, if the lane into which the host vehicle MC has entered is the branch road B, the right lane Lr of the host vehicle MC changes from the block line BL to the solid line, but if the lane into which the host vehicle MC has entered is the uphill road S, As shown in FIG. 13, the state where the right lane Lr of the host vehicle MC is the block line BL continues for a relatively long time. In order to determine whether the lane on which the host vehicle MC is traveling is a branch road B or an uphill road S, the right lane Lr of the host vehicle MC is a block line. It counts the lapse of time that continues. Therefore, as long as the count of the uphill road counter Scount does not exceed the preset threshold value Sth (step S14: NO in FIG. 10), it cannot be determined whether the road is a branch road or an uphill road, and the branch road flag F is set to 1. maintain.

制御手段8は、分岐路フラグFが1の状態であり(ステップS11:YES)、すなわち自車両MCが分岐路Bに進入した可能性があり、右車線Lrがブロック線BLではなくなったと判断すると(ステップS12:NO)、車線検出手段2および長さ幅検出手段3の検出結果に基づいて自車両の左右の車線Ll、Lrがともに実線か否かを判断する(ステップS16)。   When the control means 8 determines that the branch road flag F is 1 (step S11: YES), that is, the host vehicle MC may have entered the branch road B, and the right lane Lr is no longer the block line BL. (Step S12: NO), based on the detection results of the lane detection means 2 and the length width detection means 3, it is determined whether or not the left and right lanes Ll and Lr of the host vehicle are both solid lines (Step S16).

図14に示すように、自車両MCが分岐路Bからランプ路R(高速道路からの流出路)に進入すると、自車両MCの左右の車線Ll、Lrがともに実線になる。そのため、制御手段8は、分岐路フラグFが1の状態で右車線Lrがブロック線BLではなくなり自車両の左右の車線Ll、Lrがともに実線になったと判断すると(図10のステップS16:YES)、自車両MCがランプ路Rに進入した可能性が高いとして分岐路フラグFを2にセットする(ステップS17)。   As shown in FIG. 14, when the host vehicle MC enters the ramp road R (outflow road from the expressway) from the branch road B, the left and right lanes Ll and Lr of the host vehicle MC are both solid lines. Therefore, when the control means 8 determines that the right lane Lr is not the block line BL and the left and right lanes Ll and Lr of the host vehicle are both solid lines with the branch road flag F being 1 (step S16 in FIG. 10: YES) ) Since the vehicle MC is likely to have entered the ramp road R, the branch road flag F is set to 2 (step S17).

そして、制御手段8は、分岐路フラグFが2の場合(ステップS18:YES)、道路の曲率が予め設定された閾値以上か否かを判断するようになっている(ステップS19)。これは、本実施形態では、道路の曲率が大きい場合に自動的に自車両のアクセルスロットルやブレーキ機構等を自動制御して最適な減速を行うカーブ抑制機構が自車両に備えられていることから、ランプ路等の曲率が大きい場合には本発明による制御を解除して上記の機構による自動制御を行わせるための判断である。   And when the branch road flag F is 2 (step S18: YES), the control means 8 judges whether the curvature of a road is more than the preset threshold value (step S19). This is because, in this embodiment, when the curvature of the road is large, the own vehicle is equipped with a curve suppression mechanism that automatically controls the accelerator throttle, brake mechanism, etc. of the own vehicle to perform optimum deceleration. When the curvature of the ramp path or the like is large, it is a judgment for canceling the control according to the present invention and performing the automatic control by the above mechanism.

そのため、制御手段8は、道路の曲率が予め設定された閾値以上であると判断した場合には(ステップS19:YES)、分岐路フラグFをリセットするようになっている(ステップS20)。なお、道路の曲率は、車線検出手段2により検出された左右の車線Ll、Lrに基づいて算出してもよく、また、本実施形態では先行車両検出手段7が前記(4)式や(5)、(6)式に基づいて算出する自車両の旋回曲率Cuaに基づいて決定してもよい。   Therefore, when it is determined that the curvature of the road is equal to or greater than a preset threshold value (step S19: YES), the control means 8 resets the branch road flag F (step S20). The curvature of the road may be calculated based on the left and right lanes Ll and Lr detected by the lane detection means 2, and in the present embodiment, the preceding vehicle detection means 7 uses the above formula (4) and (5 ) And (6) may be determined based on the turning curvature Cua of the vehicle.

制御手段8は、さらに、自車両MCの左右の車線Ll、Lrのうちの一方或いは両方が検出されなくなると(ステップS21:YES)、図15に示すように自車両MCがランプ路Rを抜けてパーキングエリアPや料金所、或いはインターチェンジの出口に到達した可能性が高いとして、分岐路フラグFを3にセットするようになっている(図10のステップS22)。   Further, when one or both of the left and right lanes Ll and Lr of the host vehicle MC are not detected (step S21: YES), the control means 8 causes the host vehicle MC to exit the ramp road R as shown in FIG. Therefore, the branch flag F is set to 3 (step S22 in FIG. 10), assuming that there is a high possibility that the vehicle has reached the parking area P, the toll gate, or the interchange exit.

制御手段8は、以上のようにして分岐路フラグFの設定を終えると、続いて、分岐路フラグFの値に応じてACC装置A(図1参照)に対して各種の制御を行わせるための信号を出力するようになっている。   When the control unit 8 finishes setting the branch path flag F as described above, the control unit 8 subsequently causes the ACC device A (see FIG. 1) to perform various controls according to the value of the branch path flag F. The signal is output.

まず、分岐路フラグFが0(ステップS23、S25、S27:NO)の場合は、図7に示したように自車両MCが通常の走行レーンを走行している場合であるから、制御手段8はACC装置Aを通常通りに作動させる。そのため、上記の処理のうち、分岐路フラグFが1の状態で登坂路カウンタScountのカウント数が予め設定された閾値Sthを超えると(図10のステップS14:YES)、分岐路フラグFが0にリセットされるため(ステップS15)、後述するように登坂路に進入した段階で自車両の加速が禁止される制御が行われても、登坂路カウンタScountのカウント数が閾値Sthを超えた段階でその制御
が解除され、ACC装置Aの動作が通常の動作に復帰する。
First, when the branch road flag F is 0 (steps S23, S25, S27: NO), as shown in FIG. 7, it is a case where the host vehicle MC is traveling in a normal travel lane, and therefore, the control means 8 Activates the ACC device A as usual. Therefore, in the above processing, when the count of the uphill road counter Scount exceeds the preset threshold value Sth with the branch road flag F being 1 (step S14 in FIG. 10: YES), the branch road flag F is 0. (Step S15), so that the count of the uphill road counter Scount exceeds the threshold value Sth even if the control of prohibiting the acceleration of the host vehicle is performed when entering the uphill road as described later. Then, the control is released, and the operation of the ACC device A returns to the normal operation.

また、分岐路フラグFが2の状態で道路の曲率が予め設定された閾値以上になると(ステップS19:YES)、分岐路フラグFが0にリセットされるため(ステップS20)、後述するように自車両MCがランプ路に進入して減速する制御が行われても、道路の曲率が閾値以上になった段階でその制御が解除され、前述したようにカーブ抑制機構が機能するとともに、ACC装置Aの動作が通常の動作に復帰する。   When the road curvature is equal to or greater than a preset threshold value when the branch road flag F is 2 (step S19: YES), the branch road flag F is reset to 0 (step S20). Even if the vehicle MC enters the ramp road and is controlled to decelerate, the control is canceled when the road curvature exceeds a threshold value, and the curve suppression mechanism functions as described above, and the ACC device. The operation of A returns to the normal operation.

分岐路フラグFが1の場合(図11のステップS23:YES)、すなわち、自車両MCが分岐路Bに進入すると判定された場合、制御手段8は、自車両の加速を禁止する信号をACC装置Aに出力するようになっている(ステップS24)。自車両の加速を禁止する信号とは、具体的には、例えばアクセルオフを命令する信号であり、これによりACC装置Aはドライバによりアクセルスロットルが踏み込まれても、自車両MCの加速を行わないようになる。   When the branch road flag F is 1 (step S23 in FIG. 11: YES), that is, when it is determined that the host vehicle MC enters the branch path B, the control means 8 gives a signal for prohibiting acceleration of the host vehicle ACC. The data is output to the device A (step S24). Specifically, the signal for prohibiting acceleration of the host vehicle is, for example, a signal for instructing to turn off the accelerator, whereby the ACC device A does not accelerate the host vehicle MC even when the accelerator throttle is depressed by the driver. It becomes like this.

分岐路フラグFが2の場合(ステップS25:YES)、すなわち、自車両の左右の車線Ll、Lrがともに実線になり自車両MCが分岐路Bからランプ路Rに進入したと判断された段階で、制御手段8は、自車両を減速させる旨の信号をACC装置Aに出力するようになっている(ステップS26)。自車両を減速させる旨の信号とは、具体的には、例えばACC装置Aに予め設定された減速度で自車両が減速されるように指示する信号であり、これによりACC装置Aはその減速度で自車両が減速されるようにブレーキ機構を自動的に操作する。   When the branch road flag F is 2 (step S25: YES), that is, when it is determined that the left and right lanes Ll and Lr of the vehicle are both solid lines and the vehicle MC has entered the ramp road R from the branch road B. Thus, the control means 8 outputs a signal for decelerating the host vehicle to the ACC device A (step S26). Specifically, the signal indicating that the host vehicle is decelerated is, for example, a signal that instructs the ACC device A to decelerate the host vehicle at a preset deceleration. The brake mechanism is automatically operated so that the host vehicle is decelerated at a speed.

なお、制御手段8がACC装置Aに対して自車両を減速させる旨の信号の出力を開始した後、所定の時間が経過したり、自車両が所定の距離走行したり、自車両の車速が所定の速度未満になっても分岐路フラグFが2の状態が続く場合には、自車両はすでに十分に減速されているから、自車両を減速させる旨の信号の出力を解除するように構成することも可能である。   In addition, after the control means 8 starts outputting a signal indicating that the host vehicle is decelerated to the ACC device A, a predetermined time elapses, the host vehicle travels a predetermined distance, or the vehicle speed of the host vehicle is If the branch flag F continues to be 2 even when the speed is less than the predetermined speed, the vehicle is already sufficiently decelerated, so that the output of a signal to decelerate the vehicle is canceled. It is also possible to do.

分岐路フラグFが3の場合(ステップS27:YES)、すなわち、自車両の左右の車線Ll、Lrのうちの一方或いは両方が検出されなくなり、自車両MCがランプ路Rを抜けてパーキングエリアや料金所、或いはインターチェンジの出口に到達したと判断された段階で、制御手段8は、ACC装置AにACC制御を解除させる旨の信号を出力し(ステップS28)、分岐路フラグFを0にリセットする(ステップS29)。   When the branch road flag F is 3 (step S27: YES), that is, one or both of the left and right lanes Ll and Lr of the own vehicle are not detected, and the own vehicle MC passes through the ramp road R to enter the parking area or When it is determined that the toll gate or the exit of the interchange has been reached, the control means 8 outputs a signal to the ACC device A to cancel the ACC control (step S28), and resets the branch path flag F to 0. (Step S29).

これにより、分岐路フラグFが2の段階でACC装置Aに出力されていた自車両を減速させる旨の信号は解除され、ACC装置AによるACC制御がすべて解除される。パーキングエリアや料金所等では自車両の定速走行制御を行うよりも、先行車両等に衝突しないようにドライバが自ら適切に操縦した方がよいためである。   As a result, the signal for decelerating the host vehicle that has been output to the ACC device A when the branch path flag F is 2 is released, and all the ACC control by the ACC device A is released. This is because, in a parking area, a toll booth, and the like, it is better for the driver to appropriately handle the vehicle so as not to collide with the preceding vehicle or the like, rather than performing constant speed traveling control of the own vehicle.

なお、本実施形態では、高速道路の最も左側の走行レーンを走行中の自車両が、道路左側の分岐路に進入し、ランプ路に進入してパーキングエリアや料金所、或いはインターチェンジの出口に到達する場合について説明したが、この場合に限定されない。首都高速道路等の自動車専用道路や一般道でも同様にして制御を行うことができる。   In this embodiment, the host vehicle traveling on the leftmost lane of the expressway enters the branch road on the left side of the road, enters the ramp, and reaches the parking area, toll gate, or interchange exit. However, the present invention is not limited to this case. The same control can be performed on a motorway or general road such as the Metropolitan Expressway.

また、自動車専用道路等では道路の右側に分岐路が設けられている場合があるが、そのような場合には、自車両の左側の車線Llだけでなく、自車両の右側の車線Lrについても実線からブロック線に変化したことを検出するように構成することで分岐路を検出することができる。   In addition, there is a case where a branch road is provided on the right side of a road on an automobile exclusive road or the like. In such a case, not only the left lane Ll of the own vehicle but also the lane Lr on the right side of the own vehicle. A branch path can be detected by detecting a change from a solid line to a block line.

さらに、本実施形態では、ACC装置によりACC制御が行われていることを前提にして説明したが、ACC制御が行われていない場合でも、上記と同様に分岐路を検出し、自車両が分岐路に進入した場合には自車両の加速を禁止し、ランプ路に進入した場合には自車両を減速させる等の制御を行うことが可能である。   Furthermore, although this embodiment has been described on the assumption that the ACC control is performed by the ACC device, even when the ACC control is not performed, the branch path is detected in the same manner as described above, and the host vehicle branches. It is possible to perform control such as prohibiting acceleration of the host vehicle when entering the road, and decelerating the host vehicle when entering the ramp road.

以上のように、本実施形態に係る分岐路進入判定装置1によれば、自車両の左右の車線の長さや幅を検出し、実線であった一方の車線がブロック線に変化した場合に、変化した車線の側に分岐路が存在することを検出することで、分岐路が存在することを的確に検出することが可能となる。   As described above, according to the branch road entry determination device 1 according to the present embodiment, the length and width of the left and right lanes of the host vehicle are detected, and when one lane that is a solid line changes to a block line, By detecting the presence of a branch road on the changed lane side, it is possible to accurately detect the presence of a branch road.

また、分岐路が存在することを的確に検出したうえで、自車両が分岐路に向かって移動したり分岐路方向にウィンカ操作が行われた場合に自車両が分岐路に進入すると判定することで、自車両が分岐路に進入するか否かを的確に判定することが可能となる。   In addition, after accurately detecting the existence of a branch road, it is determined that the host vehicle enters the branch road when the host vehicle moves toward the branch road or the winker operation is performed in the direction of the branch road. Thus, it is possible to accurately determine whether or not the own vehicle enters the branch road.

さらに、上記のように分岐路を的確に検出し、分岐路への進入を的確に判定することができるため、自車両の加速を適切に禁止したり、ランプ路等では自車両を適切に減速させたりすることが可能となり、自車両を安定的に走行させることが可能となり、自車両の走行の安全性を向上させることが可能となる。   In addition, as described above, it is possible to accurately detect the branch road and accurately determine the approach to the branch road, so that the acceleration of the host vehicle is appropriately prohibited or the host vehicle is appropriately decelerated on the ramp road or the like. It becomes possible to make the host vehicle run stably, and it becomes possible to improve the safety of running of the host vehicle.

なお、本実施形態のように分岐路進入判定装置1が先行車両検出手段7を備える場合、ACC装置Aは、制御手段8から送信されてくる先行車両の速度や自車両との距離の情報に基づいて先行車両に対する追従走行制御を自動的に行う。その際、制御手段8から自車両の加速を禁止する信号や自車両を減速させる旨の信号が送信されてくると、ACC装置Aには、自車両の減速度を決定する基準として、それらの信号に基づくものと、先行車両の速度や自車両との距離の情報に基づくものとの2種類の基準が生じることとなる。   In addition, when the branch path approach determination device 1 includes the preceding vehicle detection unit 7 as in the present embodiment, the ACC device A includes information on the speed of the preceding vehicle and the distance from the host vehicle transmitted from the control unit 8. Based on this, the follow-up traveling control for the preceding vehicle is automatically performed. At that time, when a signal for prohibiting acceleration of the host vehicle or a signal for decelerating the host vehicle is transmitted from the control means 8, the ACC device A receives these signals as a reference for determining the deceleration of the host vehicle. Two types of criteria are generated: one based on the signal and one based on information on the speed of the preceding vehicle and the distance from the host vehicle.

このような場合、両者の減速度を比較して、その絶対値が大きい方、すなわち強く減速しなければならない方の減速度を優先して制御を行うように構成することが可能である。このように構成すれば、先行車両に追突する等の事態が生じることを防止することが可能となる。   In such a case, it is possible to compare the decelerations of the two, and to perform control with priority given to the deceleration having the larger absolute value, that is, the one that must be strongly decelerated. If comprised in this way, it will become possible to prevent the situation of colliding with a preceding vehicle.

また、先行車両が検出されている場合には、本実施形態の制御を行わずにACC装置AによるACC制御を行わせ、先行車両に対する追従走行制御を行わせるように構成することも可能である。このように構成すれば、先行車両に追突する等の事態が生じることを適切に防止することが可能となる。   Further, when the preceding vehicle is detected, it is possible to perform the ACC control by the ACC device A without performing the control of the present embodiment, and to perform the follow-up traveling control for the preceding vehicle. . If comprised in this way, it will become possible to prevent appropriately the situation of colliding with a preceding vehicle.

さらに、自車両のドライバにより分岐路方向とは反対方向にウィンカ操作が行われた場合には、ACC装置AによるACC制御、特に自車両の定速走行制御に復帰させるように構成することも可能である。このように構成すれば、ドライバが誤って自車両を分岐路に進入させた場合や登坂路から通常の走行レーンに復帰する場合などに自車両の加速禁止等の制御を適切に解除して、ACC制御に適切に復帰させることが可能となる。   Further, when the driver of the own vehicle performs a winker operation in the direction opposite to the branch road direction, it is possible to return to the ACC control by the ACC device A, particularly the constant speed traveling control of the own vehicle. It is. If configured in this way, when the driver accidentally enters his / her vehicle on a branch road or when returning to the normal driving lane from an uphill road, the control such as prohibition of acceleration of the own vehicle is properly canceled, It is possible to appropriately return to the ACC control.

1 分岐路進入判定装置
2 車線検出手段
21 撮像手段
3 長さ幅検出手段
4 走行区分判定手段
5 分岐路検出手段
6 分岐路進入判定手段
7 先行車両検出手段
B 分岐路
BL 所定の長さおよび所定の幅の破線(ブロック線)
Lcount 左側レーン走行中カウンタ(履歴を保持する手段)
Ll 左側の車線(左車線)
Lr 右側の車線(右車線)
MC 自車両
O2 先行車両
DESCRIPTION OF SYMBOLS 1 Branch road approach determination apparatus 2 Lane detection means 21 Imaging means 3 Length width detection means 4 Travel division determination means 5 Branch path detection means 6 Branch path entry determination means 7 Predecessor vehicle detection means B Branch road BL Predetermined length and predetermined Dashed line (block line)
Lcount Left lane running counter (means to keep history)
Ll Left lane (left lane)
Lr Right lane (right lane)
MC own vehicle O2 preceding vehicle

Claims (3)

自車両の左側および右側の車線を検出する車線検出手段と、
前記車線検出手段により検出された車線の自車両の進行方向の実空間上の長さと幅とを検出する長さ幅検出手段と、
前記長さ幅検出手段による検出結果に基づいて前記車線の線種を判定するとともに自車両が走行している走行レーンの区分を判定する走行区分判定手段と、
前記長さ幅検出手段による検出結果に基づいて実線であった車線が、所定の長さおよび所定の幅の破線に変化した場合に、変化した車線の側に分岐路が存在することを検出する分岐路検出手段と、
前記分岐路検出手段が前記分岐路を検出している間に、自車両が前記分岐路に向かう移動、または前記分岐路方向にウィンカ操作が行われた場合に、自車両が前記分岐路に進入すると判定する分岐路進入判定手段と、を備え、
前記分岐路進入判定手段により自車両が前記分岐路に進入すると判定されると、自車両の加速を禁止する信号を出力し、
前記分岐路進入判定手段により自車両が前記分岐路に進入すると判定された後、所定の時間が経過する間または所定の距離を走行する間、前記長さ幅検出手段により自車両の左側または右側の車線が前記所定の長さおよび所定の幅の破線である場合、前記自車両の加速を禁止する信号の出力を解除することを特徴とする分岐路進入判定装置。
Lane detection means for detecting the left and right lanes of the host vehicle;
A length / width detection means for detecting the length and width of the lane detected by the lane detection means in real space in the traveling direction of the host vehicle;
A travel segment determination unit that determines a line type of the lane based on a detection result by the length width detection unit and determines a segment of a travel lane in which the host vehicle is traveling;
When a lane that is a solid line is changed to a broken line having a predetermined length and a predetermined width based on a detection result by the length / width detection means, it is detected that a branch road exists on the changed lane side. A branch path detection means;
While the branch road detection means is detecting the branch road, if the host vehicle moves toward the branch road or if a winker operation is performed in the direction of the branch road, the own vehicle enters the branch road. A branch path entry judging means for judging,
When it is determined by the branch path entry determining means that the host vehicle enters the branch path, a signal for prohibiting acceleration of the host vehicle is output,
After the vehicle is determined to enter the branch road by the branch road entry determination means, the left or right side of the vehicle is left or right by the length width detection means while a predetermined time elapses or travels a predetermined distance. When the lane is a broken line having a predetermined length and a predetermined width, an output of a signal prohibiting acceleration of the host vehicle is canceled.
前記信号の出力の解除とともに、自車両の定速走行制御に復帰させる旨の信号を出力することを特徴とする請求項1に記載の分岐路進入判定装置。   The branch path entry determination device according to claim 1, wherein a signal indicating that the vehicle is returned to constant speed traveling control is output together with the cancellation of the output of the signal. 先行車両を検出する先行車両検出手段を備え、
前記先行車両検出手段により検出された前記先行車両が検出されている場合には、前記先行車両に対する追従走行制御を行う旨の信号を出力することを特徴とする請求項1又は請求項2に記載の分岐路進入判定装置。
A preceding vehicle detection means for detecting the preceding vehicle;
3. The signal according to claim 1, wherein when the preceding vehicle detected by the preceding vehicle detection unit is detected, a signal indicating that the following traveling control is performed on the preceding vehicle is output. Branch road entry judgment device.
JP2012000043A 2012-01-04 2012-01-04 Branch entry judgment device Active JP5202741B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012000043A JP5202741B2 (en) 2012-01-04 2012-01-04 Branch entry judgment device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012000043A JP5202741B2 (en) 2012-01-04 2012-01-04 Branch entry judgment device

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2007165448A Division JP4933962B2 (en) 2007-06-22 2007-06-22 Branch entry judgment device

Publications (2)

Publication Number Publication Date
JP2012106735A true JP2012106735A (en) 2012-06-07
JP5202741B2 JP5202741B2 (en) 2013-06-05

Family

ID=46492835

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012000043A Active JP5202741B2 (en) 2012-01-04 2012-01-04 Branch entry judgment device

Country Status (1)

Country Link
JP (1) JP5202741B2 (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101509995B1 (en) 2013-12-03 2015-04-07 현대자동차주식회사 Junction entry determining apparatus and method thereof
JP2017049146A (en) * 2015-09-02 2017-03-09 富士重工業株式会社 Image processing device
JP2017052413A (en) * 2015-09-09 2017-03-16 株式会社デンソー Vehicle control device
JP2018075900A (en) * 2016-11-08 2018-05-17 本田技研工業株式会社 Vehicle control apparatus, vehicle control method and vehicle control program
US10002433B2 (en) 2012-12-26 2018-06-19 Nippon Soken, Inc. Boundary line recognition apparatus and branch road determination apparatus
US20180354527A1 (en) * 2017-06-09 2018-12-13 Subaru Corporation Vehicle control device
CN109263660A (en) * 2018-11-12 2019-01-25 江铃汽车股份有限公司 A kind of lane shift pre-warning and control method for looking around image system based on 360 °
CN110550027A (en) * 2018-06-04 2019-12-10 本田技研工业株式会社 vehicle control device, vehicle control method, and recording medium

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004341941A (en) * 2003-05-16 2004-12-02 Denso Corp Traveling lane estimation device, branch lane entry estimation device, vehicle speed control device, and program
JP2007003286A (en) * 2005-06-22 2007-01-11 Nissan Motor Co Ltd Detection system of own vehicle position, navigation system, reduction control system, and detection method of own vehicle position
JP2008139104A (en) * 2006-11-30 2008-06-19 Toyota Motor Corp Device for detecting vehicle exit

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004341941A (en) * 2003-05-16 2004-12-02 Denso Corp Traveling lane estimation device, branch lane entry estimation device, vehicle speed control device, and program
JP2007003286A (en) * 2005-06-22 2007-01-11 Nissan Motor Co Ltd Detection system of own vehicle position, navigation system, reduction control system, and detection method of own vehicle position
JP2008139104A (en) * 2006-11-30 2008-06-19 Toyota Motor Corp Device for detecting vehicle exit

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10002433B2 (en) 2012-12-26 2018-06-19 Nippon Soken, Inc. Boundary line recognition apparatus and branch road determination apparatus
US10891738B2 (en) 2012-12-26 2021-01-12 Nippon Soken, Inc. Boundary line recognition apparatus and branch road determination apparatus
US9792506B2 (en) 2013-12-03 2017-10-17 Hyundai Motor Company Lane change determining apparatus, junction entry determining apparatus and method thereof
KR101509995B1 (en) 2013-12-03 2015-04-07 현대자동차주식회사 Junction entry determining apparatus and method thereof
JP2017049146A (en) * 2015-09-02 2017-03-09 富士重工業株式会社 Image processing device
JP2017052413A (en) * 2015-09-09 2017-03-16 株式会社デンソー Vehicle control device
US10363931B2 (en) 2016-11-08 2019-07-30 Honda Motor Co., Ltd. Vehicle control device, vehicle control method and vehicle control program
JP2018075900A (en) * 2016-11-08 2018-05-17 本田技研工業株式会社 Vehicle control apparatus, vehicle control method and vehicle control program
US20180354527A1 (en) * 2017-06-09 2018-12-13 Subaru Corporation Vehicle control device
US11608071B2 (en) * 2017-06-09 2023-03-21 Subaru Corporation Vehicle control device
CN110550027A (en) * 2018-06-04 2019-12-10 本田技研工业株式会社 vehicle control device, vehicle control method, and recording medium
CN110550027B (en) * 2018-06-04 2022-08-02 本田技研工业株式会社 Vehicle control device, vehicle control method, and recording medium
CN109263660A (en) * 2018-11-12 2019-01-25 江铃汽车股份有限公司 A kind of lane shift pre-warning and control method for looking around image system based on 360 °

Also Published As

Publication number Publication date
JP5202741B2 (en) 2013-06-05

Similar Documents

Publication Publication Date Title
JP4933962B2 (en) Branch entry judgment device
JP5202741B2 (en) Branch entry judgment device
US10000208B2 (en) Vehicle control apparatus
EP3366540B1 (en) Information processing apparatus and non-transitory computer-readable recording medium
EP3086990B1 (en) Method and system for driver assistance for a vehicle
JP6337435B2 (en) Driving assistance device
JP6536554B2 (en) Winker determination device and automatic driving system
JP6654923B2 (en) Map information output device
US11390275B2 (en) Vehicle control device, vehicle control method, and program
KR20110132437A (en) Method for automatically detecting a driving maneuver of a motor vehicle and a driver assistance system comprising said method
JP2018039303A (en) Vehicle control device
JP2019159756A (en) Vehicle control device and computer program
US11180141B2 (en) Vehicle control system
JP2015203972A (en) Driving route generation device
EP3912877B1 (en) Driving assistance method and driving assistance device
JP2019148908A (en) Vehicle control device
JP2009166559A (en) Vehicle outside monitor
JP7334107B2 (en) Vehicle control method and vehicle control device
JP2018090123A (en) Vehicle control device
JP2020126403A (en) Driving characteristic estimation method and driving characteristic estimation device
JP2013184491A (en) Vehicle traveling support device
JP2019172032A (en) Automatic braking device
JP2013184498A (en) Vehicle traveling support apparatus
CN112193246B (en) Vehicle and method for performing inter-vehicle distance control
JP6331234B2 (en) Vehicle control device

Legal Events

Date Code Title Description
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: 20130129

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130212

R150 Certificate of patent or registration of utility model

Ref document number: 5202741

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20160222

Year of fee payment: 3

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

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