JPH07319541A - Traveling course estimating device for automobile - Google Patents
Traveling course estimating device for automobileInfo
- Publication number
- JPH07319541A JPH07319541A JP6106428A JP10642894A JPH07319541A JP H07319541 A JPH07319541 A JP H07319541A JP 6106428 A JP6106428 A JP 6106428A JP 10642894 A JP10642894 A JP 10642894A JP H07319541 A JPH07319541 A JP H07319541A
- Authority
- JP
- Japan
- Prior art keywords
- traveling
- vehicle
- estimated
- white line
- estimating
- 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
Links
- 238000001514 detection method Methods 0.000 claims description 27
- 238000012937 correction Methods 0.000 claims description 22
- 238000012545 processing Methods 0.000 claims description 22
- 230000033001 locomotion Effects 0.000 claims description 10
- 238000000034 method Methods 0.000 description 47
- 238000010586 diagram Methods 0.000 description 16
- 238000012544 monitoring process Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
Landscapes
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
Description
【0001】[0001]
【産業上の利用分野】本発明は、複数の走行路推定手段
を有する自動車の走行路推定装置に関するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a vehicle traveling path estimating device having a plurality of traveling path estimating means.
【0002】[0002]
【従来の技術】従来、自車の操舵角や車速等の走行状態
から自車が今後走行すると予測される走行路を推定する
走行路推定手段を備え、レーダ装置の広範囲の走査で得
られる情報の中から、上記走行路推定手段で予測される
走行路に沿った領域内のもののみをピックアップし、自
車と障害物とが接触する可能性を判断するものが知られ
ている。2. Description of the Related Art Conventionally, information obtained by scanning a wide range of a radar device is provided with a traveling road estimating means for estimating a traveling road on which the own vehicle is predicted to travel from the traveling state such as the steering angle of the own vehicle and the vehicle speed. Among them, there is known one that picks up only the one in the region along the traveling road predicted by the traveling road estimating means and judges the possibility that the own vehicle and the obstacle come into contact with each other.
【0003】そのような走行路を推定する走行路推定手
段としては、舵角、車速、コーレート等の車体状態量に
より走行路を推定するもの(例えば特公昭51−789
2号公報参照)、画像処理装置を用いて画像処理により
走行路を推定するもの(例えば特開平2−120910
号公報参照)が知られている。As a traveling road estimating means for estimating such a traveling road, one for estimating the traveling road based on vehicle body state quantities such as a steering angle, a vehicle speed and a corrate (for example, JP-B-51-789).
Japanese Patent Laid-Open No. 2-120910, which estimates a traveling path by image processing using an image processing device.
(See Japanese Patent Publication).
【0004】そして、画像処理によるものでは、通常、
道路の左右両端に引かれた白線部を検出し、走行路端を
認識することになるので、推定できる走行路の範囲が広
く車両状態量によるものよりも、走行路を推定する上で
有利である。In the case of image processing, usually,
Since the white line parts drawn at the left and right ends of the road are detected and the road edge is recognized, the range of the road that can be estimated is wide and it is more advantageous in estimating the road than by the vehicle state quantity. is there.
【0005】[0005]
【発明が解決しようとする課題】しかしながら、そのよ
うな画像処理によるものを用いる場合には、道路上の白
線部の状態が著しく悪い場合や、もともと白線がない場
合もある。それに加えて、白線部は左右にあることか
ら、各々の推定段階でのエラーや実際の道路形状、車両
の挙動等により、左右の白線部についての各推定結果が
必ずしも一致しない状況が存在する。However, when such an image processing is used, the condition of the white line part on the road may be remarkably bad, or there may be no white line originally. In addition, since the white line parts are on the left and right, there are situations where the estimation results for the left and right white line parts do not necessarily match, due to errors at each estimation stage, actual road shape, vehicle behavior, and the like.
【0006】また、前述したように、道路上の白線状態
が著しく悪い場合やもともと白線部がない場合のバック
アップとして、画像処理による走行路推定手段に対し
て、推定方法の異なる他の走行路推定手段(例えば車両
状態量による走行路推定手段)を併用することも考えら
れるが、そのように推定方法の異なる複数の走行路推定
手段を用いて走行路を推定する場合にも、やはり各推定
結果が一致しない情況が存在する。Further, as described above, as a backup in the case where the state of the white line on the road is extremely bad or when there is no white line portion originally, as a backup, the running road estimation means based on image processing is used to estimate another running road with a different estimation method. It is conceivable to use a means (for example, a traveling road estimation means based on the vehicle state quantity) in combination, but even when a traveling road is estimated by using a plurality of traveling road estimation means having different estimation methods, each estimation result is still obtained. There are situations where the two do not match.
【0007】本発明はかかる点に鑑みてなされたもの
で、複数の走行路推定手段を有する場合に、各推定手段
による推定値が異なる場合であっても、精度よく走行路
を推定することができる自動車の走行路推定装置を提供
せんとするものである。The present invention has been made in view of the above points, and in the case of having a plurality of traveling road estimating means, it is possible to accurately estimate a traveling road even if the estimated values by the respective estimating means are different. The present invention is intended to provide a vehicle travel path estimation device.
【0008】[0008]
【課題を解決するための手段】請求項1に係る発明は、
自車の今後の走行路を推定する複数の走行路推定手段と
を備える自動車の走行路推定装置を前提とし、上記各走
行路推定手段により推定された走行路の信頼度を演算す
る信頼度演算手段と、該信頼度演算手段の出力を受け、
走行路の信頼度の値相互の差がしきい値を越えるとき、
上記各走行路推定手段により推定された走行路を比較
し、多数決により走行路を最終的に選定し、走行領域を
推定する走行領域推定手段を備える構成とする。The invention according to claim 1 is
A reliability calculation for calculating the reliability of the traveling road estimated by each traveling road estimating means on the premise of a traveling road estimating device for a vehicle including a plurality of traveling road estimating means for estimating a future traveling road of the own vehicle. Means and the output of the reliability calculation means,
When the difference between the road reliability values exceeds the threshold value,
The traveling paths estimated by the traveling path estimating means are compared with each other, the traveling path is finally selected by majority decision, and the traveling area estimating means for estimating the traveling area is provided.
【0009】請求項2に係る発明においては、走行路推
定手段は、車両状態量に基づき自車が今後走行すると予
想される第1の進行路を走行路として推定する第1走行
路推定手段と、画像処理に基づき、路面上の白線部を構
成すると想定される白線候補点を検出し、該白線候補点
に基づき白線部を推定し、自車が今後走行すると予想さ
れる走行路を推定する第2走行路推定手段とを備える。In the invention according to claim 2, the traveling road estimating means is a first traveling road estimating means for estimating a first traveling road, which is expected to travel the vehicle in the future, as a traveling road based on the vehicle state quantity. , The white line candidate points that are supposed to form the white line portion on the road surface are detected based on the image processing, the white line portion is estimated based on the white line candidate points, and the traveling road where the own vehicle is expected to travel in the future is estimated. A second traveling path estimating means.
【0010】請求項3に係る発明においては、さらに、
自車速、相対速度、路面の摩擦係数等に基づき障害物判
断距離を演算する距離演算手段と、該距離演算手段の出
力を受け、障害物判断距離を越える領域においては、走
行領域推定手段による走行領域の推定に際し、第1走行
路推定手段による推定を優先させる領域補正手段を備え
る。In the invention according to claim 3, further,
Distance calculation means for calculating an obstacle judgment distance based on the own vehicle speed, relative speed, road friction coefficient, etc., and, in the area exceeding the obstacle judgment distance upon receipt of the output of the distance calculation means, travel by the traveling area estimation means When estimating the area, an area correction unit is provided that prioritizes the estimation by the first traveling road estimation unit.
【0011】請求項4に係る発明においては、さらに、
第2走行路推定手段による白線候補点の検出可能距離を
演算する距離演算手段と、該距離演算手段の出力を受
け、白線候補点の検出可能距離を越える領域において
は、走行領域推定手段による走行領域の推定に際し、第
1走行路推定手段による推定を優先させる領域補正手段
とを備える。In the invention according to claim 4, further,
The distance calculating means for calculating the detectable distance of the white line candidate point by the second traveling path estimating means, and the area which exceeds the detectable distance of the white line candidate point upon receiving the output of the distance calculating means, travels by the traveling area estimating means. Area estimation means for prioritizing the estimation by the first traveling path estimation means when estimating the area.
【0012】請求項5に係る発明においては、走行領域
推定手段は、推定された走行路に対し、検知率、検知時
間の係数により重み付けを行って、走行路を最終的に決
定し、走行領域を推定するものである。In the invention according to claim 5, the traveling area estimating means weights the estimated traveling path with a coefficient of a detection rate and a coefficient of a detection time to finally determine the traveling path, and the traveling area is determined. Is estimated.
【0013】請求項6に係る発明においては、自車前方
の環境を検出する環境検出手段を備え、走行領域推定手
段が、環境検出手段の出力を受け、該環境を考慮して走
行路を選定し、走行領域を推定するものである。According to a sixth aspect of the present invention, an environment detecting means for detecting the environment in front of the vehicle is provided, and the traveling area estimating means receives the output of the environment detecting means and selects the traveling path in consideration of the environment. However, the travel area is estimated.
【0014】請求項7に係る発明においては、車両前方
の障害物を検出する障害物検出手段を備え、走行領域推
定手段が、障害物検出手段の出力を受け、障害物の大き
さ及び動きに基づいて、第1走行路推定手段による推定
又は第2走行路推定手段による推定のいずれを優先する
かを決定するものである。According to the seventh aspect of the invention, an obstacle detecting means for detecting an obstacle in front of the vehicle is provided, and the traveling area estimating means receives the output of the obstacle detecting means and determines the size and movement of the obstacle. Based on this, it is determined which of the estimation by the first traveling road estimating means and the estimation by the second traveling road estimating means is prioritized.
【0015】請求項8に係る発明においては、さらに、
自車に先行する車両の車両状態量に基づき第2の進行路
を走行路として推定する第3走行路推定手段とを備え
る。In the invention according to claim 8, further,
And a third traveling road estimating means for estimating the second traveling road as the traveling road based on the vehicle state quantity of the vehicle preceding the own vehicle.
【0016】[0016]
【作用】請求項1に係る発明によれば、各走行路推定手
段により推定された走行路の信頼度が信頼度演算手段に
て演算され、そして走行路の信頼度の値相互の差がしき
い値を越えるとき、走行領域推定手段によって上記各走
行路推定手段により推定された走行路が比較され、多数
決により走行路が最終的に選定される。According to the first aspect of the present invention, the reliability of the traveling road estimated by each traveling road estimating means is calculated by the reliability calculating means, and the difference between the reliability values of the traveling roads is calculated. When the threshold value is exceeded, the travel area estimation means compares the travel paths estimated by the travel path estimation means, and the travel path is finally selected by a majority vote.
【0017】請求項2に係る発明によれば、走行路推定
手段が、画像処理に基づき路面上の白線部を検出し、該
白線部に基づき自車が今後走行すると予想される走行路
を推定するように構成されると共に、左右白線推定手段
を備えており、左白線推定手段によって、左の白線部に
基づいて走行路が推定される一方、右白線推定手段によ
って、右の白線部に基づいて走行路が推定される。According to the second aspect of the present invention, the traveling road estimating means detects the white line portion on the road surface based on the image processing and estimates the traveling road on which the own vehicle is expected to travel in the future based on the white line portion. The left white line estimating means estimates the traveling path based on the left white line portion, while the right white line estimating means determines the right white line portion. And the road is estimated.
【0018】請求項3に係る発明によれば、障害物判断
距離を越える領域では、第1走行路推定手段により推定
された走行路に基づく領域を優先させる領域補正手段を
備える。According to the third aspect of the present invention, the area correction means is provided for prioritizing the area based on the travel path estimated by the first travel path estimation means in the area exceeding the obstacle judgment distance.
【0019】請求項4に係る発明によれば、白線候補点
の検出可能距離を越えると第1走行路推定手段に基づく
領域が優先される。According to the invention of claim 4, when the white line candidate point exceeds the detectable distance, the area based on the first traveling road estimating means is prioritized.
【0020】請求項5に係る発明によれば、推定された
走行路に対し、検知率、検知時間の係数により重み付け
を行って、走行路が最終的に決定され、その走行路に基
づき走行領域が推定される。According to the fifth aspect of the present invention, the estimated traveling path is weighted by the coefficient of the detection rate and the detection time to finally determine the traveling path, and the traveling area is determined based on the traveling path. Is estimated.
【0021】請求項6に係る発明によれば、環境検出手
段によって検出された自車前方の環境を考慮して、走行
路が選定される。According to the sixth aspect of the invention, the traveling path is selected in consideration of the environment in front of the vehicle detected by the environment detecting means.
【0022】請求項7に係る発明によれば、障害物の大
きさ及び動きに基づいて、第1走行路推定手段による推
定又は第2走行路推定手段による推定が選択される。According to the invention of claim 7, the estimation by the first traveling road estimating means or the estimation by the second traveling road estimating means is selected based on the size and the movement of the obstacle.
【0023】請求項8に係る発明によれば、第1及び第
2走行路推定手段による推定に加えて、第3走行路推定
手段による推定も考慮されて、走行路が推定される。According to the eighth aspect of the present invention, the traveling road is estimated in consideration of the estimation by the third traveling road estimating means in addition to the estimation by the first and second traveling road estimating means.
【0024】[0024]
【実施例】以下、本発明の実施例を図面に基づいて説明
する。本例は、本発明に係る自動車の走行路推定装置を
障害物検知装置に適用された例である。Embodiments of the present invention will be described below with reference to the drawings. This example is an example in which the vehicle travel path estimation device according to the present invention is applied to an obstacle detection device.
【0025】自動車の全体を示す図1において、1は自
動車で、その車体2の前部にレーダヘッドユニット3が
設けられている。このレーダヘッドユニット3は、レー
ダ波としてのパルスレーザ光を発信部から自車の前方に
向けて発信すると共に、前方に存在する先行車等の障害
物に当たって反射してくる反射波を受信部で受信する構
成になっており、走行路上の障害物との距離を計測する
ものである。また、レーダヘッドユニット3は、その発
信部から発信する、縦に細く垂直方向に扇状に拡がった
パルスレーザ光(ビーム)を水平方向に比較的広角度で
走査させるスキャン式のものである。In FIG. 1 showing the entire automobile, reference numeral 1 is an automobile, and a radar head unit 3 is provided in front of a vehicle body 2. The radar head unit 3 emits a pulsed laser beam as a radar wave from the transmitting unit toward the front of the own vehicle, and at the receiving unit receives a reflected wave reflected by an obstacle such as a preceding vehicle in front of the vehicle. It is configured to receive, and measures the distance to an obstacle on the road. Further, the radar head unit 3 is of a scanning type which is emitted from its transmitting portion and is made to scan a pulse laser beam (beam) which is thin in the vertical direction and spread in a fan shape in the vertical direction in the horizontal direction at a relatively wide angle.
【0026】4は車室内上部に配設されたCCDカメラ
で、自車前方の情景(走行路)を所定範囲内で写し出す
ものであり、該カメラ4で写し出された自車前方の情景
は、画像処理ユニット5に入力されて画像処理され、コ
ントロールユニット6において道路の左右白線部に基づ
き走行路が推定されるようになっている。Reference numeral 4 denotes a CCD camera arranged in the upper part of the passenger compartment for photographing a scene (running path) in front of the vehicle within a predetermined range. The scene in front of the vehicle photographed by the camera 4 is: The image is input to the image processing unit 5 and subjected to image processing, and the control unit 6 estimates the traveling route based on the left and right white line portions of the road.
【0027】また、コントロールユニット6には、図2
に示すように、上記CCDカメラ4からの信号のほか
に、レーザユニット3からの信号と共に、自車の車速を
検出する車速センサ7、ステアリングハンドル8aの操
舵角を検出する舵角センサ8及び自車が発生するヨーレ
ートを検出するヨーレートセンサ9からの信号も入力さ
れ、それらの信号に基づいて、走行路状態がヘッドアッ
プディスプレイ10に表示され、自車前方の障害物を検
知すると、警報手段11が作動すると共に、車両制御装
置12がブレーキ12aを作動させて各車輪に制動力を
自動的に付与するようになっている。Further, the control unit 6 has a configuration shown in FIG.
As shown in FIG. 7, in addition to the signal from the CCD camera 4, a signal from the laser unit 3 is also detected, a vehicle speed sensor 7 for detecting the vehicle speed of the own vehicle, a steering angle sensor 8 for detecting the steering angle of the steering wheel 8a, and an own vehicle. Signals from a yaw rate sensor 9 that detects the yaw rate generated by the vehicle are also input, and the traveling road condition is displayed on the head-up display 10 based on these signals, and when an obstacle in front of the vehicle is detected, an alarm means 11 is issued. Is activated, the vehicle control device 12 actuates the brake 12a to automatically apply the braking force to each wheel.
【0028】13はヘッドランプの状態(即ちON/O
FF、High/Low)を検出するヘッドランプスイ
ッチである。Reference numeral 13 indicates the state of the headlamp (that is, ON / O).
It is a headlamp switch that detects FF, High / Low).
【0029】具体的には、図3に示すように、このレー
ダヘッドユニット3の信号は、コントロールユニット6
の信号処理部21を通じて演算部22に入力され、該演
算部22において、レーザ受信光の発信時点からの遅れ
時間によって走査範囲内に存在する各障害物と自車との
間の距離、相対速度及び障害物の自車に対する方向を演
算するように構成されている。そして、信号処理部21
及び演算部22により自車前方の所定領域内に存在する
障害物を検出する障害物検出手段6Aが構成されてい
る。Specifically, as shown in FIG. 3, the signal from the radar head unit 3 is transmitted to the control unit 6
Is input to the calculation unit 22 through the signal processing unit 21 of the above, and in the calculation unit 22, the distance and relative speed between each obstacle existing in the scanning range and the own vehicle due to the delay time from the transmission time of the laser reception light. And the direction of the obstacle with respect to the own vehicle is calculated. Then, the signal processing unit 21
The calculating unit 22 constitutes an obstacle detecting means 6A for detecting an obstacle existing in a predetermined area in front of the own vehicle.
【0030】上記センサ7,8の検出信号は第1進行路
推定手段25に入力され、該第1進行路推定手段23
は、自車のステアリング舵角及び車速から自車が今後走
行する予測される進行路を推定するようになっている。
また、上記センサ7,8,9の検出信号は第2進行路推
定手段24に入力され、該第2進行路推定手段24は、
自車のステアリング舵角、車速及びヨーレートから自車
が今後走行する予測される進行路を推定するようになっ
ている。この第1及び第2進行路推定手段23,24
が、車両状態量に基づいて走行路(具体的にはその曲率
半径)を推定する第1走行路推定手段6Bを構成してい
る。The detection signals of the sensors 7 and 8 are input to the first traveling path estimating means 25 and the first traveling path estimating means 23.
Is designed to estimate a predicted traveling route of the vehicle from the future based on the steering angle and the vehicle speed of the vehicle.
Further, the detection signals of the sensors 7, 8 and 9 are input to the second traveling path estimating means 24, and the second traveling path estimating means 24,
From the steering angle of the host vehicle, the vehicle speed, and the yaw rate, it is possible to estimate the predicted traveling path of the host vehicle. The first and second traveling path estimating means 23, 24
, But constitutes the first traveling road estimating means 6B for estimating the traveling road (specifically, its radius of curvature) based on the vehicle state quantity.
【0031】また、画像処理ユニット5からの信号は、
自車前方の情景から自車が走行する道路(走行路)の左
右の白線部を抽出して左右の白線部を推定する左白線推
定手段25及び右白線推定手段26に入力され、それぞ
れ左白線及び右白線(具体的にはそれらの曲率半径)が
推定される。左白線及び右白線推定手段25,26によ
り、画像処理に基づいて走行路を推定する第2走行路推
定手段6Cが構成されている。The signal from the image processing unit 5 is
It is input to the left white line estimating means 25 and the right white line estimating means 26, which extract the left and right white line portions of the road (running road) on which the vehicle is traveling from the scene in front of the own vehicle and estimate the left and right white line portions, and the left white line estimation means 26 respectively. And the right white line (specifically, their radii of curvature) are estimated. The left white line and right white line estimating means 25, 26 constitute second traveling road estimating means 6C for estimating a traveling road based on image processing.
【0032】そして、上記第1及び第2走行路推定手段
6B,6Cからの信号が、信頼度演算手段27と共に走
行領域設定手段28に入力される。信頼度演算手段27
は、後述するように、走行路推定手段6B,6Cにより
推定された走行路(進行路)の信頼度を演算するように
構成されている。領域設定手段28は、走行路の信頼度
に基づいて、進行路及び走行路(左右の白線部)から、
これから自車が進行するであろうを推測される走行領域
(障害物判断領域に対応)を最終的に推定するようにな
っている。Then, the signals from the first and second traveling road estimating means 6B and 6C are input to the traveling area setting means 28 together with the reliability calculating means 27. Reliability calculation means 27
Is configured to calculate the reliability of the traveling road (traveling road) estimated by the traveling road estimating means 6B and 6C, as described later. The area setting means 28 determines, based on the reliability of the traveling road, from the traveling road and the traveling road (the left and right white line portions),
The travel area (corresponding to the obstacle judgment area) in which the own vehicle is supposed to proceed is finally estimated.
【0033】また、上記演算部22からの障害物情報及
び走行領域設定手段28からの障害物判断領域情報が障
害物判定手段29に入力され、該障害物判定手段29に
おいて、レーダヘッドユニット3で検出された障害物の
回避必要度を、走行領域設定手段28によって設定され
た走行領域(障害物判断領域)において障害物判断を行
い、回避の必要があると判断されれば、ヘッドアップデ
ィスプレイ10に表示されると共に、警報装置11によ
り警報が発せられた後、車両制御装置12のブレーキ装
置12aが自動的に作動するようになっている。Further, the obstacle information from the arithmetic unit 22 and the obstacle judging area information from the traveling area setting means 28 are inputted to the obstacle judging means 29, and in the obstacle judging means 29, the radar head unit 3 is used. If the degree of avoidance of the detected obstacle is judged in the traveling area (obstacle judgment area) set by the traveling area setting means 28 and it is judged that the obstacle needs to be avoided, the head-up display 10 is displayed. After the alarm is issued by the alarm device 11, the brake device 12a of the vehicle control device 12 is automatically activated.
【0034】30は領域補正手段で、ヘッドランプスイ
ッチ13よりの信号を受け、ヘッドランプの状態に応じ
て、第2走行路推定手段6Cにより推定する走行領域を
補正するものである。また、具体的に図示していない
が、領域補正手段30は、障害物判断距離、白線候補点
の検出可能距離等に基づいても、第2走行路推定手段6
Cにより推定する走行領域を補正するようになってい
る。Reference numeral 30 denotes an area correcting means for receiving a signal from the headlamp switch 13 and correcting the traveling area estimated by the second traveling path estimating means 6C according to the state of the headlamp. Although not specifically shown, the area correction unit 30 also uses the second traveling road estimation unit 6 based on the obstacle determination distance, the detectable distance of the white line candidate point, and the like.
The travel area estimated by C is corrected.
【0035】(1) 障害物検知装置による障害物検知の基
本制御 以下、上記走行路推定装置が用いられる障害物検知装置
による障害物検知の基本制御について説明する。(1) Basic Control for Obstacle Detection by Obstacle Detection Device Hereinafter, basic control for obstacle detection by the obstacle detection device using the above-mentioned travel path estimation device will be described.
【0036】図4において、スタートすると、先ず、ス
テップS1 で、第1及び第2走行路推定手段6B,6C
により走行路の推定が行われ、それから、ステップS2
で、レーダヘッドユニット3により自車前方を認識し、
障害物と推定されるもの(障害物情報)を検出する。In FIG. 4, when starting, first, in step S1, the first and second traveling path estimating means 6B and 6C are provided.
The road is estimated by the step S2
Then, the front of the vehicle is recognized by the radar head unit 3,
Detect what is presumed to be an obstacle (obstacle information).
【0037】続いて、ステップS3 で、ステップS1 に
おいて推定された走行路から、領域設定手段28によっ
て障害物判断領域となる走行領域が推定される。Then, in step S3, the area setting means 28 estimates the traveling area to be the obstacle judgment area from the traveling path estimated in step S1.
【0038】それから、ステップS4 で上記障害物判断
領域に基づいて障害物情報のマスキングを行い、ステッ
プS5 で障害物判断を行う。上記ステップS3 〜S5 の
実行は、障害物判定手段29で行われる。Then, in step S4, obstacle information is masked based on the obstacle judgment area, and in step S5, obstacle judgment is performed. The obstacle determining means 29 executes the above steps S3 to S5.
【0039】その後、ステップS6 で必要であれば障害
物回避制御を行い、リターンする。障害物回避制御は、
例えば警報装置による警報、車両制御装置12のブレー
キ12aで行われるが、具体的に図示していないが、自
動操舵装置等によって行うようにしてもよい。Then, in step S6, obstacle avoidance control is performed if necessary, and the process returns. Obstacle avoidance control
For example, although the warning is given by the warning device and the brake 12a of the vehicle control device 12, although not specifically shown, it may be given by an automatic steering device or the like.
【0040】(2) ステップS1 での走行路推定 走行路推定に用いる推定値を決定する基本制御 図5に示すように、まず、ステップ11において、逆光判
定、即ち路面輝度に基づき逆光状態であるか否かを判定
する。この判定の結果、逆光状態であれば、路面の輝度
が上昇し、白線部と他の部分との識別が十分にできなく
なるため、第2走行路推定手段6Cによって正確な走行
路推定ができなくなるので、後述するように、第2走行
路推定手段6Cによる推定値Rl ,Rr を採用すること
なく第1走行路推定手段6Bによる推定値R11,R12を
採用することとなる。(2) Traveling Road Estimation in Step S1 Basic Control for Determining Estimated Value Used for Running Road Estimation As shown in FIG. 5, first, in step 11, backlight determination is made, that is, backlighting is performed based on road surface brightness. Or not. As a result of this determination, in the backlight condition, the brightness of the road surface rises, and the white line portion and other portions cannot be sufficiently discriminated from each other. Therefore, the second traveling road estimating means 6C cannot accurately estimate the traveling road. Therefore, as will be described later, the estimated values R11, R12 by the first traveling road estimating means 6B are adopted without using the estimated values Rl, Rr by the second traveling road estimating means 6C.
【0041】逆光状態でなければ、ステップ12で、走行
路推定手段6B,6Cにより走行路についての推定値
(曲率半径)Rl ,Rr ,R11,R12を算出し、それか
ら、CCDカメラ4のピッチ角のエラー判定を行う(ス
テップS13)。この判定の結果、ピッチ角のエラーであ
れば、後述するように、第2走行路推定手段6Cによっ
て正確な走行路推定ができなくなるので、後述するよう
に、第2走行路推定手段6Cによる推定値Rl ,Rr を
採用することなく第1走行路推定手段6Bによる推定値
R11,R12を採用することとなる。If it is not the backlit state, in step 12, the estimated values (radius of curvature) Rl, Rr, R11, R12 for the traveling road are calculated by the traveling road estimating means 6B, 6C, and then the pitch angle of the CCD camera 4 is calculated. Error determination is performed (step S13). If the result of this determination is that there is an error in the pitch angle, it will not be possible for the second traveling road estimating means 6C to accurately estimate the traveling road, as will be described later, so that the estimation by the second traveling road estimating means 6C will be described later. The estimated values R11 and R12 by the first traveling road estimating means 6B are adopted without using the values Rl and Rr.
【0042】ピッチ角のエラーがなく、逆光状態でもな
ければ、第1走行路推定手段6Bによる走行路推定だけ
でなく、第2走行路推定手段6Cによる走行路推定が可
能であり、複数の推定値が得られることから、どのよう
にして推定値を決定するかを決めるために、ステップS
14では、第2走行路推定手段6Cによる走行路について
の推定値Rl ,Rr のバラツキ、即ち推定値Rl ,Rr
相互の差がしきい値ΔRを越えるか否かが判定され、し
きい値ΔRを越えれば、バラツキが大きすぎていずれの
推定値を信用してよいか判らないので、推定値Rl ,R
r 、R11に基づき多数決で最終的に走行領域推定に使用
する推定値を選定する(ステップS15)一方、しきい値
ΔRを越えなければ、走行路についての推定値Rl ,R
r ,R11の信頼度を検出し(ステップS16)、バラツキ
が小さく各推定値Rl ,Rr 、R11の信頼度も高いと考
えられることから、ステップS15の多数決制御を行うこ
となく、信頼度に基づき最終的に走行領域推定に使用す
る推定値を算出する(ステップS17)。If there is no pitch angle error and there is no backlight condition, not only the traveling road estimation by the first traveling road estimating means 6B but also the traveling road estimation by the second traveling road estimating means 6C is possible. Once the value is obtained, step S is used to determine how to determine the estimated value.
In 14, the variation of the estimated values Rl, Rr for the traveling road by the second traveling road estimating means 6C, that is, the estimated values Rl, Rr
It is judged whether or not the mutual difference exceeds the threshold value ΔR. If the difference exceeds the threshold value ΔR, the estimated values Rl, R cannot be estimated because the variation is too large to trust.
Based on r and R11, a majority is used to finally select an estimated value to be used for estimating the traveling area (step S15). On the other hand, if the threshold value ΔR is not exceeded, the estimated values Rl and R for the traveling path
Since the reliability of r and R11 is detected (step S16) and the variation is small and the reliability of each estimated value Rl, Rr, and R11 is considered to be high, the reliability is determined based on the reliability without performing the majority control in step S15. Finally, an estimated value used for estimating the traveling area is calculated (step S17).
【0043】以下、各ステップでの制御を具体的に説明
する。The control in each step will be specifically described below.
【0044】ステップS11での逆光判定 具体的な制御は、図6に示すように、スタートすると、
各画素の輝度を検出し(ステップS21)、それから白線
部の輝度(平均輝度)CNTh、路面部の輝度(平均輝
度)CNTrを検出し(ステップS22)、それから、白
線部の輝度CNThと路面部の輝度CNTrとの差が、
所定値KHl よりも小さいか否かを判定する(ステップ
S23)。Backlight judgment in step S11 Concrete control is as shown in FIG.
The brightness of each pixel is detected (step S21), then the brightness (average brightness) CNTh of the white line part and the brightness (average brightness) CNTr of the road surface part are detected (step S22), and then the brightness CNTh of the white line part and the road surface part Difference from the brightness CNTr of
It is determined whether it is smaller than the predetermined value KHl (step S23).
【0045】ステップS23での判定がYESの場合は、
白線部と路面部との輝度の差が少なく路面全体が光って
いる逆光状態であると考えられるので、第2走行路推定
手段6Cによる走行路についての推定値Rl ,Rr は使
用しないこととし(ステップS24)、NOの場合は、逆
光状態でないので、第2走行路推定手段6Cによる走行
路についての推定値Rl ,Rr を使用することとし(ス
テップS25)、リターンする。If the determination in step S23 is yes,
Since it is considered that there is a backlight condition in which there is little difference in luminance between the white line portion and the road surface portion and the entire road surface is shining, the estimated values Rl and Rr for the traveling road by the second traveling road estimating means 6C are not used ( In the case of NO at step S24), since it is not in the backlight state, the estimated values Rl and Rr for the traveling road by the second traveling road estimating means 6C are used (step S25), and the process returns.
【0046】ステップS12での走行路についての推定
値の算出 (i) 第1走行路推定手段6Bによる推定値の算出の基本
制御 第1進行路推定手段23において、図7に示すサブルー
チンに従って行われる。即ち、ステップS31で車速セン
サ5、舵角センサ6及びヨーレートセンサ7からの各信
号を読込んだ後、ステップS32でステアリング舵角θH
と車速v0 とに基づいた第1の予測方法により自車の進
行路が予測される。具体的には、進行路についての推定
値R01(曲率半径)、β01(自車の横すべり角)が、下
記の式により算出される。Calculation of Estimated Value for Driving Road in Step S12 (i) Basic Control of Calculation of Estimated Value by First Driving Road Estimating Means 6B In the first traveling road estimating means 23, it is performed according to a subroutine shown in FIG. . That is, after reading each signal from the vehicle speed sensor 5, the steering angle sensor 6 and the yaw rate sensor 7 in step S31, the steering steering angle θH is read in step S32.
And the traveling speed of the vehicle is predicted by the first prediction method based on the vehicle speed v0. Specifically, the estimated values R01 (radius of curvature) and β01 (side slip angle of the vehicle) for the traveling road are calculated by the following formulas.
【0047】[0047]
【数1】 続いて、ステップS33でヨーレートγと車速V0 とに基
づいた第2の予測方法により自車両の進行路が予測され
る。具体的には、進行路についての推定値R02(曲率半
径)、β02(自車の横すべり角)が、下記の式により算
出される。[Equation 1] Then, in step S33, the traveling path of the host vehicle is predicted by the second prediction method based on the yaw rate γ and the vehicle speed V0. Specifically, the estimated values R02 (radius of curvature) and β02 (side slip angle of the vehicle) for the traveling road are calculated by the following formulas.
【0048】[0048]
【数2】 その後、ステップS34でステアリング舵角θH の絶対値
が所定角度θc よりも小さいか否かが判定される。この
判定がYESのときには、ステップS35で第2の予測方
法により予測された進行路が選択され、進行路について
の推定値R11にR02を設定すると共に、推定値β11にβ
02を設定し、リターンする。[Equation 2] Then, in step S34, it is determined whether or not the absolute value of the steering angle θH is smaller than the predetermined angle θc. If this determination is YES, the traveling path predicted by the second prediction method is selected in step S35, the estimated value R11 for the traveling path is set to R02, and the estimated value β11 is set to β.
Set 02 and return.
【0049】一方、上記ステップS34の判定がNOのと
き、つまりステアリング舵角θH が所定角度θc より大
きいときには、更にステップS36で第1の予測方法によ
り予測された進行路についての推定値R01の絶対値と第
2の予測方法により予測された進行路についての推定値
R02の絶対値との大小が比較される。そして、第1の予
測方法により予測された進行路についての推定値R01の
方が小さいときには、ステップS37へ移行して、進行路
についての推定値R11としてR01が採用されると共に、
推定値β11として角β01が設定される一方、第2の予測
方法により予測された進行路についての推定値R02の方
が小さいときには、ステップS35へ移行して、進行路に
ついての推定値R11にR02が設定されると共に、推定値
β11にβ02が設定される。つまり、推定値(曲率半径)
の小さい方が進行路として選択されることとなる。On the other hand, when the determination in step S34 is NO, that is, when the steering steering angle θH is larger than the predetermined angle θc, the absolute value of the estimated value R01 for the traveling path predicted by the first prediction method is further calculated in step S36. The magnitude of the value and the absolute value of the estimated value R02 for the traveling route predicted by the second prediction method are compared. Then, when the estimated value R01 for the traveling road predicted by the first prediction method is smaller, the process proceeds to step S37, and R01 is adopted as the estimated value R11 for the traveling road, and
While the angle β01 is set as the estimated value β11, when the estimated value R02 for the traveling road predicted by the second prediction method is smaller, the process proceeds to step S35, and the estimated value R11 for the traveling road is changed to R02. Is set, and β02 is set to the estimated value β11. That is, estimated value (curvature radius)
The smaller one is selected as the traveling route.
【0050】また、第1進行路推定手段23はステアリ
ング舵角θH と車速V0 とに基づき、第2進行路推定手
段24はヨーレートγと車速V0 とに基づきそれぞれ進
行路を推定し、自車の走行状態に応じて、いずれか一方
の推定を用いるようになっているので、進行路の推定を
適切に行うことができる。即ち、自車がカントを有する
曲線道路上を旋回走行するときには、ステアリングハン
ドルを大きく操舵しなくても自車はカントにより旋回運
動をすることから、ヨーレートγに基づいて予測された
進行路についての推定値R02が、ステアリング舵角θH
に基づいて予測された進行路についての推定値R01より
も小さくなる。このとき、ヨーレートγに基づいて予測
された進行路についての推定値R02を採用するので、カ
ントに影響されることなく、進行路を適切に推定するこ
とができる。また、自車が急激な旋回走行をするとき、
大きな値となるステアリング舵角θH に対応して、進行
路についての推定値がR01の小さいものと推定すること
なり、急激な旋回運転にも充分に対応して進行路の推定
を適切に行うことができる。The first traveling route estimating means 23 estimates the traveling route based on the steering angle θH and the vehicle speed V0, and the second traveling route estimating means 24 estimates the traveling route based on the yaw rate γ and the vehicle speed V0. Since either one of the estimations is used according to the traveling state, it is possible to appropriately estimate the traveling path. That is, when the host vehicle turns on a curved road having a cant, the host vehicle makes a turning motion by the cant even if the steering wheel is not steered greatly. The estimated value R02 is the steering angle θH
It becomes smaller than the estimated value R01 for the traveling route predicted based on At this time, since the estimated value R02 for the traveling road predicted based on the yaw rate γ is adopted, the traveling road can be appropriately estimated without being influenced by the cant. Also, when your vehicle makes a sharp turn,
Corresponding to the steering steering angle θH, which is a large value, the estimated value for the traveling road will be estimated to be a small value of R01, and the traveling road should be estimated appropriately in response to a sudden turning operation. You can
【0051】また、先行車両があるときは、次のように
して、進行路を推定することもできる。When there is a preceding vehicle, the traveling route can be estimated as follows.
【0052】図8に示すように、スタートすると、ま
ず、第1走行路推定手段6Bによって推定された進行路
(推定値R11)上に障害物があるか否かが判定される
(ステップS41)。障害物があれば、続いて、障害物が
移動物でかつ第1走行路推定手段6Bによって推定され
た進行路上に一定時間以上(例えば3sec 以上)存在し
たか否かが判定される(ステップS42)一方、存在して
いなければ、そのままリターンする。As shown in FIG. 8, when starting, it is first determined whether or not there is an obstacle on the traveling road (estimated value R11) estimated by the first traveling road estimating means 6B (step S41). . If there is an obstacle, it is subsequently determined whether or not the obstacle is a moving object and has existed on the traveling path estimated by the first traveling path estimating means 6B for a certain period of time (for example, 3 seconds or more) (step S42). ) On the other hand, if it does not exist, it returns as it is.
【0053】障害物が存在していれば、障害物が、第1
走行路推定手段6Bによって推定された進行路上から外
れたか否かを判定する(ステップS43)一方、存在して
いなければ、そのままする。If an obstacle is present, the obstacle is the first
On the other hand, it is judged whether or not the vehicle deviates from the traveling road estimated by the traveling road estimating means 6B (step S43).
【0054】進行路から外れていれば、分岐路等がある
と考えられるので、先行車両の移動を監視するロックオ
ンを開始し、それに基づいてその先行車両の進行路につ
いての推定値R12(進行路の曲率半径)を算出し(ステ
ップS44)、ステップS45に移行する一方、外れていな
ければ、そのままリターンする。If the vehicle deviates from the traveling road, it is considered that there is a branch road. Therefore, the lock-on for monitoring the movement of the preceding vehicle is started, and the estimated value R12 (travel The radius of curvature of the road is calculated (step S44), and the process proceeds to step S45, while if there is no deviation, the process directly returns.
【0055】ステップS45においては、ロックオン開始
から一定時間経過したか否かを判定し、一定時間経過し
ていれば、先行車両の移動を監視する必要がないので、
ロックオンを解除する(ステップS46)、一定時間経過
していなければ、ステップS47に移行し、先行車両の監
視を継続する。In step S45, it is determined whether or not a fixed time has elapsed from the start of lock-on. If the fixed time has elapsed, it is not necessary to monitor the movement of the preceding vehicle.
The lock-on is released (step S46), and if the fixed time has not elapsed, the process proceeds to step S47 to continue monitoring the preceding vehicle.
【0056】ステップS47においては、障害物が、進行
路(曲率半径R11)上に復帰したか否かを判定し、復帰
しておれば、先行車両の移動を監視する必要がないの
で、そのままリターンし、復帰していなければ、ステッ
プS44に移行する。In step S47, it is determined whether or not the obstacle has returned to the traveling path (curvature radius R11). If the obstacle has returned, it is not necessary to monitor the movement of the preceding vehicle, and therefore the routine returns. If it has not recovered, the process proceeds to step S44.
【0057】ステップS45の判定においては、ロックオ
ン開始から一定時間経過したか否かの判定に代えて、
0.2G<V/R12であるか否かの判定を行うようにし
てもよい。これは、自車が曲率半径R11の進行路から曲
率半径R12の進行路に変換するのにどれだけの横Gが発
生するかを求め、その値が0.2Gを越えるか否かを判
定している。In the determination in step S45, instead of determining whether a fixed time has elapsed from the start of lock-on,
It may be possible to determine whether 0.2G <V / R12. This is to find out how much lateral G occurs when the vehicle transforms from the traveling path having the radius of curvature R11 to the traveling path having the radius of curvature R12, and determines whether the value exceeds 0.2G. ing.
【0058】(ii)第2走行路推定手段6Cによる推定値
の算出の基本制御 画像処理による走行路推定の処理の流れは、通常、図9
に示すようになされる。尚、前提条件として、直線路で
は横すべり角が発生しないこと、直線路では白線部に対
する車体姿勢角は微小であること、曲線路では走行軌跡
は車線を平行移動したものと考える。また、座標は、道
路面上の車両を原点とし、車両の前後方向をy 軸、左右
方向をx 軸としたものを考える。(Ii) Basic Control for Calculation of Estimated Value by Second Road Estimating Means 6C The flow of the process of road estimation by image processing is usually as shown in FIG.
It is done as shown in. As preconditions, it is considered that a side slip angle does not occur on a straight road, a vehicle body posture angle with respect to a white line portion is small on a straight road, and a running locus is a parallel movement of a lane on a curved road. The coordinates are assumed to have the vehicle on the road surface as the origin, the longitudinal direction of the vehicle as the y-axis, and the lateral direction as the x-axis.
【0059】具体的には、まず、スタートすると、画像
データ(各画素の輝度CNT(x,y))が取り込まれ(ス
テップS51)、二値化のしきい値(THRESH)が設定され
(ステップS52)、各画素の輝度がしきい値を越えるか
否かで1又は0の二値化処理される(ステップS53)。
即ち、CNT(x,y) >THRESHであれば、BW(x,y)=1
とする一方、CNT(x,y) ≦THRESHであれば、BW(x,
y)=0とするそれから、左右の白線部に対応するよう
CCDカメラ4による左右のスキャンウインドウの左右
方向の幅が設定され(ステップS54)、それに続いて、
自動車の前後方向に対応するスキャンピッチが設定され
(ステップS55)、スキャンウインドウ内をスキャンピ
ッチに従って走査し白線候補点即ちBW(x,y)=1であ
る点の座標WP1x,WP1y及び個数NWP−L1(左側の
スキャンウインドウ内),NWP−R1(右側のスキャン
ウインドウ内)が検出され(ステップS56)、逆透視変
換により平面座標への変化される(ステップS57)。変
換後の白線候補点の座標は、WP2x,WP2yとする。Specifically, first, when starting, image data (luminance CNT (x, y) of each pixel) is taken in (step S51), and a binarization threshold value (THRESH) is set (step S51). S52), the binarization processing of 1 or 0 is performed depending on whether or not the brightness of each pixel exceeds the threshold value (step S53).
That is, if CNT (x, y)> THRESH, BW (x, y) = 1
On the other hand, if CNT (x, y) ≤ THRESH, then BW (x,
y) = 0, and the widths of the left and right scan windows by the CCD camera 4 in the left and right directions are set so as to correspond to the left and right white line portions (step S54), and subsequently,
A scan pitch corresponding to the front-rear direction of the vehicle is set (step S55), and the coordinates WP1x, WP1y and the number NWP- of the white line candidate points, that is, BW (x, y) = 1, are scanned by scanning the scan window according to the scan pitch. L1 (in the left scan window) and NWP-R1 (in the right scan window) are detected (step S56), and the plane coordinates are changed by the inverse perspective transformation (step S57). The coordinates of the white line candidate points after conversion are WP2x and WP2y.
【0060】それから、自車が走行した後の白線部上の
点として仮想候補点(座標VPx ,VPy 、個数NV
P)が設定され(ステップS58)、白線候補点、仮想候
補点を用いて左右の白線部について最小二乗法による近
似曲線(y=ax2 +bx+c)、具体的には左白線部
についての2次曲線の係数aL,bL,cL、右白線部
についての2次曲線の係数aR,bR,cRが算出され
る(ステップs59)。Then, virtual candidate points (coordinates VPx, VPy, number NV) are set as points on the white line after the vehicle has run.
P) is set (step S58), and an approximate curve (y = ax 2 + bx + c) by the method of least squares is applied to the left and right white line parts using the white line candidate points and the virtual candidate points, specifically, the quadratic curve of the left white line part. The coefficients aL, bL, cL of the curve and the coefficients aR, bR, cR of the quadratic curve for the right white line portion are calculated (step s59).
【0061】ここで、路上障害物検出のため、より前方
まで検出しないといけないという要求から、2次曲線
(y=ax2 +bx+c)により白線部を近似してお
り、係数aL,aRは、白線部(2次近似曲線)の曲率
半径をRl (Rr )とすると、a=1/2Rl (1/2
Rr )となり、係数bL,bRは白線部に対する車体姿
勢角あるいは横すべり角、係数cL,cRは車両中心か
ら白線部までの横偏差量を表わすことになる。Here, in order to detect an obstacle on the road, the white line portion is approximated by a quadratic curve (y = ax 2 + bx + c) due to the requirement that it must be detected further forward, and the coefficients aL and aR are white lines. If the radius of curvature of the part (quadratic approximation curve) is Rl (Rr), then a = 1 / 2Rl (1/2
Rr), the coefficients bL and bR represent the vehicle body attitude angle or the side slip angle with respect to the white line portion, and the coefficients cL and cR represent the lateral deviation amount from the vehicle center to the white line portion.
【0062】そして、白線候補点と近似曲線の偏差(H
EN)を算出し(ステップS60)、白線候補点を検定す
る(ステップS61)。即ち、しきい値HENmax を越え
る偏差HENの場合は、白線候補点から除外する。そし
て、検定後の白線候補点の数を、NWP−L2,NWP−
R2とする。Then, the deviation (H
EN) is calculated (step S60), and the white line candidate points are tested (step S61). That is, if the deviation HEN exceeds the threshold value HENmax, it is excluded from the white line candidate points. Then, the number of white line candidate points after the verification is set to NWP-L2, NWP-
R2.
【0063】その後、スキャンエリアの検定を行う(ス
テップS62)。即ち、検定後の白線候補点の数NWP−
L2,NWP−R2がしきい値NWP−min (白線候補点数
の下限値)より小さいか否かを判定し、小さければ、ス
キャンウインドウのリセット、即ちスキャンウインドウ
に関するパラメータを初期値にセットし(ステップS6
3)、リターンする一方、小さくなければ、スキャンウ
インドウの更新、即ち近似曲線から設定幅WDTHの位
置にウインドウをセットし(ステップS64)、二次曲線
式の係数を出力し(ステップS65)、リターンする。After that, the scan area is verified (step S62). That is, the number of white line candidate points after the test NWP-
It is determined whether or not L2 and NWP-R2 are smaller than a threshold value NWP-min (lower limit value of white line candidate points). If smaller, a scan window is reset, that is, a parameter related to the scan window is set to an initial value (step S6
3) Return, but if not smaller, update the scan window, that is, set the window to the position of the set width WDTH from the approximate curve (step S64), output the coefficient of the quadratic curve equation (step S65), and return. To do.
【0064】ステップS13でのCCDカメラのピッチ
角のエラー判定の制御 図10に示すように、CCDカメラ4による画像処理に
より推定された左右の白線部RL ,RR に基づく走行路
についての推定値(曲率半径)Rl ,Rr の符号が反対
で、それらの絶対値がそれらの平均値(曲率半径)Rx
の絶対値と異なり、進行路R01についての推定値(曲率
半径)R11が平均値Rx に略等しい状態では、CCDカ
メラのピッチ角のエラーであると判断されるので、その
場合には、補正を行う必要がある。Rl ,Rr は上り坂
の状態を、Rl ´,Rr ´は下り坂の状態をそれぞれ示
す。Control of Pitch Angle Error Judgment of CCD Camera in Step S13 As shown in FIG. 10, an estimated value for the traveling path based on the left and right white line portions RL and RR estimated by the image processing by the CCD camera 4 ( The radii of curvature Rl and Rr have opposite signs, and their absolute values are their average values (radius of curvature) Rx
In contrast to the absolute value of, when the estimated value (curvature radius) R11 of the traveling path R01 is substantially equal to the average value Rx, it is determined that the error is the pitch angle of the CCD camera. There is a need to do. Rl and Rr indicate an uphill state, and Rl 'and Rr' indicate a downhill state.
【0065】具体的な制御は、図11に示すように、ス
タートすると、まず、走行路(進行路)についての推定
値Rl ,Rr ,R11を読み込み(ステップS70)、左右
の白線部に基づく走行路についての推定値(曲率半径)
Rl ,Rr の絶対値が、それらの平均値(曲率半径)R
x の絶対値と異なり、進行路についての推定値(曲率半
径)R11が平均値Rx に略等しいか否かを判定する(ス
テップS71)。ここで、略等しいとは、あるしきい値の
範囲内で等しいという意味で、完全に一致するという意
味ではない。以下、本明細書において同様である。As a concrete control, as shown in FIG. 11, when starting, first, the estimated values Rl, Rr, R11 for the traveling road (traveling road) are read (step S70), and traveling based on the left and right white line portions is performed. Estimated value for road (radius of curvature)
The absolute values of Rl and Rr are their average values (radius of curvature) R
Unlike the absolute value of x, it is determined whether the estimated value (curvature radius) R11 for the traveling path is substantially equal to the average value Rx (step S71). Here, “substantially equal” means being equal within a certain threshold range, and does not mean being completely coincident. The same applies hereinafter in this specification.
【0066】ステップS71の判定において、YESであ
れば、走行路の左右の白線部及び進行路についての推定
値に基づく、自車Aと左右白線部との横方向の偏差であ
る現在偏差εφの変化率が略等しいか否かを判定する
(ステップS72)。一方、NOであれば、走行路の左右
の白線部についての推定値は信頼できないと考えられる
ので、進行路についての推定値R11を優先して採用し
(ステップS73)、リターンする。If YES in the determination in step S71, the current deviation εφ, which is the lateral deviation between the vehicle A and the left and right white line parts, based on the estimated values of the left and right white line parts of the traveling road and the traveling road. It is determined whether the rates of change are substantially equal (step S72). On the other hand, if NO, it is considered that the estimated values for the left and right white line portions of the traveling road are unreliable, so the estimated value R11 for the traveling road is preferentially adopted (step S73), and the process returns.
【0067】それから、ステップS72の判定において、
NOであれば、ステップS71の判定でNOであった場合
と同様に、進行路についての推定値R11を優先して採用
し(ステップS73)、リターンする。Then, in the determination of step S72,
If NO, as in the case of NO in the determination in step S71, the estimated value R11 for the traveling path is preferentially adopted (step S73), and the process returns.
【0068】ステップS72の判定において、YESであ
れば、ピッチ角のエラーであると推定されるので、カメ
ラピッチ角を保存してピッチ角補正を行う(ステップS
74)。If YES in the determination in step S72, it is estimated that there is an error in the pitch angle, so the camera pitch angle is saved and the pitch angle is corrected (step S
74).
【0069】ステップS74でのピッチ角補正の後、左右
の白線部についての推定値Rl ,Rr が略等しいか否か
を判定し(ステップS75)、略等しければ、ピッチ角補
正によりエラーがなくなったと判断されるので、左右の
白線部についての推定値Rl,Rr を優先して採用し
(ステップS76)、リターンする一方、略等しくならな
ければ、ステップS78で繰返し数Nが設定数Ns である
か否かを判定し、繰返し数Nが設定数Ns でなければ、
ステップS74に戻り、ピッチ角補正を繰り返す一方、繰
返し数Nが設定数Ns になれば、ピッチ角のエラーでは
ないと判断されるので、ピッチ角を元に戻し(ステップ
S78)、それから、ステップS73に移行する。After the pitch angle correction in step S74, it is determined whether or not the estimated values Rl and Rr for the left and right white line portions are substantially equal (step S75). If they are substantially equal, the pitch angle correction eliminates the error. Since the judgment is made, the estimated values Rl and Rr for the left and right white line parts are preferentially adopted (step S76), and while returning, if they are not substantially equal, whether the number of repetitions N is the set number Ns in step S78. If the number of repetitions N is not the set number Ns,
Returning to step S74, while the pitch angle correction is repeated, if the number of repetitions N reaches the set number Ns, it is determined that it is not a pitch angle error, so the pitch angle is returned to the original (step S78), and then step S73. Move to.
【0070】信頼度に基づき推定値を決定する制御 図12に示すように、スタートすると、まず、画像処理
により推定された走行路の左右の白線部に基づく曲率半
径Rl ,Rr 及びそれらの推定についての信頼度Sl ,
Sr を算出し(ステップS81)、それから、信頼度Sl
,Sr のしきい値S01を設定する(ステップS82)。Control for Determining Estimated Value Based on Reliability As shown in FIG. 12, when starting, first, regarding the radii of curvature Rl, Rr and their estimation based on the left and right white line portions of the road estimated by the image processing. The reliability of S,
Sr is calculated (step S81), and then the reliability Sl
, Sr threshold S01 is set (step S82).
【0071】その後、各曲率半径Rl ,Rr の信頼度S
l ,Sr が共にしきい値S0 よりも小さいか否かを判定
し(ステップS83)、小さければ信頼性に劣るので、進
行路に基づく曲率半径R11を採用し(ステップS84)、
リターンする。一方、小さくなければ、続いて、各白線
部Rl ,Rr の信頼度Sl ,Sr が共にしきい値S0よ
りも大きいか否かを判定し(ステップS85)、大きくな
ければ、信頼度Sl ,Sr の高い方の曲率半径、即ちし
きい値S0 よりも大きい白線部の曲率半径を採用し(ス
テップ86)、リターンする。Then, the reliability S of each radius of curvature Rl, Rr
It is determined whether both l and Sr are smaller than the threshold value S0 (step S83). If the values are smaller than the threshold value S0, reliability is poor. Therefore, the radius of curvature R11 based on the traveling path is adopted (step S84).
To return. On the other hand, if it is not smaller, then it is determined whether or not the reliability degrees Sl and Sr of the white line portions Rl and Rr are both higher than the threshold value S0 (step S85). If not, the reliability degrees Sl and Sr are determined. Is used, that is, the radius of curvature of the white line portion larger than the threshold value S0 is adopted (step 86), and the process returns.
【0072】また、共にしきい値S0 よりも大きけれ
ば、次の式に基づき、信頼度Sl ,Sr による重み付け
をして曲率半径を求め(ステップS87)、リターンす
る。If both are greater than the threshold value S0, the radii of curvature are determined by weighting the reliability values Sl and Sr based on the following equation (step S87), and the process returns.
【0073】[0073]
【数3】 また、信頼度Sl ,Sr による重み付けをして曲率半径
を求めるステップS87制御に代えて、図13に示すよう
に、各白線部の曲率半径(推定値)についての信頼度S
l ,Sr を比較し(ステップS88)、信頼度の高い方の
曲率半径を用い(ステップS89,S90)、リターンする
ようにすることもできる。[Equation 3] Further, as shown in FIG. 13, the reliability S for the radius of curvature (estimated value) of each white line portion is replaced with the control of step S87 for obtaining the radius of curvature by weighting with the reliability S1, Sr.
It is also possible to compare l and Sr (step S88), use the radius of curvature with the higher reliability (steps S89, S90), and return.
【0074】続いて、信頼度を求める方法である具体例
1〜3を説明する。Next, specific examples 1 to 3 as a method of obtaining the reliability will be described.
【0075】(i) 具体例1 左右それぞれの白線候補点の数NWP、白線候補点と近
似曲線との偏差HENにより、次の式に基づいて信頼度
を算出する。(I) Concrete Example 1 The reliability is calculated based on the following equation from the number NWP of left and right white line candidate points and the deviation HEN between the white line candidate points and the approximate curve.
【0076】[0076]
【数4】 (ii)具体例2 次の式で求められる曲率半径(推定値)の変化率Khに
基づいて、信頼度を段階的に決定する(図14参照)。[Equation 4] (ii) Concrete Example 2 The reliability is determined stepwise based on the rate of change Kh of the radius of curvature (estimated value) obtained by the following formula (see FIG. 14).
【0077】[0077]
【数5】 具体例3 次の式に基づき、曲率半径(推定値)の検出率により信
頼度を算出する。[Equation 5] Concrete Example 3 Based on the following equation, the reliability is calculated by the detection rate of the radius of curvature (estimated value).
【0078】[0078]
【数6】 また、上記図13に示す制御では、信頼度を直接的に比
較することで信頼度の高い推定値を決定するようにして
いるが、信頼度の高い方の推定値(曲率半径)を決める
方法として、そのほか、次の具体例4,5に示すように
して、決定することもできる。[Equation 6] In the control shown in FIG. 13, the reliability is directly compared to determine the estimated value with high reliability. However, the estimated value (curvature radius) with higher reliability is determined. Alternatively, it can be determined as shown in the following specific examples 4 and 5.
【0079】具体例4 本例は、白線候補点/スキャン範囲の周期により判定す
るものである。Concrete Example 4 In this example, the judgment is made by the cycle of the white line candidate points / scan range.
【0080】左右の白線部が、実線の白線RL ,RR で
はなく、破線の白線RL ´,RR ´であると、図15に
示すように、スキャン範囲Wをうまく設定しないと、推
定値が正確に求められないことからである。尚、白線候
補点/スキャン範囲の値JHは、次の式により求め、こ
の周期が大きいときは無規則な変動のため周期が長くな
っており、実線と考えられ、周期が小さいときは、白線
部が一定間隔で配置されている破線であると考えられ
る。また、破線の場合は変化が大きいので、実線よりも
振幅が大きくなると考えられる。If the left and right white line parts are not the solid white lines RL and RR but the broken white lines RL 'and RR', the estimated value is accurate unless the scan range W is set properly as shown in FIG. This is because it is not required for. The white line candidate point / scan range value JH is obtained by the following formula. When this period is large, the period is long because of irregular fluctuations, and is considered to be a solid line. When the period is small, the white line is It is considered that the parts are broken lines arranged at regular intervals. Further, in the case of the broken line, since the change is large, it is considered that the amplitude becomes larger than that of the solid line.
【0081】[0081]
【数7】 具体的な制御の流れは、図16に示すように、スタート
すると、まず、左右白線部についての上記値JHの周期
JHl T、JHr T及び振幅JHl B、JHrBを算出
し(ステップS91)、右白線部についての上記値JHの
周期JHr Tがしきい値T1 より小さくかつ振幅JHr
Bがしきい値B1 より大きいか否かを判定する(ステッ
プS92)。そして、その判定がYESであってもNOで
あっても、左白線部についての周期JHl Tがしきい値
T1 より小さくかつ振幅JHl Bがしきい値B1 より大
きいか否かを判定する(ステップS93,S94)。[Equation 7] As shown in FIG. 16, when the control flow starts, first, the cycles JHLT, JHRT and the amplitudes JHLB, JHRB of the above-mentioned value JH for the left and right white line parts are calculated (step S91), and right. The period JHr T of the above value JH for the white line portion is smaller than the threshold value T1 and the amplitude JHr
It is determined whether B is larger than the threshold value B1 (step S92). Then, whether the judgment is YES or NO, it is judged whether or not the cycle JH1T for the left white line part is smaller than the threshold value T1 and the amplitude JH1B is larger than the threshold value B1 (step S93, S94).
【0082】そして、ステップS93において、YESで
あれば、左右の白線部が共にかなり間隔の大きい破線で
あると判断され、信頼度が低いと考えられるので、車両
状態量による推定値を使用し、画像データは1次近似に
変更し、車線幅の推定を行い、それらを使用し(ステッ
プS95)、リターンする一方、NOであれば、周期JH
r Tがしきい値T1 より大きく又は振幅JHr Bがしき
い値B1 より小さく、周期JHl Tがしきい値T1 より
小さくかつ振幅JHl Bがしきい値B1 より大きいの
で、白線部は実線と考えられ、左白線部の曲率半径Rl
を使用し(ステップS96)、リターンする。If YES in step S93, it is determined that the left and right white line portions are broken lines with considerably large intervals, and the reliability is considered to be low. Therefore, the estimated value based on the vehicle state quantity is used. The image data is changed to the first approximation, the lane width is estimated, these are used (step S95), and the process returns, while if NO, the cycle JH
Since r T is larger than the threshold value T1 or the amplitude JHr B is smaller than the threshold value B1, the period JHl T is smaller than the threshold value T1 and the amplitude JHl B is larger than the threshold value B1, the white line portion is considered to be a solid line. And the radius of curvature Rl of the left white line
Is used (step S96) and the process returns.
【0083】一方、ステップS94の判定において、YE
Sであれば、右白線部についての曲率半径Rr を使用し
(ステップS98)、リターンする一方、NOであれば、
左右の白線部の曲率半径Rl ,Rr を平均して、走行路
推定に用いる曲率半径を決定し(ステップS97)、リタ
ーンする。On the other hand, in the determination of step S94, YE
If S, the radius of curvature Rr for the right white line portion is used (step S98), and while returning, if NO,
The radii of curvature Rl and Rr of the left and right white line portions are averaged to determine the radius of curvature used for roadway estimation (step S97), and the process returns.
【0084】具体例6 本例は、現在偏差の比較により判定するものである。Concrete Example 6 In this example, judgment is made by comparing current deviations.
【0085】具体的な制御の流れは、図17に示すよう
に、スタートすると、各白線部について、現在偏差Bと
t秒前の現在偏差B´の差を算出し(ステップS101
)、それらの差が左右の白線部のいずれにおいて大き
いかを判定し(ステップS102 )、大きい方が信頼度が
低いと判断されるから、右の白線部の方が大きい場合
は、左の白線部についての曲率半径Rl を採用し(ステ
ップS103 )、左の白線部の方が大きい場合は右の白線
部についての曲率半径Rr を採用し(ステップS10
4)、リターンする。As shown in FIG. 17, the specific control flow is such that, when started, the difference between the current deviation B and the current deviation B't seconds ago is calculated for each white line portion (step S101).
), It is determined which of the left and right white line portions is larger (step S102), and the larger the difference, the lower the reliability. Therefore, if the right white line portion is larger, the left white line portion is larger. The radius of curvature Rl for the part is adopted (step S103), and if the left white line part is larger, the radius of curvature Rr for the right white line part is adopted (step S10).
4), return.
【0086】また、上述した例はいずれも左右の白線部
についての推定値の信頼度を算出するものであり、車両
状態量による進行路推定による推定値は、車両挙動が定
常状態においては信頼性が高く、過渡状態において信頼
性が低いといえ、即ち信頼度はその変化率に依存すると
いえるので、次の図18に示すようにして、進行路につ
いての推定値の信頼度を算出して利用することもでき
る。In each of the above examples, the reliability of the estimated value for the left and right white line portions is calculated, and the estimated value obtained by estimating the traveling path based on the vehicle state quantity is reliable when the vehicle behavior is in a steady state. Is high and the reliability is low in the transient state, that is, the reliability depends on the rate of change, and therefore the reliability of the estimated value for the traveling path is calculated and used as shown in FIG. You can also do it.
【0087】図18において、スタートすると、まず、
過去N回のR11の平均値RAVE を算出し(ステップS10
1 )、今回のR11と平均値RAVE の差RSUB を算出する
(ステップS102 )。In FIG. 18, when starting, first,
The average value RAVE of R11 in the past N times is calculated (step S10
1) The difference RSUB between the current R11 and the average value RAVE is calculated (step S102).
【0088】[0088]
【数8】 それから、次の式に基づいて信頼度PTRを算出し(ステ
ップS103 )、リターンする。[Equation 8] Then, the reliability PTR is calculated based on the following equation (step S103), and the process returns.
【0089】[0089]
【数9】 多数決により走行路を推定する場合の基本制御 スタートすると、図19に示すように、まず、先行車両
の進行路である第2の進行路についての推定値R12につ
いての出力があるか否かが判定される(ステップS111
)。[Equation 9] When the basic control for estimating the travel route by majority decision is started, first, as shown in FIG. 19, it is determined whether or not there is an output of the estimated value R12 for the second travel route which is the travel route of the preceding vehicle. (Step S111
).
【0090】第2の進行路についての推定値R12の出力
があれば、推定値R12(曲率半径)の第2の進行路側に
ウィンカー信号が出されているか否かが判定され(ステ
ップS112 )、ウィンカー信号が出されていれば、推定
値R12(曲率半径)の第2の進行路を優先し(ステップ
S113 )、リターンする一方、ウィンカー信号が出され
ていなければ、ステップS114 に移行する。If the estimated value R12 for the second traveling road is output, it is determined whether or not a winker signal is output to the second traveling road side of the estimated value R12 (curvature radius) (step S112). If the winker signal is output, the second traveling path having the estimated value R12 (radius of curvature) is prioritized (step S113), and the process returns, while if the winker signal is not output, the process proceeds to step S114.
【0091】一方、ステップS111 で第2の進行路につ
いての推定値R12の出力がなければ、走行路及び進行路
についての推定値Rl ,Rr ,R11がすべて略等しいか
否かを判定し(ステップS115 )、すべてが略等しけれ
ば、推定領域を広く確保できることから、走行路につい
ての推定値Rl ,Rr を優先し(ステップS116 )、リ
ターンする。この場合の推定値の関係を図20に示す。On the other hand, if the estimated value R12 for the second traveling road is not output in step S111, it is determined whether or not the estimated values Rl, Rr, R11 for the traveling road and the traveling road are all substantially equal (step S11). If all of them are substantially equal, the estimated region can be secured widely, so the estimated values Rl and Rr for the traveling road are prioritized (step S116), and the process returns. The relationship between the estimated values in this case is shown in FIG.
【0092】また、すべてが等しくなければ、走行路の
左右白線部についての推定値Rl ,Rr が略等しく、進
行路についての推定値R11がそれらと異なるか否かを判
定する(ステップS117 )。YESである場合(図21
参照)は、ステップS116 に移行する一方、NOであれ
ば、ステップS118 ,S119 に移行し、走行路の左右白
線部についての推定値Rl ,Rr のいずれか一方のみが
進行路についての推定値R11に等しいか否かを判定し、
等しい場合(図22及び図23参照)は、等しい方の推
定値Rl (又はRr )を優先し(ステップS120 ,S12
1 )、いずれも等しくなければ、進行路についての推定
値R11を優先し(ステップS122 )、リターンする。If all are not equal, it is determined whether the estimated values Rl and Rr for the left and right white line portions of the traveling road are substantially equal and the estimated value R11 for the traveling road is different from them (step S117). If YES (FIG. 21)
If the answer is NO, the process proceeds to steps S118 and S119, and only one of the estimated values Rl and Rr for the left and right white line portions of the traveling road is the estimated value R11 for the traveling road. Is equal to
If they are equal (see FIG. 22 and FIG. 23), the estimated value Rl (or Rr) of the other one is prioritized (steps S120, S12).
1) If none of them are equal, the estimated value R11 for the traveling path is given priority (step S122), and the process returns.
【0093】また、ステップS114 では、左白線部につ
いての推定値Rl と進行路についての推定値R11が等し
く、右白線部についての推定値Rr と第2の進行路につ
いての推定値R12が等しく、かつそれらが等しくないと
いう条件を満たすか否かが判定され、YESの場合(図
24参照)は、ステップS120 に移行する一方、NOの
場合には、さらに、右白線部についての推定値Rr と進
行路についての推定値R11が等しく、左白線部について
の推定値Rlと第2の進行路についての推定値R12が等
しく、かつそれらが等しくないという条件を満たすか否
かが判定され(ステップS123 )、YESの場合(図2
5参照)は、ステップS121 に移行する一方、NOの場
合には、多数決による選定がなされ(ステップS124
)、リターンする。In step S114, the estimated value Rl for the left white line portion and the estimated value R11 for the traveling road are equal, the estimated value Rr for the right white line portion and the estimated value R12 for the second traveling road are equal, Further, it is determined whether or not the condition that they are not equal is satisfied, and if YES (see FIG. 24), the process proceeds to step S120, while if NO, the estimated value Rr for the right white line portion is further calculated. It is determined whether or not the conditions that the estimated values R11 for the traveling route are equal, the estimated value Rl for the left white line portion and the estimated value R12 for the second traveling route are equal, and they are not equal (step S123). ), If YES (Fig. 2
5), the process proceeds to step S121, while in the case of NO, the majority decision is made (step S124).
), Return.
【0094】また、図26に示すように、推定された走
行路についてのの推定値に対し、検知率、検知時間の係
数により重み付けを行って、走行路を最終的に決定する
多数決判定式によって走行路を推定することもできる。Further, as shown in FIG. 26, the estimated value for the estimated traveling road is weighted by the coefficient of the detection rate and the detection time, and the majority decision formula is used to finally determine the traveling road. It is also possible to estimate the travel route.
【0095】[0095]
【数10】 即ち、スタートすると、走行路についての推定値Rl ,
Rr ,R11,R12を読み込み(ステップS131 )、ウイ
ンカ信号によりウインカ操作があるか否かを判定し(ス
テップS132 )、ウィンカー操作があれば、ウインカー
方向の走行路の推定値(曲率半径)を優先し(ステップ
S133 )、リターンする一方、ウィンカー操作がなけれ
ば、ステップS134 に移行し、画像検知率が50%を越
えるか否かを判定する。[Equation 10] That is, when the vehicle is started, the estimated value Rl for the traveling road,
Rr, R11, R12 are read (step S131), it is determined whether there is a blinker operation by a blinker signal (step S132), and if there is a blinker operation, the estimated value (radius of curvature) of the road in the direction of the blinker is prioritized. On the other hand, the process returns (step S133), and if there is no winker operation, the process proceeds to step S134 to determine whether the image detection rate exceeds 50%.
【0096】画像検知率が50%を越えるのであれば、
画像処理による第2走行路推定手段6Cによる推定値R
l ,Rr の信頼度が高いと考えられるので、多数決判定
式により走行路を決定する(ステップS135 )一方、5
0%を越えない場合には、曲率半径R11を優先し(ステ
ップS136 )、走行領域が設定され(ステップS13
7)、リターンする。If the image detection rate exceeds 50%,
Estimated value R by the second traveling road estimating means 6C by image processing
Since it is considered that the reliability of l and Rr is high, the travel route is determined by the majority decision formula (step S135), while 5
If it does not exceed 0%, the radius of curvature R11 is prioritized (step S136), and the traveling area is set (step S13).
7), return.
【0097】そして、走行路を決定した後、走行路につ
いての推定値(曲率半径)が計算され(ステップS138
)、ステップS137 を経て、リターンする。 また、
多数決判定式により決定するのに代えて、次の式によ
り、走行路を直接推定するようにすることもできる。After determining the traveling road, an estimated value (curvature radius) for the traveling road is calculated (step S138).
), And returns through step S137. Also,
Instead of the majority decision formula, the following formula may be used to directly estimate the travel route.
【0098】[0098]
【数11】 (6) 補正制御 ヘッドランプ・スイッチの状態によって、左右の白線
部の推定範囲を変更する制御 ヘッドランプの点灯状態によって、白線部の検出状態が
異なってくることを考慮したものである。[Equation 11] (6) Correction control The control that changes the estimated range of the left and right white line parts depending on the state of the headlamp switch Considers that the detection state of the white line part differs depending on the lighting state of the headlamps.
【0099】図27に示すように、スタートすると、ヘ
ッドラップスイッチ13の位置を検出し(ステップS14
1 )、ヘッドランプスイッチがOFFであるか否かを判
定し(ステップS142 )、YESの場合は、周囲環境が
良好な昼間であると考えらえるので、車体前方60mま
で白線部データ(白線候補点)を検出して走行路推定を
行い、車体前方120mまで予想して障害物判断領域を
設定し、障害物判断する(ステップS143 )、NOであ
れば、ヘッドランプ・スイッチがHigh位置であるか
Low位置であるかを判定する(ステップS144 )。As shown in FIG. 27, when starting, the position of the head wrap switch 13 is detected (step S14).
1) It is determined whether or not the headlamp switch is OFF (step S142). If YES, it can be considered that the environment is good in the daytime, so white line data (white line candidates) up to 60 m in front of the vehicle body. Point) is detected to estimate the traveling path, the obstacle judgment area is set by predicting 120 m ahead of the vehicle body, and obstacle judgment is made (step S143). If NO, the headlamp switch is in the high position. Or the Low position is determined (step S144).
【0100】ステップS144 での判定において、Hig
h位置であれば、車体前方40mまでの白線部データを
検出して走行路推定を行い、車体前方60mまで予想し
て障害物判断領域を設定し、障害物判断する一方(ステ
ップS145 )、Low位置であれば、High位置にあ
るよりも車体前方は暗いので、車体前方20mまでの白
線部データを検出して走行路推定を行い、車体前方40
mまで予想して障害物判定領域を設定し、障害物判断す
る(ステップS146 )。In the determination at step S144, it is determined that High
If it is at the h position, the white line data up to 40 m ahead of the vehicle body is detected to estimate the traveling path, the obstacle judgment area is set by predicting up to 60 m ahead of the vehicle body, and the obstacle is judged (Step S145), while Low is determined. If it is at the position, the front of the vehicle is darker than it is at the High position. Therefore, the white line data up to 20 m in front of the vehicle is detected to estimate the traveling path, and the vehicle front 40
The obstacle judgment area is set by predicting up to m, and the obstacle is judged (step S146).
【0101】また、図28に示すように、ヘッドランプ
がONであると、ヘッドライトの光Uによる路面光りに
よって、本来の白線候補点P1 〜P4 以外に、その路面
光りの部分P5 〜P8 を白線部RL ,RR の白線候補点
であると誤検知するおそれがあるので、この誤検知を回
避するために、ヘッドランプのON/OFFにより、図
29に示すように、車体前方部分には、白線部がないと
考えられることから、その部分を、画像処理のための本
来の左右のスキャンウインドウW11,W12(図28参
照)から除いたスキャンウインドウW11´,W12´を用
いることにより、誤検知を防止するようにしている。Further, as shown in FIG. 28, when the headlamp is ON, the road surface light due to the light U of the headlight causes not only the original white line candidate points P1 to P4, but also the road surface light portions P5 to P8 to be detected. There is a risk of erroneous detection as a white line candidate point of the white line portions RL and RR. Therefore, in order to avoid this erroneous detection, the headlamp is turned on / off, as shown in FIG. Since it is considered that there is no white line part, the false detection is performed by using the scan windows W11 ′ and W12 ′ that are removed from the original left and right scan windows W11 and W12 for image processing (see FIG. 28). I try to prevent it.
【0102】白線候補点の検出距離に基づく補正 本例は、例えば図30に示す坂道の山頂付近等のよう
に、本来白線候補点を検出して白線部RL ,RR を検出
する距離L11まで、白線候補点を検出できない場合の対
策である。Correction Based on Detection Distance of White Line Candidate Point In this example, up to the distance L11 for originally detecting the white line candidate point and detecting the white line portions RL and RR, such as near the summit of the slope shown in FIG. This is a countermeasure when the white line candidate points cannot be detected.
【0103】図31に示すように、スタートすると、第
2走行路推定手段6Cにより推定された走行路の白線部
についての推定値Rl ,Rr (曲率半径)及び第1走行
路推定手段6Bにより推定された進行路についての推定
値R11,R12(曲率半径)を読込み(ステップS151
)、それらの基づき前述した手法により走行路の推定
を行う(ステップS152 )。それから、走行路推定手段
によりの信号に基づき現実に白線候補点を検出すること
ができる検出可能距離L11を算出し(ステップS153)、
それから、該検出可能距離L11が、白線部(白線候補
点)を検出すべきであると予め定められている設定距離
Ls (しきい値)より小さいか否かを判定する(ステッ
プS154 )。As shown in FIG. 31, when the vehicle is started, the estimated values Rl and Rr (radius of curvature) for the white line portion of the traveling road estimated by the second traveling road estimating means 6C and the first traveling road estimating means 6B are estimated. Estimated values R11 and R12 (radius of curvature) for the traveled route are read (step S151
), And based on them, the traveling path is estimated by the method described above (step S152). Then, a detectable distance L11 at which a white line candidate point can be actually detected is calculated based on the signal from the traveling road estimation means (step S153),
Then, it is determined whether or not the detectable distance L11 is smaller than a set distance Ls (threshold value) which is predetermined to detect the white line portion (white line candidate point) (step S154).
【0104】検出可能距離L11が設定距離Ls よりも小
さい場合は、検出可能距離を越えて障害物が存在してい
る可能性は低いと考えられるので、検出可能距離L11ま
では走行路推定手段により走行路の左右白線部について
の推定値Rl ,Rr を優先し(ステップS155 )、検出
可能距離L11以降は進行路についての推定値R11を優先
し(ステップS156 )、それぞれ障害物判定領域を設定
し(ステップS157 )、リターンする。If the detectable distance L11 is smaller than the set distance Ls, it is considered unlikely that an obstacle exists beyond the detectable distance. The estimated values Rl and Rr for the left and right white lines of the traveling road are prioritized (step S155), and the estimated value R11 for the traveling road is prioritized after the detectable distance L11 (step S156), and obstacle judgment areas are set respectively. (Step S157) and the process returns.
【0105】レーザデータによる補正 本例は、進行路推定手段による推定値半径及び走行路推
定手段による推定値が全く異なる場合には、自車前方の
環境を検出するレーザデータユニット(環境検出手段)
よって検出される構造物(例えば路側のリフレクタ、隣
接車線の車両等)を利用して、いずれの推定値(曲率半
径)が信頼できるかを判定するものである。Correction by Laser Data In this example, a laser data unit (environment detecting means) for detecting the environment in front of the own vehicle when the estimated value radius by the traveling road estimating means and the estimated value by the traveling road estimating means are completely different.
Therefore, using the detected structure (for example, a roadside reflector, a vehicle in an adjacent lane, etc.), it is determined which estimated value (curvature radius) is reliable.
【0106】図32に示すように、スタートすると、ま
ず、走行路の白線部についての推定値Rl ,Rr 及び進
行路についての推定値R11を読込み(ステップS161
)、それらの推定値Rl ,Rr ,R11がすべて異なる
か否かを判定する(ステップS162 )。As shown in FIG. 32, when starting, first, the estimated values Rl and Rr for the white line portion of the traveling road and the estimated value R11 for the traveling road are read (step S161).
), It is determined whether or not the estimated values Rl, Rr, R11 are all different (step S162).
【0107】すべての曲率半径が異なる場合には、N個
以上の規則的なレーザレーダ・データ(自車前方の環境
に関するデータ)があるか否かを判定する(ステップS
163)一方、そうでない場合、即ち3つ又は2つの曲率
半径が等しい場合には、多数決を用いて曲率半径が等し
い推定Rを優先する(ステップS170 )。尚、レーザレ
ーダ・データは、走行路が曲線であることも考慮する
と、少なくともN=3個のレーザレーダ・データは必要
である。If all the radii of curvature are different, it is judged whether or not there are N or more regular laser radar data (data relating to the environment in front of the vehicle) (step S).
163) On the other hand, if not, that is, if three or two radii of curvature are equal, a majority rule is used to give priority to the estimation R having the same radius of curvature (step S170). Note that at least N = 3 pieces of laser radar data are necessary for the laser radar data, considering that the traveling road is a curve.
【0108】レーザレーダ・データがN個以上ある場合
は、レーザデータ・レーダに基づく走行路の推定値(曲
率半径)が、いずれかの推定値Rl ,Rr ,R11に等し
いか否かを判定する(ステップS165 )一方、レーザレ
ーダ・データがない場合には、いずれの推定値(曲率半
径)の信頼度が高いのか判定できないので、ステップS
163 に移行してシステムを停止する。When there are N or more pieces of laser radar data, it is determined whether or not the estimated value (radius of curvature) of the traveling path based on the laser data radar is equal to any of the estimated values Rl, Rr, R11. (Step S165) On the other hand, if there is no laser radar data, it is not possible to determine which of the estimated values (radius of curvature) has high reliability.
Migrate to 163 and shut down the system.
【0109】また、推定値(曲率半径)Rl ,Rr ,R
11のいずれもがレーザレーダ・データにより推定される
推定値(曲率半径)に等しくない場合も、同様に、ステ
ップS163 に移行するが、推定値Rl ,Rr ,R11のい
ずれかに等しい場合は、等しい推定値の信頼度が最も高
いと判断してその推定値(曲率半径)を優先し(ステッ
プS166 〜S168 )、走行路推定を行い、それに基づき
障害物判定領域を設定して(ステップS169 )、リター
ンする。The estimated values (radius of curvature) Rl, Rr, R
If none of 11 is equal to the estimated value (radius of curvature) estimated by the laser radar data, the process similarly proceeds to step S163, but if any of the estimated values Rl, Rr, R11 is equal, It is determined that the reliability of the same estimated value is the highest, and the estimated value (curvature radius) is prioritized (steps S166 to S168), the travel route is estimated, and the obstacle determination area is set based on it (step S169). , Return.
【0110】例えば図33に示すように、推定値Rl ,
Rr ,R11がすべて異なる場合であっても、自車Aの前
方のレーザデータD1 〜D4 は推定値Rr と一致してい
るので、この場合は、推定値Rr が優先される。For example, as shown in FIG. 33, the estimated values Rl,
Even if Rr and R11 are all different, the laser data D1 to D4 in front of the vehicle A match the estimated value Rr, and in this case, the estimated value Rr is prioritized.
【0111】障害物判断距離に基づく補正 本例は、自車両の直前に当たる障害物判断距離内では走
行路全体に亘って障害物判断をすることが望ましいが,
障害物判断距離を越えれば、障害物判定領域を広く設定
する必要がないことから、進行路推定による進行路に基
づいて設定される領域であることを考慮したものであ
る。Correction Based on Obstacle Judgment Distance In this example, it is desirable to judge obstacles over the entire traveling path within the obstacle judgment distance that is immediately before the host vehicle.
If the obstacle determination distance is exceeded, it is not necessary to set the obstacle determination region to be wide, and this is because the region is set based on the traveling route estimated by the traveling route.
【0112】図34に示すように、スタートすると、ま
ず、前述した手法に基づいて走行路が推定され(ステッ
プS171 )、それから、自車速、相対速度、路面摩擦係
数により障害物判断距離L21を算出する(ステップS17
2 )。尚、障害物判断距離L21は例えば次の式により求
められる。As shown in FIG. 34, when the vehicle is started, the traveling road is first estimated based on the above-mentioned method (step S171), and then the obstacle judgment distance L21 is calculated from the own vehicle speed, the relative speed and the road friction coefficient. Yes (step S17
2). The obstacle judgment distance L21 is calculated by the following equation, for example.
【0113】[0113]
【数12】 それから、ステップS171 において走行路の白線部につ
いての推定値Rl ,Rr が優先される場合であっても、
障害物判断距離L21内でのみ走行路の白線部についての
推定値Rl ,Rr を優先し、障害物判断距離L21を越え
れば、進行路についての推定値R11を優先して、障害物
判断領域を設定し(ステップS173 )、リターンする。[Equation 12] Then, even if the estimated values Rl and Rr for the white line portion of the road are prioritized in step S171,
Only within the obstacle judgment distance L21, the estimated values Rl and Rr for the white line portion of the traveling road are prioritized. If the obstacle judgment distance L21 is exceeded, the estimated value R11 for the traveling road is prioritized and the obstacle judgment area is set. Set (step S173) and return.
【0114】従って、図35に示すように、障害物判断
の要求が特に高い障害物判断距離L21までは、走行路の
白線部についての推定値(曲率半径)Rl ,Rr を優先
して領域の設定をすることとなり、むやみに障害物判定
領域を大きくすることがないので、効率よく障害物判断
をすることができる。Therefore, as shown in FIG. 35, the estimated values (radius of curvature) Rl and Rr for the white line portion of the road are prioritized until the obstacle judgment distance L21 where the obstacle judgment request is particularly high. Since the setting is performed and the obstacle determination area is not unnecessarily enlarged, the obstacle determination can be efficiently performed.
【0115】尚、ステップS171 において進行路につい
ての推定値(曲率半径)R11が優先される場合には、障
害物判断距離内も、障害物判断距離を越えても、進行路
についての推定値R11が優先される。When the estimated value (curvature radius) R11 for the traveling road is prioritized in step S171, the estimated value R11 for the traveling road is obtained within the obstacle judgment distance and beyond the obstacle judgment distance. Has priority.
【0116】(13)障害物の大きさに基づく補正 図36に示すように、スタートすると、まず、走行路に
ついての推定値Rl ,Rr ,R11がすべて略等しいか否
かを判定し(ステップS181 )、等しければステップS
182 に移行し、障害物の動きについて、相対速度V1 が
自車速V0 に等しいか否かを判定する一方、等しくなけ
れば、直ちにリターンする。(13) Correction Based on Obstacle Size As shown in FIG. 36, when starting, it is first determined whether or not the estimated values Rl, Rr, R11 for the traveling path are all substantially equal (step S181). ), If equal then step S
At 182, it is determined whether or not the relative speed V1 is equal to the own vehicle speed V0 regarding the movement of the obstacle, and if not, the process immediately returns.
【0117】相対速度が自車速に等しいと障害物は移動
していないので、ステップS183 に移行し、障害物の幅
が所定値より小さいか否かを判定する一方、小さくない
と、路側固定構造部であると判断し、推定値R11を優先
し(ステップS184 )、走行路を設定し(ステップS18
5 )、リターンする。If the relative speed is equal to the own vehicle speed, the obstacle has not moved. Therefore, the routine proceeds to step S183, where it is judged whether or not the width of the obstacle is smaller than a predetermined value. It is determined that the group is a copy, the estimated value R11 is prioritized (step S184), and the traveling path is set (step S18)
5) return.
【0118】また、障害物の大きさが所定値以下であれ
ば、推定値Rl ,Rr を優先し(ステップS186 )、走
行領域を設定し(ステップS185 )、リターンする。If the size of the obstacle is less than the predetermined value, the estimated values Rl and Rr are given priority (step S186), the travel area is set (step S185), and the process returns.
【0119】(9) 左右の白線部の曲率半径のうち一方の
みが、車両状態量による曲率半径に一致する場合の制御 具体的には、図37に示すように、スタートすると、例
えば走行路推定手段によって推定された走行路の左白線
部についての推定値Rl が進行路推定手段によって推定
された進行路についての推定値R11に略等しく、かつ右
側白線部についての推定値Rr が検出不能であるか否か
を判定する(ステップS191 )。(9) Control in the case where only one of the radii of curvature of the left and right white line parts matches the radius of curvature of the vehicle state quantity Specifically, as shown in FIG. The estimated value Rl for the left white line portion of the traveling road estimated by the means is approximately equal to the estimated value R11 for the traveling road estimated by the traveling road estimating means, and the estimated value Rr for the right white line portion is undetectable. It is determined whether or not (step S191).
【0120】YESであれば、右側のスキャンエリアを
左側にシフトし(ステップS192 )、Rr が検出される
か否かを判定する(ステップS193 )一方、NOであれ
ば、そのままリターンする。If YES, the right scan area is shifted to the left (step S192), and it is determined whether or not Rr is detected (step S193). If NO, the process directly returns.
【0121】ステップS193 の判定において、YESで
あれば、現在偏差で判定できるか否かを判定し(ステッ
プS194 )、できれば、車線上を走行しているいわゆる
車線またぎであると判断して(ステップS195 )、推定
値Rl ,Rr より車線幅を推定し、リターンする一方、
NOであれば、推定値Rl を基準に、白線の過去の履歴
を利用して車線幅を推定し(ステップS196 )、リター
ンする。If YES in the determination in step S193, it is determined whether or not the current deviation can be determined (step S194), and if possible, it is determined that it is a so-called lane crossing traveling on a lane (step S194). S195), the lane width is estimated from the estimated values Rl and Rr, and the process returns, while
If NO, the lane width is estimated using the past history of the white line based on the estimated value Rl (step S196), and the process returns.
【0122】[0122]
【発明の効果】請求項1に係る発明は、上記のように、
各走行路推定手段により推定された走行路の信頼度を信
頼度演算手段にて演算し、そして走行路の信頼度の値相
互の差がしきい値以上となるとき、走行領域推定手段に
よって上記各走行路推定手段により推定された走行路を
比較し、多数決により走行路を最終的に選定するように
しているので、複数の走行路推定手段を有する場合に、
各推定手段による推定値が異なる場合であっても、精度
よく走行路を推定することができる。The invention according to claim 1 has the following features.
The reliability of the traveling road estimated by each traveling road estimating means is calculated by the reliability calculating means, and when the difference between the reliability values of the traveling road is equal to or more than a threshold value, the traveling area estimating means performs Since the running paths estimated by the respective running path estimating means are compared and the running path is finally selected by the majority decision, when a plurality of running path estimating means are provided,
Even if the estimation values obtained by the estimation means are different, it is possible to accurately estimate the traveling path.
【0123】請求項2に係る発明は、画像処理に基づき
路面上の左右の白線部を検出し、該左右の白線部に基づ
き自車が今後走行すると予想される走行路を推定するよ
うにしているので、広い走行路を推定することができ
る。According to the second aspect of the present invention, the left and right white line portions on the road surface are detected based on the image processing, and based on the left and right white line portions, it is possible to estimate the traveling road on which the vehicle is expected to travel in the future. Therefore, it is possible to estimate a wide traveling path.
【0124】請求項3に係る発明は、障害物判断距離を
越える領域では、第1走行路推定手段により推定された
走行路に基づく領域を優先させるようにしているので、
障害物判断の必要な領域において広い走行路を推定する
ことができる。。According to the third aspect of the present invention, in the area exceeding the obstacle judgment distance, the area based on the traveling road estimated by the first traveling road estimating means is prioritized.
It is possible to estimate a wide traveling road in an area where obstacle judgment is required. .
【0125】請求項4に係る発明は、白線候補点の検出
可能距離を越えると、第1走行路推定手段に基づく領域
を優先させるので、無駄なく走行路の推定を行うことが
できる。According to the fourth aspect of the present invention, when the distance over which the white line candidate points can be detected is exceeded, the area based on the first traveling road estimating means is prioritized, so that the traveling road can be estimated without waste.
【0126】請求項5に係る発明は、検知率、推定時間
の係数により重み付けを行った多数決判定式により走行
路を決定するようにしているので、簡単に走行路の推定
をすることができる。According to the fifth aspect of the present invention, the road is determined by the majority decision formula weighted by the coefficient of the detection rate and the coefficient of the estimated time. Therefore, the road can be easily estimated.
【0127】請求項6に係る発明は、自車前方の環境を
考慮して走行路を推定するようにしているので、走行路
の推定の精度を高めることができる。In the invention according to claim 6, since the traveling path is estimated in consideration of the environment in front of the host vehicle, the accuracy of estimation of the traveling path can be improved.
【0128】請求項7に係る発明は、障害物の大きさ及
び動きに基づいて、第1走行路推定手段による推定値又
は第2走行路推定手段による推定値を選択するようにし
ているので、障害物に応じて走行路を推定することがで
きる。According to the seventh aspect of the invention, the estimated value by the first traveling road estimating means or the estimated value by the second traveling road estimating means is selected based on the size and movement of the obstacle. It is possible to estimate the traveling path according to the obstacle.
【0129】請求項8に係る発明は、第1及び第2走行
路推定手段による推定に加えて、第3走行路推定手段に
よる推定も考慮して、走行路を推定するようにしている
ので、精度よく走行路を推定することが可能である。In the invention according to claim 8, the traveling road is estimated in consideration of the estimation by the third traveling road estimating means in addition to the estimation by the first and second traveling road estimating means. It is possible to accurately estimate the traveling path.
【図1】自動車の斜視図である。FIG. 1 is a perspective view of an automobile.
【図2】制御系のブロック図である。FIG. 2 is a block diagram of a control system.
【図3】コントロールユニットのブロック図である。FIG. 3 is a block diagram of a control unit.
【図4】障害物検知の処理の流れを示す流れ図である。FIG. 4 is a flowchart showing a flow of an obstacle detection process.
【図5】走行路推定の基本制御を示す流れ図である。FIG. 5 is a flow chart showing basic control of travel route estimation.
【図6】逆光判定の制御を示す流れ図である。FIG. 6 is a flowchart showing the control of backlight determination.
【図7】車両状態量に基づく進行路推定のサブルーチン
を示す流れ図である。FIG. 7 is a flow chart showing a subroutine of traveling path estimation based on a vehicle state quantity.
【図8】先行車両に基づく進行路推定のサブルーチンを
示す流れ図である。FIG. 8 is a flow chart showing a subroutine of traveling path estimation based on a preceding vehicle.
【図9】画像処理に基づく走行路推定のサブルーチンを
示す流れ図である。FIG. 9 is a flowchart showing a subroutine of roadway estimation based on image processing.
【図10】CCDカメラのピッチ角補正の説明図であ
る。FIG. 10 is an explanatory diagram of pitch angle correction of a CCD camera.
【図11】CCDカメラのピッチ角補正のサブルーチン
を示す流れ図である。FIG. 11 is a flowchart showing a subroutine of pitch angle correction of the CCD camera.
【図12】信頼度演算のサブルーチンを示す流れ図であ
る。FIG. 12 is a flowchart showing a subroutine of reliability calculation.
【図13】同流れ図である。FIG. 13 is the same flowchart.
【図14】推定値の変化率と信頼度との関係を示す図で
ある。FIG. 14 is a diagram showing a relationship between a change rate of an estimated value and reliability.
【図15】白線部の実線と破線との説明図である。FIG. 15 is an explanatory diagram of a solid line and a broken line of a white line portion.
【図16】信頼度が高いものを決定する制御のサブルー
チンを示す流れ図である。FIG. 16 is a flowchart showing a control subroutine for determining one with high reliability.
【図17】同流れ図である。FIG. 17 is the same flowchart.
【図18】信頼度演算のサブルーチンを示す流れ図であ
る。FIG. 18 is a flowchart showing a subroutine of reliability calculation.
【図19】多数決により推定値を決定する制御の流れ図
である。FIG. 19 is a flow chart of control for determining an estimated value by majority voting.
【図20】推定値の関係を示す図である。FIG. 20 is a diagram showing a relationship between estimated values.
【図21】推定値の関係を示す図である。FIG. 21 is a diagram showing a relationship between estimated values.
【図22】推定値の関係を示す図である。FIG. 22 is a diagram showing a relationship between estimated values.
【図23】推定値の関係を示す図である。FIG. 23 is a diagram showing a relationship between estimated values.
【図24】推定値の関係を示す図である。FIG. 24 is a diagram showing a relationship between estimated values.
【図25】推定値の関係を示す図である。FIG. 25 is a diagram showing a relationship between estimated values.
【図26】変形例を示す流れ図である。FIG. 26 is a flowchart showing a modified example.
【図27】ヘッドランプ補正のサブルーチンを示す流れ
図である。FIG. 27 is a flowchart showing a headlamp correction subroutine.
【図28】ヘッドランプ補正の説明図である。FIG. 28 is an explanatory diagram of headlamp correction.
【図29】同説明図である。FIG. 29 is an explanatory diagram of the same.
【図30】白線候補点の検出距離の説明図である。FIG. 30 is an explanatory diagram of a detection distance of a white line candidate point.
【図31】白線部候補点の検出距離に基づく補正のサブ
ルーチンを示す流れ図である。FIG. 31 is a flowchart showing a subroutine of correction based on the detection distance of a white line portion candidate point.
【図32】レーザデータによる補正のサブルーチンを示
す流れ図である。FIG. 32 is a flowchart showing a subroutine of correction based on laser data.
【図33】レーザデータによる補正の説明図である。FIG. 33 is an explanatory diagram of correction based on laser data.
【図34】障害物判断距離による補正のサブルーチンを
示す流れ図である。FIG. 34 is a flowchart showing a subroutine of correction based on an obstacle judgment distance.
【図35】同説明図である。FIG. 35 is an explanatory diagram of the same.
【図36】障害物の大きさ等に基づく補正のサブルーチ
ンを示す流れ図である。FIG. 36 is a flowchart showing a subroutine for correction based on the size of an obstacle or the like.
【図37】車線またぎの判定のサブルーチンを示す流れ
図である。FIG. 37 is a flowchart showing a lane crossing determination subroutine.
1 自動車 6 コントロールユニット 6A 障害物検出手段 6B 第1走行路路推定手段 6C 第2走行路推定手段 7 車速センサ 8 舵角センサ 9 ヨーレートセンサ 27 信頼度演算手段 28 走行領域設定手段 30 領域補正手段 1 Car 6 Control Unit 6A Obstacle Detecting Means 6B First Driving Road Estimating Means 6C Second Driving Road Estimating Means 7 Vehicle Speed Sensor 8 Steering Angle Sensor 9 Yaw Rate Sensor 27 Reliability Calculating Means 28 Traveling Area Setting Means 30 Area Correcting Means
───────────────────────────────────────────────────── フロントページの続き (72)発明者 足立 智彦 広島県安芸郡府中町新地3番1号 マツダ 株式会社内 (72)発明者 中植 宏志 広島県安芸郡府中町新地3番1号 マツダ 株式会社内 ─────────────────────────────────────────────────── ─── Continuation of the front page (72) Inventor Tomohiko Adachi No. 3 Shinchi, Fuchu-cho, Aki-gun, Hiroshima Prefecture Mazda Co., Ltd. (72) Inventor Hiroshi Nakaue No. 3 Shinchi, Fuchu-cho, Aki-gun, Hiroshima Mazda Stock In the company
Claims (8)
行路推定手段とを備える自動車の走行路推定装置におい
て、 上記各走行路推定手段により推定された走行路の信頼度
を演算する信頼度演算手段と、 該信頼度演算手段の出力を受け、走行路の信頼度の値相
互の差がしきい値を越えるとき、上記各走行路推定手段
により推定された走行路を比較し、多数決により走行路
を最終的に選定し、走行領域を推定する走行領域推定手
段を備えることを特徴とする自動車の走行路推定装置。1. A travel route estimation device for a vehicle, comprising: a plurality of travel route estimation means for estimating a future travel route of a vehicle; calculating reliability of the travel route estimated by each of the travel route estimation means. When the difference between the reliability values of the traveling paths exceeds a threshold value by receiving the output of the reliability calculating means and the reliability calculating means, the traveling paths estimated by the respective traveling path estimating means are compared, A travel route estimating device for an automobile, comprising: a travel region estimating means for finally selecting a travel route by majority decision and estimating a travel region.
自車が今後走行すると予想される第1の進行路を走行路
として推定する第1走行路推定手段と、画像処理に基づ
き、路面上の白線部を構成すると想定される白線候補点
を検出し、該白線候補点に基づき白線部を推定し、自車
が今後走行すると予想される走行路を推定する第2走行
路推定手段とを備えるところの請求項1記載の自動車の
走行路推定装置。2. The traveling road estimating means estimates, as a traveling road, a first traveling road on which the own vehicle is expected to travel in the future based on the vehicle state quantity, and a road surface based on image processing. A second travel route estimating means for detecting a white line candidate point which is supposed to constitute the upper white line portion, estimating the white line portion based on the white line candidate point, and estimating a travel route where the own vehicle is expected to travel in the future; The vehicle travel path estimation device according to claim 1, further comprising:
係数等に基づき障害物判断距離を演算する距離演算手段
と、 該距離演算手段の出力を受け、障害物判断距離を越える
領域においては、走行領域推定手段による走行領域の推
定に際し、第1走行路推定手段による推定を優先させる
領域補正手段を備えるところの請求項2記載の自動車の
走行路推定装置。3. A distance calculation means for calculating an obstacle judgment distance based on a vehicle speed, a relative speed, a friction coefficient of a road surface, and the like, and an area which exceeds an obstacle judgment distance when an output of the distance calculation means is received. 3. The traveling path estimation device for an automobile according to claim 2, further comprising area correction means for prioritizing the estimation by the first traveling path estimation means when estimating the traveling area by the traveling area estimation means.
候補点の検出可能距離を演算する距離演算手段と、 該距離演算手段の出力を受け、白線候補点の検出可能距
離を越える領域においては、走行領域推定手段による走
行領域の推定に際し、第1走行路推定手段による推定を
優先させる領域補正手段とを備えるところの請求項2記
載の自動車の走行路推定装置。4. A distance calculating means for calculating a detectable distance of a white line candidate point by the second traveling road estimating means, and an area which receives an output of the distance calculating means and exceeds the detectable distance of the white line candidate point. 3. The vehicle travel path estimation device according to claim 2, further comprising area correction means for prioritizing the estimation by the first travel path estimation means when the travel area estimation means estimates the travel area.
に対し、検知率、検知時間の係数により重み付けを行っ
て、走行路を最終的に決定し、走行領域を推定するもの
であるところの請求項2記載の自動車の走行路推定装
置。5. The travel area estimating means weights the estimated travel path with a coefficient of a detection rate and a detection time, finally determines the travel path, and estimates the travel area. The vehicle travel path estimation device according to claim 2.
を備え、走行領域推定手段が、環境検出手段の出力を受
け、該環境を考慮して走行路を選定し、走行領域を推定
するものであるところの請求項2記載の自動車の走行路
推定装置。6. An environment detecting means for detecting an environment in front of the own vehicle, wherein the traveling area estimating means receives an output of the environment detecting means, selects a traveling path in consideration of the environment, and estimates a traveling area. The traveling path estimation device for an automobile according to claim 2, which is a vehicle.
手段を備え、 走行領域推定手段が、障害物検出手段の出力を受け、障
害物の大きさ及び動きに基づいて、第1走行路推定手段
による推定又は第2走行路推定手段による推定のいずれ
を優先するかを決定するものであるところの請求項2記
載の自動車の走行路推定装置。7. An obstacle detecting means for detecting an obstacle in front of the vehicle, wherein the traveling area estimating means receives the output of the obstacle detecting means, and based on the size and the movement of the obstacle, the first traveling path. 3. The traveling path estimating device for a vehicle according to claim 2, wherein which of the estimation by the estimating means and the estimation by the second traveling path estimating means is prioritized.
量に基づき第2の進行路を走行路として推定する第3走
行路推定手段とを備えるところの請求項2記載の自動車
の走行路推定装置。8. The traveling road of the automobile according to claim 2, further comprising a third traveling road estimating means for estimating the second traveling road as a traveling road based on the vehicle state quantity of the vehicle preceding the own vehicle. Estimator.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP10642894A JP3352528B2 (en) | 1994-05-20 | 1994-05-20 | Vehicle travel path estimation device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP10642894A JP3352528B2 (en) | 1994-05-20 | 1994-05-20 | Vehicle travel path estimation device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH07319541A true JPH07319541A (en) | 1995-12-08 |
| JP3352528B2 JP3352528B2 (en) | 2002-12-03 |
Family
ID=14433395
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP10642894A Expired - Lifetime JP3352528B2 (en) | 1994-05-20 | 1994-05-20 | Vehicle travel path estimation device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3352528B2 (en) |
Cited By (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10307998A (en) * | 1997-05-07 | 1998-11-17 | Nippon Soken Inc | Automatic steering device for vehicles |
| JPH1139598A (en) * | 1997-07-17 | 1999-02-12 | Fuji Heavy Ind Ltd | Collision preventing device for vehicle |
| JP2001296138A (en) * | 2000-04-13 | 2001-10-26 | Honda Motor Co Ltd | Travel curvature calculation device |
| JP2002131432A (en) * | 2000-10-24 | 2002-05-09 | Honda Motor Co Ltd | Vehicle travel trajectory prediction device |
| JP2003058997A (en) * | 2001-08-09 | 2003-02-28 | Nissan Motor Co Ltd | Roadway environment detection device |
| JP2006113627A (en) * | 2004-10-12 | 2006-04-27 | Honda Motor Co Ltd | Vehicle control object determination device |
| US7974778B2 (en) | 2004-09-17 | 2011-07-05 | Honda Motor Co., Ltd. | Vehicular control object determination system and vehicular travel locus estimation system |
| JP2011248638A (en) * | 2010-05-27 | 2011-12-08 | Nissan Motor Co Ltd | Road environment information acquiring apparatus and method of the same |
| US8385601B2 (en) | 2010-03-08 | 2013-02-26 | Nippon Soken, Inc. | In-vehicle white line recognition apparatus |
| US8744194B2 (en) | 2009-04-09 | 2014-06-03 | Denso Corporation | Boundary line recognition apparatus |
| JP2018511505A (en) * | 2014-11-06 | 2018-04-26 | オートリブ ディベロップメント エービー | System and method for vehicle route prediction |
| JP6407447B1 (en) * | 2017-01-10 | 2018-10-17 | 三菱電機株式会社 | Traveling path recognition device and traveling path recognition method |
| EP3835824A1 (en) * | 2019-12-12 | 2021-06-16 | Aptiv Technologies Limited | Adaptive object in-path detection model for automated or semi-automated vehicle operation |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR101976392B1 (en) * | 2012-11-28 | 2019-05-09 | 현대모비스 주식회사 | System by detection of lane marking |
-
1994
- 1994-05-20 JP JP10642894A patent/JP3352528B2/en not_active Expired - Lifetime
Cited By (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10307998A (en) * | 1997-05-07 | 1998-11-17 | Nippon Soken Inc | Automatic steering device for vehicles |
| JPH1139598A (en) * | 1997-07-17 | 1999-02-12 | Fuji Heavy Ind Ltd | Collision preventing device for vehicle |
| JP2001296138A (en) * | 2000-04-13 | 2001-10-26 | Honda Motor Co Ltd | Travel curvature calculation device |
| JP2002131432A (en) * | 2000-10-24 | 2002-05-09 | Honda Motor Co Ltd | Vehicle travel trajectory prediction device |
| JP2003058997A (en) * | 2001-08-09 | 2003-02-28 | Nissan Motor Co Ltd | Roadway environment detection device |
| US7974778B2 (en) | 2004-09-17 | 2011-07-05 | Honda Motor Co., Ltd. | Vehicular control object determination system and vehicular travel locus estimation system |
| JP2006113627A (en) * | 2004-10-12 | 2006-04-27 | Honda Motor Co Ltd | Vehicle control object determination device |
| US8744194B2 (en) | 2009-04-09 | 2014-06-03 | Denso Corporation | Boundary line recognition apparatus |
| US8385601B2 (en) | 2010-03-08 | 2013-02-26 | Nippon Soken, Inc. | In-vehicle white line recognition apparatus |
| JP2011248638A (en) * | 2010-05-27 | 2011-12-08 | Nissan Motor Co Ltd | Road environment information acquiring apparatus and method of the same |
| JP2018511505A (en) * | 2014-11-06 | 2018-04-26 | オートリブ ディベロップメント エービー | System and method for vehicle route prediction |
| JP6407447B1 (en) * | 2017-01-10 | 2018-10-17 | 三菱電機株式会社 | Traveling path recognition device and traveling path recognition method |
| EP3835824A1 (en) * | 2019-12-12 | 2021-06-16 | Aptiv Technologies Limited | Adaptive object in-path detection model for automated or semi-automated vehicle operation |
| US11400926B2 (en) | 2019-12-12 | 2022-08-02 | Aptiv Technologies Limited | Adaptive object in-path detection model for automated or semi-automated vehicle operation |
Also Published As
| Publication number | Publication date |
|---|---|
| JP3352528B2 (en) | 2002-12-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3400092B2 (en) | Vehicle travel path estimation device | |
| JP6410949B2 (en) | Lane recognition device and lane recognition method | |
| US7532109B2 (en) | Vehicle obstacle verification system | |
| EP2273233B1 (en) | Reliability evaluation device, reliability evaluation method, and reliability evaluation program | |
| JP3352528B2 (en) | Vehicle travel path estimation device | |
| US10752223B2 (en) | Autonomous emergency braking system and method for vehicle at crossroad | |
| JP2004531424A (en) | Sensing device for cars | |
| JP7371269B2 (en) | Method and device for calibrating camera pitch of a car, and method for continuously learning a vanishing point estimation model for the purpose | |
| GB2276481A (en) | Vehicle-surroundings monitoring apparatus | |
| JP3588814B2 (en) | Vehicle obstacle detection device | |
| JP2020057146A (en) | Traveling lane estimation device, traveling lane estimation method, and control program | |
| JP3794041B2 (en) | Vehicle obstacle detection device | |
| JP2025061981A (en) | Vehicle control device and vehicle control method | |
| CN115042784A (en) | Automobile adaptive cruise system control method, device, vehicle and storage medium | |
| JP5682302B2 (en) | Traveling road estimation device, method and program | |
| CN109427212B (en) | Vehicle running detection method and vehicle running detection system | |
| JP4082286B2 (en) | Front object position detection device | |
| JP3400088B2 (en) | Vehicle travel path estimation device | |
| US12411235B2 (en) | Object detection device, object detection method, and computer-readable storage medium | |
| JP2006048568A (en) | Object recognition method and object recognizing device | |
| JPH09288179A (en) | Vehicle curve diameter estimation device and target preceding vehicle detection device | |
| JP2006168628A (en) | Collision prevention supporting method and device | |
| JP5103722B2 (en) | Stop vehicle discrimination device | |
| JP2006040029A (en) | Obstacle recognition method and obstacle recognition device | |
| JPH05113482A (en) | Rear end collision prevention device mounted on car |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20020903 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080920 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090920 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100920 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110920 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110920 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120920 Year of fee payment: 10 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130920 Year of fee payment: 11 |
|
| EXPY | Cancellation because of completion of term |