JPH07220199A - Travel controller for automobile - Google Patents

Travel controller for automobile

Info

Publication number
JPH07220199A
JPH07220199A JP6292729A JP29272994A JPH07220199A JP H07220199 A JPH07220199 A JP H07220199A JP 6292729 A JP6292729 A JP 6292729A JP 29272994 A JP29272994 A JP 29272994A JP H07220199 A JPH07220199 A JP H07220199A
Authority
JP
Japan
Prior art keywords
vehicle
traveling
traveling path
preceding vehicle
road
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP6292729A
Other languages
Japanese (ja)
Other versions
JP3582071B2 (en
Inventor
Tomomi Izumi
知示 和泉
Kenji Shimizu
賢治 清水
Yoshiaki Sugamoto
好晃 菅本
Satoru Ando
悟 安藤
Kazunori Okuda
和徳 奥田
Toshihiro Ishihara
敏広 石原
Takahiro Inada
貴裕 稲田
Tsunehisa Okuda
恒久 奥田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mazda Motor Corp
Original Assignee
Mazda Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mazda Motor Corp filed Critical Mazda Motor Corp
Priority to JP29272994A priority Critical patent/JP3582071B2/en
Publication of JPH07220199A publication Critical patent/JPH07220199A/en
Application granted granted Critical
Publication of JP3582071B2 publication Critical patent/JP3582071B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

PURPOSE:To suitably detect a preceding vehicle on a traveling route when the traveling direction of a present vehicle is estimated in an instable state. CONSTITUTION:This device is provided with an object detecting means 7 for detecting an object existent in front of the present vehicle, first traveling route estimating means 22 for estimating the first traveling route to travel the present vehicle, preceding vehicle identifying means 23 for identifying the preceding vehicle to be the object vehicle of the present vehicle (such as the preceding vehicle closest to the present vehicle, for example,) from the preceding vehicles, which are detected by the object detecting means, existent on the first traveling route, and second traveling route estimating means 24 for estimating the second traveling route of the present vehicle based on the preceding vehicle when this preceding vehicle gets out of the first traveling route at least, and the preceding vehicle identifying means is provided to identify the preceding vehicle to be the object vehicle of the present vehicle from the preceding vehicle existent on the first traveling route and the preceding vehicle existent on the second traveling route when the preceding vehicle gets out of this first traveling route.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、自動車の走行制御装置
に係わり、特に、先行車に追従して走行したり先行車と
の衝突を防止するようにした自動車の走行制御装置に関
する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a vehicle drive control device, and more particularly, to a vehicle drive control device for following a preceding vehicle and preventing collision with the preceding vehicle.

【0002】[0002]

【従来の技術】従来より、この種の自動車の走行制御装
置に用いられる自動車用障害物検出装置として、例えば
特公昭51−7892号公報に開示されるように、自車
の前方に向けて超音波や電波等のレーダ波を発信して前
方に存在する先行車等の障害物を検出するレーダ装置
と、該レーダ装置を水平方向に回動させる回動手段と、
自車のステアリング舵角を検出する舵角検出手段とを備
え、上記舵角検出手段で検出される舵角に応じて、上記
回動手段によって上記レーダ装置を所定角度回動して、
自車両が走行する方向にレーダ波を向けるようにしたも
のは知られている。また、近年、レーダ装置としてスキ
ャン式のものを用いて水平方向に比較的広角度でもって
走査を行う一方、その走査で得られる情報の中から、マ
イクロコンピュータを利用して、自車のステアリング舵
角やヨーレート等の走行状態に基づいて予測される自車
両の進行路に沿って領域内のもののみをピックアップす
ることにより、レーダ装置による障害物の検出をソフト
的に上記領域内に限定して行うようにしたものが開発さ
れている。
2. Description of the Related Art Conventionally, as an automobile obstacle detection device used in a vehicle traveling control device of this type, as disclosed in, for example, Japanese Examined Patent Publication No. 51-7892, it is possible to use a supercharger in front of the vehicle. A radar device that emits a radar wave such as a sound wave or a radio wave to detect an obstacle such as a preceding vehicle in front of the radar device, and a rotating unit that horizontally rotates the radar device,
A steering angle detection means for detecting the steering angle of the host vehicle, and in accordance with the steering angle detected by the steering angle detection means, the rotation means rotates the radar device by a predetermined angle,
It is known that the radar wave is directed in the direction in which the host vehicle travels. Further, in recent years, a scanning type radar device is used to perform scanning at a relatively wide angle in the horizontal direction, and a microcomputer is used to extract the steering steering of the vehicle from the information obtained by the scanning. By picking up only those in the area along the travel route of the vehicle predicted based on the driving condition such as the corner and yaw rate, the radar device can limit the detection of obstacles by the software within the above area. The ones that are supposed to be done are being developed.

【0003】[0003]

【発明が解決しようとする課題】ところが、上記従来の
障害物検出装置では、レーダ装置による先行車の検出を
自車の進行路に沿った領域内に限定することをハード的
又はソフト的のいずれで行う場合でも、自車の走行状態
に基づいて自車の進行路を予測しているため、直線道路
から曲線道路へ進入するときに次のような問題がある。
すなわち、先行車が直線道路から曲線道路へ進入し、自
車が未だ曲線道路に進入していないときには、先行車は
自車の進行路から外れるため、曲線道路上で先行車と自
車との間に割り込んで来る車を早期に検出することがで
きないという問題である。本発明はかかる点に鑑みてな
されたものであり、自車の進行方向の推定が不安定な状
態のときに進行路上の先行車の検出を適切に行うことが
できる自動車の走行制御装置を提供することを目的とし
ている。また、本発明は、自車の走行状態等に基づいて
予測する第1の進行路と、先行車の位置に基づいて予測
する第2の進行路とを併用することにより、曲線道路上
で先行車と自車との間に割り込んで来る車をも早期に検
出できるようにし、先行車の検出を適切に行うことがで
きる自動車の走行制御装置を提供することを目的として
いる。
However, in the above-mentioned conventional obstacle detection device, it is hard or soft to limit the detection of the preceding vehicle by the radar device to the area along the traveling path of the own vehicle. Even in the case of, the traveling route of the own vehicle is predicted based on the traveling state of the own vehicle, so that there is the following problem when entering a curved road from a straight road.
That is, when a preceding vehicle enters a curved road from a straight road and the own vehicle has not entered the curved road yet, the preceding vehicle deviates from the traveling path of the own vehicle, and therefore, the preceding vehicle and the own vehicle on the curved road The problem is that cars that come in between cannot be detected early. The present invention has been made in view of the above point, and provides a vehicle traveling control device capable of appropriately detecting a preceding vehicle on a traveling road when the estimation of the traveling direction of the vehicle is unstable. The purpose is to do. Further, the present invention uses the first traveling path predicted based on the traveling state of the own vehicle and the second traveling path predicted based on the position of the preceding vehicle in combination to lead the vehicle on the curved road. It is an object of the present invention to provide a vehicle traveling control device that enables early detection of a vehicle that comes in between a vehicle and its own vehicle and can appropriately detect a preceding vehicle.

【0004】[0004]

【課題を解決するための手段及び作用】上記の目的を達
成するために請求項1記載の第1の発明の自動車の走行
制御装置は、自車の前方に存在する物体を検出する物体
検出手段と、自車が走行すべき第1進行路を推定する第
1進行路推定手段と、上記物体検出手段により検出され
た上記第1進行路上に存在する先行車の中から自車の対
象車となる先行車を識別する先行車識別手段と、少なく
とも上記先行車が第1進行路から外れたときこの先行車
に基づいて自車の第2進行路を推定する第2進行路推定
手段と、を有し、上記先行車識別手段は、上記先行車が
第1進行路から外れたときこの第1進行路上に存在する
先行車と上記第2進行路上に存在する先行車の中から自
車の対象車となる先行車を識別するように設けられてい
ることを特徴としている。このように構成された第1の
発明においては、先行車が直線道路から曲線道路へ進入
して、第1の進行路から外れたときには、該先行車の位
置又は移動軌跡に基づいて、第2の進行路が第2進行路
予測手段により予測され、先行車識別手段において、上
記第1の進行路上に存在する先行車と上記第2の進行路
上に存在する先行車の中から、自車の対象車となる先行
車(例えば自車に最も近い先行車)が識別される。この
ため、曲線道路上で先行車と自車との間に割り込んで来
る車も早期に検出できることになる。
In order to achieve the above object, the traveling control device for a vehicle according to the first aspect of the invention is an object detecting means for detecting an object existing in front of the vehicle. A first traveling road estimating means for estimating a first traveling road on which the vehicle should travel, and a target vehicle of the own vehicle among preceding vehicles existing on the first traveling road detected by the object detecting means. Leading vehicle identifying means for identifying the preceding vehicle, and second traveling path estimating means for estimating the second traveling path of the own vehicle based on the preceding vehicle at least when the preceding vehicle deviates from the first traveling path. The preceding vehicle identifying means has an object of the own vehicle from preceding vehicles existing on the first traveling path and preceding vehicles existing on the second traveling path when the preceding vehicle deviates from the first traveling path. It is characterized in that it is provided to identify the preceding vehicle to be a car There. In the first aspect of the invention configured as described above, when the preceding vehicle enters the curved road from the straight road and deviates from the first traveling road, the second vehicle is determined based on the position or movement trajectory of the preceding vehicle. Is predicted by the second traveling road predicting means, and the preceding vehicle identifying means determines from the preceding vehicle existing on the first traveling road and the preceding vehicle existing on the second traveling road of the own vehicle. A preceding vehicle that is a target vehicle (for example, a preceding vehicle closest to the own vehicle) is identified. Therefore, a vehicle that comes in between the preceding vehicle and the vehicle on the curved road can be detected early.

【0005】請求項2記載の第2の発明においては、上
記第1進行路推定手段が、自車の走行状態に基づいて第
1進行路を推定するように設けられている。このように
構成された第2の発明においては、自車の走行状態(例
えば、車速、ハンドル舵角、ヨーレート等)に基づいて
第1進行路推定手段により第1進行路が推定される。請
求項3記載の第3の発明は、更に、上記第1進行路上に
存在する物体が静止物体であるか否かを判定する静止物
体判定手段を有し、上記第1進行路推定手段は、上記静
止物体判定手段により判定された静止物体の属性に基づ
いて第1進行路を推定するように設けられている。この
ように構成された第3の発明においては、静止物体判定
手段が第1進行路上に存在する物体が静止物体(路側リ
フレクタ等)であるか否かを判定し、この判定された静
止物体の属性に基づいて第1進行路が推定される。請求
項4記載の第4の発明においては、上記先行車識別手段
が、上記先行車を追従対象車として識別するように設け
られ、上記第2進行路推定手段が、この追従対象車とし
て識別された先行車に基づいて第2進行路を推定するよ
うに設けられている。
In the second aspect of the present invention, the first traveling route estimating means is provided so as to estimate the first traveling route based on the traveling state of the vehicle. In the second aspect of the invention configured as described above, the first traveling path estimation unit estimates the first traveling path based on the traveling state of the vehicle (for example, vehicle speed, steering wheel steering angle, yaw rate, etc.). A third invention according to claim 3 further has a stationary object determining means for determining whether or not the object existing on the first traveling path is a stationary object, and the first traveling path estimating means comprises: It is provided so as to estimate the first traveling path based on the attribute of the stationary object determined by the stationary object determination means. In the third aspect of the invention thus configured, the stationary object determination means determines whether the object existing on the first traveling path is a stationary object (a roadside reflector or the like), and the determined stationary object The first traveling path is estimated based on the attribute. According to a fourth aspect of the present invention, the preceding vehicle identifying means is provided so as to identify the preceding vehicle as the following target vehicle, and the second traveling path estimating means is identified as the following target vehicle. The second traveling path is estimated based on the preceding vehicle.

【0006】このように構成された第4の発明において
は、先行車識別手段により先行車が追従対象車として識
別され、さらに、この追従対象車に基づいて第2進行路
推定手段により第2進行路が推定される。請求項5に記
載の第5の発明においては、上記先行車識別手段が、上
記先行車が第1進行路から外れた時点からその外れた地
点に自車が到達するまでの間は上記第2進行路上に存在
する先行車の中から自車の対象車となる先行車を識別
し、自車がその外れた時点に到着するまでに上記先行車
が第1進行路に戻らないときは、その後第1進行路上に
存在する先行車の中から自車の対象車となる先行車を識
別するように設けられ、上記第2進行路推定手段が、こ
の識別された自車の対象車となる先行車を基にして第2
進行路を推定するように設けられている。このように構
成された第5の発明においては、曲線道路上での割込み
車の早期検出を可能にしつつ、最も危険な先行車を検出
するための対象領域が常に一つの進行路のみで足りるこ
とになり、その分上記自車の対象車となる先行車の検出
が精度良くかつ迅速に行われる。請求項6記載の第6の
発明においては、上記先行車識別手段が、上記追従対象
車として識別された先行車よりも第1進行路又は第2進
行路上に自車の追従対象車とすべき先行車が存在する場
合には、その追従対象車とすべき先行車を追従対象車と
して識別するように設けられている。
In the fourth aspect of the invention thus constituted, the preceding vehicle identifying means identifies the preceding vehicle as a follow-up target vehicle, and the second traveling path estimating means makes the second advancing based on the follow-up target vehicle. The road is estimated. According to a fifth aspect of the present invention, the preceding vehicle identifying means sets the second vehicle until the vehicle reaches the point where the preceding vehicle deviates from the first traveling path until the vehicle deviates from the first traveling path. If the preceding vehicle that is the target vehicle of the own vehicle is identified from the preceding vehicles existing on the traveling road and the preceding vehicle does not return to the first traveling path by the time the own vehicle arrives at the time of departure, then The vehicle is provided so as to identify a preceding vehicle which is a target vehicle of the own vehicle from among preceding vehicles existing on the first traveling path, and the second traveling path estimation means is a preceding vehicle which is a target vehicle of the identified own vehicle. Second based on car
It is provided to estimate the route of travel. In the fifth aspect of the invention configured as described above, the target area for detecting the most dangerous preceding vehicle is always sufficient for one traveling path while enabling early detection of an interrupting vehicle on a curved road. Accordingly, the preceding vehicle, which is the target vehicle of the own vehicle, can be detected accurately and promptly. According to a sixth aspect of the present invention, the preceding vehicle identifying means should be the subject vehicle of the subject vehicle on the first traveling path or the second traveling path of the preceding vehicle identified as the following target vehicle. When there is a preceding vehicle, the preceding vehicle that should be the following vehicle is identified as the following vehicle.

【0007】このように構成された第6の発明によれ
ば、自車の追従対象車を精度良くかつ迅速に検出するこ
とができる。請求項7記載の第7の発明においては、上
記第1進行路推定手段が、自車の前方に存在する先行車
に基づいて第1進行路を推定するように設けられてい
る。このように構成された第7の発明においては、自車
の前方に存在する先行車に基づいて第1進行路推定手段
により第1進行路が推定される。請求項8記載の第8の
発明においては、上記第2進行路推定手段により推定さ
れる第2進行路が、自車と先行車を所定幅を有するよう
に結んだものである。このように構成された第8の発明
においては、第2進行路が自車と先行車を所定幅を有す
るように結ばれる。
According to the sixth aspect of the present invention thus configured, it is possible to accurately and quickly detect the vehicle to be followed by the own vehicle. In the seventh aspect of the present invention, the first traveling path estimating means is provided so as to estimate the first traveling path based on the preceding vehicle existing ahead of the own vehicle. In the seventh aspect of the invention configured as above, the first traveling path is estimated by the first traveling path estimating means based on the preceding vehicle existing ahead of the own vehicle. According to an eighth aspect of the present invention, the second traveling path estimated by the second traveling path estimating means connects the own vehicle and the preceding vehicle so as to have a predetermined width. In the eighth aspect of the invention configured as above, the second traveling path is connected so that the own vehicle and the preceding vehicle have a predetermined width.

【0008】[0008]

【実施例】以下、本発明の一実施例について添付図面を
参照して説明する。先ず、図1乃至図13により本発明
の第1実施例を説明する。図1は、本発明の第1実施例
に係わる自動車の走行制御装置の全体構成を示す。図1
において、1はエンジン吸気系のスロットル弁(図示せ
ず)の開度を自動調整するスロットル制御装置、2は電
子制御式自動変速機(EAT)の制御装置、3は各車輪
に付与する制動力を自動調整するブレーキ制御装置であ
り、これら三種類の制御装置1〜3は、いずれも図示し
ていないがアクチュエータを有し、該各アクチュエータ
は、コントロールユニット4により制御される。すなわ
ち、コントロールユニット4は、スロットル制御装置1
のアクチュエータに対し目標スロットル開度信号を出力
して制御を行うとともに、ブレーキ制御装置3のアクチ
ュエータに対し目標ブレーキ量信号を出力して制御を行
う。またコントロールユニット4は、EAT制御装置2
のシフト位置を検出するセンサ(図示せず)からのシフ
ト位置信号を受けつつ、該EAT制御装置2のアクチュ
エータに対しシフト制御信号を出力して制御を行う。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described below with reference to the accompanying drawings. First, a first embodiment of the present invention will be described with reference to FIGS. FIG. 1 shows an overall configuration of a vehicle travel control device according to a first embodiment of the present invention. Figure 1
In the figure, 1 is a throttle control device that automatically adjusts the opening of a throttle valve (not shown) of the engine intake system, 2 is a control device for an electronically controlled automatic transmission (EAT), and 3 is a braking force applied to each wheel. The three types of control devices 1 to 3 each have an actuator (not shown), and each actuator is controlled by the control unit 4. That is, the control unit 4 is the throttle control device 1
The target throttle opening signal is output to the actuator for control, and the target brake amount signal is output to the actuator of the brake control device 3 for control. Further, the control unit 4 is the EAT control device 2
While receiving a shift position signal from a sensor (not shown) for detecting the shift position, the shift control signal is output to the actuator of the EAT control device 2 for control.

【0009】また、6は車室内のインストルメントパネ
ル等に設けられる情報表示装置であって、該情報表示装
置6は、図示していないが、上記コントロールユニット
4からの警報信号を受けて点灯する警報ランプと、コン
トロールユニット4からの自己診断信号を受けて画面表
示する表示部とを備えている。7は先行車等自車の前方
に存在する物体を検出するレーダ装置であって、該レー
ダ装置7は、レーダ波としての遠赤外線を自車の前方に
向けて発信するとともに、先行車に当たって反射してく
る反射波を受信し、その受信時点と発信時点との時間差
によって自車と物体との間の距離を判定するように構成
されており、その検出信号である車間距離信号はコント
ロールユニット4に入力される。また、上記レーダ装置
7は、遠赤外線を水平方向に比較的広角度で走査するス
キャン式のものである。さらに、11はスロットル弁の
開度を検出するスロットル開度センサ、12は車速を検
出する車速センサ、13はハンドル舵角(以下、単に舵
角という)を検出する舵角センサ、14は自車に発生す
るヨーレートを検出するヨーレートセンサ、15は自車
に発生する横加速度を検出する横Gセンサ、16はブレ
ーキペダルの踏込み時にON作動するブレーキスイッ
チ、17はクラッチの作動状態に応じてON作動するク
ラッチスイッチ、18はロックオンスイッチであり、こ
れらセンサ・スイッチ類11〜18の検出信号は、いず
れもコントロールユニット4に入力される。尚、図示し
ていないエンジン回転数センサ等その他のセンサ・スイ
ッチ類の検出信号もコントロールユニット4に入力され
る。
Reference numeral 6 denotes an information display device provided on an instrument panel or the like in the vehicle compartment. The information display device 6 is turned on when an alarm signal from the control unit 4 is received although not shown. An alarm lamp and a display unit for displaying a screen upon receiving a self-diagnosis signal from the control unit 4 are provided. Reference numeral 7 denotes a radar device for detecting an object existing in front of the own vehicle such as a preceding vehicle. The radar device 7 emits far infrared rays as a radar wave toward the front of the own vehicle and reflects the preceding vehicle. The incoming reflected wave is received, and the distance between the vehicle and the object is determined based on the time difference between the reception time and the transmission time. Entered in. The radar device 7 is a scan type device that scans far infrared rays in a horizontal direction at a relatively wide angle. Further, 11 is a throttle opening sensor that detects the opening of the throttle valve, 12 is a vehicle speed sensor that detects the vehicle speed, 13 is a steering angle sensor that detects the steering angle of the steering wheel (hereinafter simply referred to as steering angle), and 14 is the vehicle. A yaw rate sensor that detects the yaw rate that occurs in the vehicle, a lateral G sensor that detects the lateral acceleration that occurs in the vehicle, 16 is a brake switch that is turned on when the brake pedal is depressed, and 17 is turned on according to the operating state of the clutch. The clutch switches 18 and 18 are lock-on switches, and the detection signals of these sensor switches 11 to 18 are all input to the control unit 4. Incidentally, detection signals of other sensors and switches (not shown) such as an engine speed sensor are also input to the control unit 4.

【0010】図2に示すように、上記コントロールユニ
ット4は、レーダ装置7からの検出信号を始め、各種の
センサ・スイッチ類11〜18からの検出信号を受けて
所定の情報処理を行う入力情報処理部21と、該入力情
報処理部21から自車の走行状態に関する情報(例えば
車速、ハンドル舵角及びヨーレート等)を受け、これに
基づいて自車の第1の進行路を推定する第1進行路推定
手段22と、上記入力情報処理部21の情報のうち、特
にレーダ装置7で検出された物体に関する情報を受ける
とともに、上記第1進行路推定手段22で推定された第
1進行路の情報を入手する先行車識別手段23とを備え
ている。該先行車識別手段23は、レーダ装置7で検出
された物体の中から、上記第1進行路上に存在する自車
に最も近い先行車を識別するように設けられている。ま
た、上記コントロールユニット4は、上記第1進行路推
定手段22とは別に自車の第2進行路を推定する第2進
行路推定手段24を備えており、該第2進行路推定手段
24は、上記先行車識別手段23で識別された先行車の
位置等の情報を受け、これに基づいて第2進行路を推定
するように設けられている。第2進行路推定手段24で
推定された第2進行路の情報は、上記先行車識別手段2
3に入力され、該先行車識別手段23は、第1進行路上
の先行車が該第1進行路から外れたときつまり第1進行
路と第2進行路とが一致しなくなったとき、それらの進
行路上にそれぞれ存在する先行車の中から、自車に最も
近い先行車を識別するように設けられている。
As shown in FIG. 2, the control unit 4 receives the detection signals from the radar device 7 and the detection signals from the various sensors / switches 11 to 18 to input predetermined information. A first section that receives information (for example, vehicle speed, steering wheel steering angle, yaw rate, etc.) regarding the traveling state of the vehicle from the processing section 21 and the input information processing section 21, and estimates the first traveling path of the vehicle based on the information. Of the information of the traveling path estimating unit 22 and the input information processing unit 21, in particular, the information about the object detected by the radar device 7 is received and the first traveling path estimated by the first traveling path estimating unit 22 is received. And a preceding vehicle identifying means 23 for obtaining information. The preceding vehicle identifying means 23 is provided so as to identify the preceding vehicle closest to the own vehicle existing on the first traveling path from the objects detected by the radar device 7. Further, the control unit 4 includes a second traveling road estimating means 24 for estimating a second traveling road of the own vehicle, in addition to the first traveling road estimating means 22, and the second traveling road estimating means 24 includes It is provided so as to receive the information such as the position of the preceding vehicle identified by the preceding vehicle identifying means 23 and estimate the second traveling path based on the information. The information on the second traveling road estimated by the second traveling road estimating means 24 is the preceding vehicle identifying means 2 described above.
When the preceding vehicle on the first traveling road deviates from the first traveling road, that is, when the first traveling road and the second traveling road do not coincide with each other, It is provided so that the preceding vehicle closest to the own vehicle can be identified from the preceding vehicles existing on the traveling road.

【0011】上記先行車識別手段23で識別された自車
に最も近い先行車の情報は、識別手段23から車速制御
部25に出力される。該車速制御部25は、自車に最も
近い先行車と自車との車間距離及び相対速度に基づい
て、両者が接触する可能性があるか否かを判断し、その
判断結果に応じて、出力情報処理部26を介して出力信
号を出力するように設けられている。図3は上記コント
ロールユニット4による制御のうち、特にロックオンス
イッチ18がONに切換えられ自車が先行車に追従して
走行する追従走行時の制御のメインルーチンを示すフロ
ーチャート図である。上記ルーチンは、第1進行路の推
定(ステップS1)と、ロックオン対象車(追従対象
車)の登録(ステップS3)と、ロックオンの実行(ス
テップS5)と、ロックオンの変更及び解除(ステップ
S7)とからなる。第1進行路の推定のサブルーチンは
図4に示し、ロックオン対象車の登録のサブルーチンは
図5に示し、ロックオンの実行のサブルーチンは図6に
示し、更に、ロックオンの変更及び解除のサブルーチン
は図7及び図8に示す。以下、これらについて、順次説
明する。 (第1進行路の推定)図4において、先ず、ステップS
11で自車データ(舵角θ、車速v、ヨーレートφ)を
読み込んだ後、ステップS12で舵角θに基づいて自車
の旋回半径R11を下記の式により、演算する。
The information on the preceding vehicle closest to the own vehicle identified by the preceding vehicle identifying means 23 is output from the identifying means 23 to the vehicle speed control section 25. The vehicle speed control unit 25 determines whether there is a possibility of contact between the preceding vehicle closest to the own vehicle and the own vehicle based on the inter-vehicle distance and the relative speed, and according to the determination result, It is provided so as to output an output signal via the output information processing unit 26. FIG. 3 is a flow chart showing a main routine of control performed by the control unit 4 during follow-up running in which the lock-on switch 18 is turned ON and the vehicle follows the preceding vehicle. The above routine includes estimation of the first traveling path (step S1), registration of a lock-on target vehicle (following target vehicle) (step S3), execution of lock-on (step S5), and change and release of lock-on (step S5). And step S7). A subroutine for estimating the first traveling path is shown in FIG. 4, a subroutine for registering the lock-on target vehicle is shown in FIG. 5, a subroutine for executing lock-on is shown in FIG. 6, and a subroutine for changing and releasing lock-on is shown. Are shown in FIGS. 7 and 8. Hereinafter, these will be sequentially described. (Estimation of first traveling path) In FIG. 4, first, step S
After reading the vehicle data (steering angle θ, vehicle speed v, yaw rate φ) at 11, the turning radius R11 of the vehicle is calculated by the following formula based on the steering angle θ at step S12.

【0012】R11=(1+A・v2 )・N・L/θ 但し、Aはスタビリティファクタ、Nはステアリングギ
ヤ比、Lはホイールベースである。続いて、ステップS
13でヨーレートφに基づいて自車の旋回半径R12を
下記の式により、演算する。 R12=v/φ そして、ステップS14で上記両旋回半径R11、R1
2のうち、いずれが小さいかを判断し、ステップS1
5、16でその小さい方を第1進行路の曲率半径R1と
するとともに、ステップ17で上記曲率半径R1に所定
幅を設けて第1進行路を生成し、リターンする。ここ
で、旋回半径R11、R12の小さい方を第1進行路の
曲率半径R1としたのは、センサ類の応答遅れ等を考慮
したことによるものである。以上のような第1進行路の
予測は、コントロールユニット4内の第1進行路推定手
段22により行われる。 (ロックオン対象車の登録)図5において、先ず、ステ
ップS31で自車の前方の物体(障害物)データ(距離
及び方向)を読み込んだ後、ステップS32で物体デー
タが連続して検出されているか否かを判定し、ステップ
S33で物体データが所定のエリア内で所定の確定度以
上のものであるか否かを判定する。確定度とは時間当た
りの検出回数をいい、該確定度が所定値以上でないもの
及びデータが所定のエリア外にまで広く散在するものは
共に物体とは見做されない。上記両判定が共にYESの
ときには、ステップS34で物体と見做されたものにつ
いて物体識別番号を付与する。
R11 = (1 + A · v 2 ) · N · L / θ where A is the stability factor, N is the steering gear ratio, and L is the wheel base. Then, step S
At 13, the turning radius R12 of the vehicle is calculated based on the yaw rate φ by the following formula. R12 = v / φ Then, in step S14, both turning radii R11, R1
Which of the two is smaller is determined, and step S1
In 5 and 16, the smaller one is set as the radius of curvature R1 of the first traveling path, and in step 17, the curvature radius R1 is provided with a predetermined width to generate the first traveling path, and the process returns. Here, the smaller turning radius R11, R12 is set as the radius of curvature R1 of the first traveling path because the response delay of the sensors is taken into consideration. The prediction of the first traveling path as described above is performed by the first traveling path estimating means 22 in the control unit 4. (Registration of lock-on target vehicle) In FIG. 5, first, in step S31, object (obstacle) data (distance and direction) in front of the vehicle is read, and in step S32, object data is continuously detected. Then, it is determined in step S33 whether or not the object data has a certain degree of certainty or more in a predetermined area. The degree of certainty refers to the number of detections per hour, and both the degree of certainty that is not greater than or equal to a predetermined value and the case where data is scattered widely outside a predetermined area are not considered to be objects. When both of the above determinations are YES, the object identification number is given to the object regarded as the object in step S34.

【0013】続いて、ステップS35で上記物体識別番
号を付与した物体が移動物体であるか否かを判定する。
この判定は、実際には、自車と物体との間の距離及び自
車速に基づいて物体の速度を求め、該物体速度が所定の
しきい値以上であるか否かを検討することにより行われ
る。次に、ステップS36で物体が第1進行路上に存在
するものであるか否かを判定する。上記両判定が共にY
ESのときには、ステップS37で物体が第1進行路上
の先行車であるとしてロックオン(L/O)対象車候補
とする。しかる後、ステップS38でロックオン対象候
補になった先行車のうち自車との車間距離が最も短いも
のであるか、つまり最も近い先行車であるか否かを判定
し、この判定がYESのときには、ステップS39で該
先行車をロックオン対象車として登録し、リターンす
る。以上のようなロックオン対象車の登録は、コントロ
ールユニット4内の先行車識別手段23により行われ
る。 (ロックオンの実行)図6において、先ず、ステップS
51でロックオン対象車が登録されていることを確認し
た後、ステップS52で第2進行路の曲率半径R2を下
記の式により、演算する。
Subsequently, in step S35, it is determined whether or not the object to which the object identification number is given is a moving object.
This judgment is actually performed by obtaining the speed of the object based on the distance between the own vehicle and the object and the own vehicle speed, and examining whether the object speed is equal to or higher than a predetermined threshold value. Be seen. Next, in step S36, it is determined whether the object exists on the first traveling path. Both of the above judgments are Y
In the case of ES, in step S37, it is determined that the object is a preceding vehicle on the first traveling road and is a candidate vehicle for lock-on (L / O). Then, in step S38, it is determined whether or not the preceding vehicle that has become the lock-on target candidate has the shortest inter-vehicle distance, that is, the closest preceding vehicle, and this determination is YES. Sometimes, in step S39, the preceding vehicle is registered as a lock-on target vehicle, and the process returns. The registration of the lock-on target vehicle as described above is performed by the preceding vehicle identifying means 23 in the control unit 4. (Execution of lock-on) In FIG. 6, first, step S
After confirming that the lock-on target vehicle is registered in 51, the radius of curvature R2 of the second traveling path is calculated by the following equation in step S52.

【0014】R2=L/2√(1−cos2 θ) 図9に示すように、上記第2進行路は、自車Mに対する
先行車Aの位置に基づいて推定される自車の進行路であ
る。Lは自車Mの先行車Aとの車間距離、θは自車Mと
先行車Aとを結ぶ直線が自車Mの進行方向(前後中心
線)となす角度である。続いて、ステップS53で上記
曲率半径R2に所定幅を設けて第2進行路を生成した
後、ステップS54でロックオンを実行し、リターンす
る。ロックオンは、ロックオン対象車(追従対象車)に
対し、所定の車間距離を保ちかつ同じ車速で追従して走
行するように車速を制御するものであり、コントロール
ユニット4内の車速制御部25により行われる。また、
ステップS52、S53での第2進行路の予測は、コン
トロールユニット4内の第2進行路推定手段24により
行われる。 (ロックオンの変更及び解除)次に、ロックオンの変更
及び解除のサブルーチンを図10を参照しつつ図7及び
図8により説明する。
R2 = L / 2√ (1-cos 2 θ) As shown in FIG. 9, the second traveling path is the traveling path of the own vehicle estimated based on the position of the preceding vehicle A with respect to the own vehicle M. Is. L is the distance between the host vehicle M and the preceding vehicle A, and θ is the angle formed by the straight line connecting the host vehicle M and the preceding vehicle A with the traveling direction of the host vehicle M (front-rear center line). Subsequently, in step S53, the radius of curvature R2 is provided with a predetermined width to generate a second traveling path, and then lock-on is executed in step S54, and the process returns. The lock-on is to control the vehicle speed so that the vehicle can be driven at the same vehicle speed while keeping a predetermined vehicle-to-vehicle distance with respect to the lock-on target vehicle (following target vehicle). Done by. Also,
The prediction of the second traveling path in steps S52 and S53 is performed by the second traveling path estimating means 24 in the control unit 4. (Lock-on change and release) Next, a lock-on change and release subroutine will be described with reference to FIG. 10 and FIGS.

【0015】図7及び図8において、先ず、ステップS
71でロックオン対象車A並びに第1及び第2進行路の
曲率半径R1、R2を認識した後、ステップS72で第
1進行路の曲率半径R1と第2進行路の曲率半径R2と
が略同一であるか、つまりロックオン対象車Aが第1進
行路K1上にいるか否かを判定する。この判定がYES
のときには、第2進行路K2(第1進行路K1と同じ)
上にロックオン対象車Aより近い先行車Bが存在するか
否かを判定し、その判定がYESのときには、ステップ
S74で先行車Bをロックオン対象車とし、該先行車B
をもとに第2進行路を生成する一方、判定がNOのとき
には、ステップS75で先行車Aをそのままロックオン
対象車とし、該先行車Aをもとに第2進行路を生成す
る。一方、上記ステップS72の判定がNOのとき、つ
まりロックオン対象車Aが第1進行路K1から外れてい
るときには、ステップS76で第2進行路K2上にロッ
クオン対象車Aより近い先行車Bが存在するか否かを判
定し、この判定がYESのときには、ステップS77で
先行車Bをロックオン対象候補とした後、ステップS7
8で第1進行路K1上に上記先行車Bより近い先行車C
が存在するか否かを判定する。この判定がYESのとき
には、ステップS79で先行車Cをロックオン対象車と
し、該先行車Cをもとに第2進行路を生成する一方、判
定がNOのときには、ステップS80で先行車Bをロッ
クオン対象車とし、該先行車Bをもとに第2進行路を生
成する。上記ステップS76の判定がNOのときには、
ステップS81で第1進行路K1上にロックオン対象車
Aより近い先行車Cが存在するか否かを判定し、その判
定がYESのときには、ステップS79へ移行して、先
行車Cをロックオン対象車とし、該先行車Cをもとに第
2進行路を生成する。一方、判定がNOのときには、ス
テップS82で先行車Aをそのままロックオン対象車と
し、該先行車Aをもとに第2進行路を生成する。以上の
ことから、ロックオン対象車Aが第1進行路K1から外
れているときには、第1進行路K1上に存在する先行車
Cと第2進行路K2上に存在する先行車A、Bの中か
ら、自車に最も近い先行車を識別するようになってお
り、この識別は、コントロールユニット4内の先行車識
別手段23により行われる。
In FIGS. 7 and 8, first, step S
After recognizing the lock-on target vehicle A and the radii of curvature R1 and R2 of the first and second traveling paths in 71, the curvature radius R1 of the first traveling path and the curvature radius R2 of the second traveling path are substantially the same in step S72. That is, it is determined whether or not the lock-on target vehicle A is on the first traveling path K1. This judgment is YES
When, the second traveling path K2 (same as the first traveling path K1)
It is determined whether or not there is a preceding vehicle B closer to the lock-on target vehicle A. When the determination is YES, the preceding vehicle B is set as the lock-on target vehicle in step S74, and the preceding vehicle B
On the other hand, if the determination is NO, the preceding vehicle A is directly set as the lock-on target vehicle in step S75, and the second traveling path is generated based on the preceding vehicle A. On the other hand, when the determination in step S72 is NO, that is, when the lock-on target vehicle A is off the first traveling path K1, the preceding vehicle B closer to the lock-on target vehicle A on the second traveling path K2 is step S76. Is present, and if this determination is YES, the preceding vehicle B is set as the lock-on target candidate in step S77, and then step S7 is performed.
8 is a preceding vehicle C closer to the first traveling path K1 than the preceding vehicle B
Is present. When the determination is YES, the preceding vehicle C is set as the lock-on target vehicle in step S79, and the second traveling path is generated based on the preceding vehicle C. When the determination is NO, the preceding vehicle B is determined in step S80. The second traveling path is generated based on the preceding vehicle B as the lock-on target vehicle. When the determination in step S76 is NO,
In step S81, it is determined whether or not a preceding vehicle C closer to the lock-on target vehicle A exists on the first traveling path K1. If the determination is YES, the process proceeds to step S79 to lock-on the preceding vehicle C. The second traveling path is generated based on the preceding vehicle C as the target vehicle. On the other hand, when the determination is NO, the preceding vehicle A is directly set as the lock-on target vehicle in step S82, and the second traveling path is generated based on the preceding vehicle A. From the above, when the lock-on target vehicle A deviates from the first traveling path K1, the preceding vehicle C existing on the first traveling path K1 and the preceding vehicles A and B existing on the second traveling path K2. The preceding vehicle closest to the own vehicle is identified from the inside, and this identification is performed by the preceding vehicle identifying means 23 in the control unit 4.

【0016】上記ステップS74、S75、S79、S
80及びS82のいずれかで先行車A〜Cをロックオン
対象車とし、第2進行路を生成した後、ステップS83
でロックオン対象車がロストしたか否かを判定する。こ
の判定がNOのロストしていないときには、ステップS
71に戻り、ロックオンを続行する一方、判定がYES
のロストしたときには、ステップS84でロックオンを
解除し、リターンする。尚、ロックオン解除から次のロ
ックオン対象車が登録されるまでの間は、車速制御部2
5により自車速が所定車速になるように制御される。次
に、上記本発明の第1実施例の作用・効果を説明する。
自車Mがロックオン対象車である先行車Aに追従して走
行するとき、第1進行路推定手段22は、自車Mの走行
状態に関する舵角θ、ヨーレートφ及び車速vに基づい
て、第1の進行路K1を推定し、また第2進行路推定手
段23は、上記先行車Aの自車Mに対する位置に基づい
て、第2の進行路K2を推定する。そして、自車Mが直
線道路上を直進走行するとき、または曲線道路上を定常
旋回走行するときなどには、上記第1進行路K1と第2
進行路K2とは略一致する。この場合、先行車識別手段
23は、常に第2進行路K2上に存在する先行車の中か
ら、自車Mに最も近い先行車を識別してロックオン対象
車とする(図8中のステップS74、S75)。このた
め、ロックオン対象車Aと自車Mとの間に他の自動車が
割り込んで来たときには、該割込み車を早期に検出する
ことができ、警報又は自動制動により接触を回避するこ
とができる。
Steps S74, S75, S79, S
After the preceding vehicles A to C are set as lock-on target vehicles in either 80 or S82, and the second traveling path is generated, step S83 is performed.
At, it is determined whether the lock-on target vehicle has been lost. When this determination is NO, that is, when it is not lost, step S
Returning to 71, the lock is continued, but the determination is YES.
If is lost, the lock-on is released in step S84 and the process returns. It should be noted that the vehicle speed control unit 2 operates from the lock-on release until the next lock-on target vehicle is registered.
The vehicle speed is controlled by 5 to be a predetermined vehicle speed. Next, the operation and effect of the first embodiment of the present invention will be described.
When the host vehicle M travels following the preceding vehicle A that is the lock-on target vehicle, the first traveling path estimating unit 22 determines, based on the steering angle θ, the yaw rate φ, and the vehicle speed v regarding the traveling state of the host vehicle M. The first traveling route K1 is estimated, and the second traveling route estimating means 23 estimates the second traveling route K2 based on the position of the preceding vehicle A with respect to the own vehicle M. When the vehicle M travels straight on a straight road or travels on a curved road in a steady turn, the first traveling road K1 and the second traveling road K1
It substantially coincides with the traveling path K2. In this case, the preceding vehicle identifying means 23 identifies the preceding vehicle closest to the own vehicle M among the preceding vehicles that always exist on the second traveling path K2 and sets it as the lock-on target vehicle (step in FIG. 8). S74, S75). Therefore, when another vehicle enters between the lock-on target vehicle A and the own vehicle M, the interrupted vehicle can be detected early and contact can be avoided by an alarm or automatic braking. .

【0017】一方、上記先行車Aが直線道路から曲線道
路へ進入し、自車Mがまだ直線道路上を走行するときな
どには、先行車Aが第1進行路K1から外れ、第1進行
路K1と第2進行路K2とが相違するようになる。この
場合、先行車識別手段23は、第1進行路K1上に存在
する先行車Cと第2進行路K2上に存在する先行車A、
Bの中から、自車に最も近い先行車を識別してロックオ
ン対象車とする(図7中のステップS76〜S82)。
このため、上述の直線道路上での直線走行時と同様に割
込み車Bを早期に検出することができる。また、ロック
オン対象車Aが自車Mの進行路(第1進行路)K1から
わき道に逸れていったときでも、自車Mの進行路K1上
に存在する先行車Cを早期に検出することができる。こ
の結果、接触を適切に回避することができ、安全性を高
めることができる。図11は、本発明の第1実施例の先
行車識別手段23によるロックオンの変更及び解除の変
形例を示すサブルーチンの部分図(図8相当図)であ
る。この変形例は、先行車であるロックオン対象車Aが
第1進行路K1から外れ、第1進行路K1の曲率半径R
1と第2進行路K2の曲率半径R2とが相違するとき
(図7中のステップS72の判定がNOのとき)、所定
時間t秒の間は第2進行路K2上に存在する先行車の中
から自車に最も近い先行車を識別し、上記所定時間t秒
が経過した時にロックオン対象車Aが第1進行路K1に
戻らないときはその後第1進行路K1上に存在する先行
車の中から自車に最も近い先行車を識別するようにした
ものである。
On the other hand, when the preceding vehicle A enters a curved road from a straight road and the host vehicle M is still traveling on the straight road, the preceding vehicle A deviates from the first traveling road K1 and makes the first traveling road. The road K1 and the second traveling road K2 become different. In this case, the preceding vehicle identifying means 23 determines that the preceding vehicle C existing on the first traveling path K1 and the preceding vehicle A existing on the second traveling path K2,
The preceding vehicle closest to the own vehicle is identified from B and is set as the lock-on target vehicle (steps S76 to S82 in FIG. 7).
Therefore, the interrupting vehicle B can be detected at an early stage as in the case of the straight running on the straight road described above. Further, even when the lock-on target vehicle A deviates from the traveling road (first traveling road) K1 of the own vehicle M to the side road, the preceding vehicle C existing on the traveling road K1 of the own vehicle M is detected early. be able to. As a result, contact can be appropriately avoided and safety can be improved. FIG. 11 is a partial view (corresponding to FIG. 8) of a subroutine showing a modification of the lock-on change and release by the preceding vehicle identifying means 23 according to the first embodiment of the present invention. In this modification, the lock-on target vehicle A, which is the preceding vehicle, deviates from the first traveling path K1 and the radius of curvature R of the first traveling path K1.
1 and the radius R2 of curvature of the second traveling path K2 are different (when the determination in step S72 in FIG. 7 is NO), the preceding vehicle existing on the second traveling path K2 for a predetermined time t seconds. The preceding vehicle closest to the own vehicle is identified from the inside, and if the lock-on target vehicle A does not return to the first traveling path K1 when the predetermined time t seconds have elapsed, then the preceding vehicle existing on the first traveling path K1 thereafter. This is to identify the preceding vehicle closest to the own vehicle from among.

【0018】すなわち、第1進行路K1の曲率半径R1
と第2進行路K2の曲率半径R2とが相違するときに
は、図11において、先ず、ステップS91でロックオ
ン対象車Aが第1進行路K1から外れた時点から所定時
間t秒以内であるか否かを判定する。ここで、上記所定
時間は、ロックオン対象車Aが第1進行路K1から外れ
た地点に自車Mが到着するまでの時間であって、下記式
により、演算される。 t=(L/v)+α 但し、Lはロックオン対象車Aが第1進行路K1から外
れた時点における該ロックオン対象車Aと自車Mとの車
間距離、vは自車速、αは自車のピッチング等の特性と
センサの特性とから算出される補正値である。上記ステ
ップS91の判定がYESの所定時間t以内のときに
は、ステップS92で第2進行路K2の曲率半径R2が
所定値Raより小さいか否かを判定し、ステップS93
でロックオン対象車Aが停止しその車速が略零であるか
否かを判定する。上記所定値Ra、図12に示すよう
に、先行車(ロックオン対象車)Aの車速が大きくなる
従って一時関数的に増加するように設定される。ここ
で、曲線道路を旋回走行するときには、通常、穏やかに
旋回し、その旋回半径は、曲線道路の曲率半径と同じで
比較的大きくなる。従って、第2進行路K2の曲率半径
R2が所定値Raより小さいときには、ロックオン対象
車Aが曲線道路に進入したのではなく、何かの意図で急
旋回したものと考えられる。
That is, the radius of curvature R1 of the first traveling path K1
When the radius of curvature R2 of the second traveling path K2 is different from that of the second traveling path K2, first in FIG. 11, it is determined whether the lock-on target vehicle A is within a predetermined time t seconds from the time when the lock-on target vehicle A deviates from the first traveling path K1. To determine. Here, the predetermined time is a time until the vehicle M arrives at a point where the lock-on target vehicle A deviates from the first traveling path K1, and is calculated by the following formula. t = (L / v) + α where L is the vehicle-to-vehicle distance between the lock-on target vehicle A and the host vehicle M when the lock-on target vehicle A deviates from the first traveling path K1, v is the host vehicle speed, and α is It is a correction value calculated from the characteristics of the vehicle such as pitching and the characteristics of the sensor. When the determination in step S91 is within the predetermined time t of YES, it is determined in step S92 whether the radius of curvature R2 of the second traveling path K2 is smaller than the predetermined value Ra, and step S93.
Then, it is determined whether the lock-on target vehicle A is stopped and the vehicle speed is substantially zero. The predetermined value Ra, as shown in FIG. 12, is set so that the vehicle speed of the preceding vehicle (lock-on target vehicle) A increases and accordingly increases temporarily. Here, when the vehicle travels on a curved road, the vehicle usually makes a gentle turn, and its turning radius is the same as the radius of curvature of the curved road and relatively large. Therefore, when the radius of curvature R2 of the second traveling path K2 is smaller than the predetermined value Ra, it is considered that the lock-on target vehicle A did not enter the curved road but made a sharp turn for some purpose.

【0019】そして、上記両ステップS92、S93の
判定が共にNOのときには、ステップS94で第2進行
路K2上にロックオン対象車Aより近い先行車Bが存在
するか否かを判定し、この判定がYESのときには、ス
テップS95で先行車Bをロックオン対象車とし、該先
行車Bをもとに第2進行路を生成する一方、判定がNO
のときには、ステップS96で先行車Aをそのままロッ
クオン対象車とし、該先行車Aをもとに第2進行路を生
成する。一方、上記ステップS91の判定がNOの所定
時間tを経過したときには、ステップS97で第1進行
路K1上に先行車Cが存在するか否かを判定し、この判
定がYESのときには、ステップS98で上記先行車C
をロックオン対象車とし、該先行車Cをもとに第2進行
路を生成する一方、判定がNOのときには、ステップS
99でロックオン対象車をロストしたと判定する。ま
た、上記ステップS92の判定がYESのときつまり第
2進行路K2の旋回半径R2が所定値Raより小さいと
き、あるいは上記ステップS93の判定がYESのとき
つまりロックオン対象車Aが第1進行路K1から外れた
後に停車したときにも、上記ステップS97へ移行す
る。
When both the determinations in steps S92 and S93 are NO, it is determined in step S94 whether or not there is a preceding vehicle B closer to the lock-on target vehicle A on the second traveling path K2. When the determination is YES, the preceding vehicle B is set as the lock-on target vehicle in step S95, and the second traveling path is generated based on the preceding vehicle B, while the determination is NO.
In this case, in step S96, the preceding vehicle A is directly set as the lock-on target vehicle, and the second traveling path is generated based on the preceding vehicle A. On the other hand, when the determination in step S91 has passed the NO predetermined time t, it is determined in step S97 whether the preceding vehicle C is present on the first traveling path K1. If the determination is YES, step S98 In the preceding vehicle C
Is set as the lock-on target vehicle, the second traveling path is generated based on the preceding vehicle C, and if the determination is NO, step S
At 99, it is determined that the lock-on target vehicle is lost. When the determination in step S92 is YES, that is, when the turning radius R2 of the second traveling path K2 is smaller than the predetermined value Ra, or when the determination in step S93 is YES, that is, the lock-on target vehicle A is the first traveling path. When the vehicle is stopped after being out of K1, the process also goes to step S97.

【0020】そして、上記変形例においては、先行車で
あるロックオン対象車Aが第1進行路K1から外れ、第
1進行路K1の曲率半径R1と第2進行路K2の曲率半
径R2とが相違するときには、ロックオン対象車Aが第
1進行路K1から外れた時点から所定時間t、つまり先
行車Aが第1の進行路から外れた地点に自車Mが到着す
るまでの時間の間は第2進行路K2上に存在する先行車
の中から自車Mに最も近い先行車を識別し、上記所定時
間tが経過した時に上記ロックオン対象車Aが第1進行
路K1に戻らないときはその後第1進行路K1上に存在
する先行車の中から自車Mに最も近い先行車を識別する
ようにしているので、曲線道路上での割込み車等を早期
に検出できるとともに、最も近い先行車を検出するため
の対象領域が常に一つの進行路のみで足り、その分上記
先行車の検出を精度良くかつ迅速に行うことができる。
また、上記第2進行路K2の曲率半径R2が所定値Ra
より小さく、ロックオン対象車Aが曲線道路に進入した
のではなく何かの意図で急旋回したものと考えられると
き、あるいは上記ロックオン対象車Aが第1進行路K1
から外れた後に停止したときには、第1進行路K1上に
存在する先行車の中から自車に最も危険な先行車を識別
するようにしているので、誤った進行路に基づく先行車
の誤検出を防止することができる。
In the modified example, the lock-on target vehicle A, which is the preceding vehicle, deviates from the first traveling path K1, and the radius of curvature R1 of the first traveling path K1 and the radius of curvature R2 of the second traveling path K2 are equal to each other. When they differ, a predetermined time t from the time when the lock-on target vehicle A deviates from the first traveling path K1, that is, the time until the vehicle M arrives at a point where the preceding vehicle A deviates from the first traveling path K1. Identifies the preceding vehicle closest to the host vehicle M among the preceding vehicles existing on the second traveling path K2, and the lock-on target vehicle A does not return to the first traveling path K1 when the predetermined time t has elapsed. At this time, the preceding vehicle closest to the host vehicle M is identified from the preceding vehicles present on the first traveling path K1, so that an interrupted vehicle or the like on the curved road can be detected early and The target area for detecting a preceding vehicle is always One of the advancing path only enough can be detected correspondingly the preceding vehicle with high precision and quickly.
Further, the radius of curvature R2 of the second traveling path K2 is a predetermined value Ra.
When it is smaller, it is considered that the lock-on target vehicle A did not enter the curved road but made a sharp turn for some purpose, or when the lock-on target vehicle A was on the first traveling path K1.
When the vehicle stops after being deviated from the preceding vehicle, the preceding vehicle most dangerous to the own vehicle is identified from the preceding vehicles existing on the first traveling path K1. Therefore, the erroneous detection of the preceding vehicle based on the incorrect traveling path is performed. Can be prevented.

【0021】尚、上記第1実施例では、レーダ装置7と
して、レーダ波としての遠赤外線を水平方向に比較的広
角度で走査するスキャン式のものを用いたが、それ以外
に、比較的狭い角度の範囲内でのみ障害物を検出するレ
ーダ装置を用い、該レーダ装置をアクチュエータで垂直
軸廻りに回動させるように構成したものにも同様に適用
することができる。また、上記第1実施例では、第1進
行路K1上に存在する先行車C及び第2進行路K2上に
存在する先行車A、Bの中から、ロックオン対象車を識
別するに当たり、自車と各先行車との車間距離の大小に
応じて、上記先行車の識別を行うようにしたが、上記車
間距離の代りに、自車と各先行車との相対速度の大小、
または車間距離と相対速度との両方に応じて、先行車の
識別を行うようにしてもよい。車間距離と相対速度の両
方に応じて、先行車の識別を行う場合、先ず、図13に
示すマップを用いて、各先行車との車間距離及び相対速
度に応じて減速制御量を求め、該減速制御量の大きいも
のを自車に最もロックオン対象車と判断すればよい。次
に、本発明の第2実施例について図14乃至図19を参
照して説明する。上記第1実施例は、第1進行路推定手
段22により、自車の走行状態に関する情報(例えば、
車速、ハンドル舵角及びヨーレート等)を受け、これに
基づいて自車の第1進行路を推定するようにしたもので
あるが、この第2実施例は、第1進行路推定手段30に
より、道路の路側に設けられた路側リフレクタ等の静止
物体を用いて自車の第1進行路を推定するようにしたも
のである。以下、第1実施例と異なる部分のみ説明し、
同一部分の説明は省略する。
In the first embodiment, as the radar device 7, a scan type device which scans far infrared rays as a radar wave in a horizontal direction at a relatively wide angle is used. The present invention can be similarly applied to a radar device that detects an obstacle only within an angle range and is configured to rotate the radar device by an actuator around a vertical axis. Further, in the first embodiment, when identifying the lock-on target vehicle from the preceding vehicles C existing on the first traveling path K1 and the preceding vehicles A and B existing on the second traveling path K2, According to the size of the inter-vehicle distance between the car and each preceding vehicle, the preceding vehicle is identified, but instead of the inter-vehicle distance, the relative speed between the own vehicle and each preceding vehicle is large or small.
Alternatively, the preceding vehicle may be identified according to both the inter-vehicle distance and the relative speed. When the preceding vehicle is identified according to both the inter-vehicle distance and the relative speed, first, using the map shown in FIG. 13, the deceleration control amount is obtained according to the inter-vehicle distance and the relative speed to each preceding vehicle, The vehicle with the largest deceleration control amount may be determined as the vehicle that is most subject to lock-on. Next, a second embodiment of the present invention will be described with reference to FIGS. 14 to 19. In the first embodiment, the first traveling road estimating means 22 causes the information regarding the traveling state of the own vehicle (for example,
The vehicle speed, the steering angle of the steering wheel, the yaw rate, etc.) are received, and the first traveling path of the host vehicle is estimated based on the received vehicle speed. In the second embodiment, the first traveling path estimating means 30 is used. The first traveling path of the own vehicle is estimated by using a stationary object such as a roadside reflector provided on the roadside of the road. Hereinafter, only the parts different from the first embodiment will be described,
Description of the same parts will be omitted.

【0022】図14に示すように、第1進行路推定手段
30は、先ず、レーダ装置7の出力を受け、自車両前方
に存在する物体を検出する物体検出手段31と、該物体
検出手段31の出力を受け、自車両前方に存在する静止
物体を検出する静止物体検出手段32と、該静止物体検
出手段32の出力を受け、自車両前方に静止物体がある
とき、該静止物体の属性に基づき次式に基づき自車両の
進行路(曲率半径R12)を推定する第1進行路第2推
定手段33とを備える。ここで、静止物体の属性は、自
車両と静止物体との距離L、自車両からみた静止物体の
方位φ、自車両と静止物体との相対速度v及び横移動速
度vtであり、レーダ装置7、車速センサ12及び舵角
センサ13からの信号に基づき簡単に検出することがで
きる。 R12=L・(v・cosφ/vt−sinφ) 更に、第1進行路推定手段30は、車速v、舵角θに基
づき次式により自車両の進行路(曲率半径R11)を推
定する第1進行路第1推定手段34と、レーダ装置7の
出力を受け、自車両前方に静止物体が存在しないとき、
第1進行路第1推定手段34により推定された進行路を
選択する選択手段35とを備える。この第1進行路第1
推定手段34は、次式により自車両のスリップアングル
β1を検出するスリップアングル演算手段34aを備え
る。
As shown in FIG. 14, the first traveling path estimating means 30 first receives an output of the radar device 7 and detects an object existing in front of the own vehicle, and an object detecting means 31. Of the stationary object existing in front of the host vehicle, and the output of the stationary object detection unit 32. Based on the following equation, the first traveling route second estimating means 33 for estimating the traveling route (curvature radius R12) of the vehicle is provided. Here, the attributes of the stationary object are the distance L between the own vehicle and the stationary object, the azimuth φ of the stationary object viewed from the own vehicle, the relative speed v between the own vehicle and the stationary object, and the lateral movement speed vt. , And can be easily detected based on the signals from the vehicle speed sensor 12 and the steering angle sensor 13. R12 = L · (v · cosφ / vt−sinφ) Further, the first traveling path estimating means 30 estimates the traveling path (curvature radius R11) of the host vehicle based on the vehicle speed v and the steering angle θ by the following equation. When the output of the traveling path first estimating means 34 and the radar device 7 is received and there is no stationary object in front of the host vehicle,
And a selecting unit 35 for selecting the traveling route estimated by the first traveling route first estimating unit 34. This 1st path 1st
The estimating unit 34 includes a slip angle calculating unit 34a that detects the slip angle β1 of the host vehicle according to the following equation.

【0023】R11=(1+A・v2 )・N・L/θ β1=[{-1 + m/2mL・Lf/(Lr・kf) ・v2}/(1 + A ・
v2) ]・Lr/L・θ/ N 但し、A:スタビリティファクタ N:ステアリングギヤ比 L:ホイールベース Lf:車両重心と前輪との間の距離 Lr:車両重心と後輪との間の距離 m:車両質量 kf:後輪1輪当りのコーナリングパワー そして、第1進行路第1推定手段34は、第1進行路の
推定に際しスリップアングルβ1を考慮するようになっ
ている。即ち、自車両から距離Liの静止物体が見える
べき角度の領域Φ1は次式で計算される。 Φ1=Li/2R11−β1 また、第1進路推定手段30の物体検出手段31及び選
択手段35からの信号が、先行車識別手段23に出力さ
れる。
R11 = (1 + A · v 2 ) · N · L / θ β1 = [{-1 + m / 2mL·Lf / (Lr · kf) · v 2 } / (1 + A ·
v 2 )] ・ Lr / L ・ θ / N where A: Stability factor N: Steering gear ratio L: Wheel base Lf: Distance between vehicle center of gravity and front wheels Lr: Between vehicle center of gravity and rear wheels Distance m: vehicle mass kf: cornering power per rear wheel Then, the first traveling path first estimating means 34 takes the slip angle β1 into consideration when estimating the first traveling path. That is, the area Φ1 of the angle at which the stationary object at the distance Li should be visible from the host vehicle is calculated by the following equation. Φ1 = Li / 2R11−β1 Further, signals from the object detecting means 31 and the selecting means 35 of the first route estimating means 30 are output to the preceding vehicle identifying means 23.

【0024】次に、図15により、上記第1進路推定手
段30による第1進行路の推定に係わる制御内容を説明
する。先ず、第1進行路第1推定手段34により、車
速、舵角による第1進行路の曲率半径R11及びスリッ
プアングルβ1が次式により演算される(ステップT
1)。 R11=(1+A・v2 )・N・L/θ β1=[{-1 + m/2mL・Lf/(Lr・kf) ・v2}/(1 + A ・
v2) ]・Lr/L・θ/ N 但し、A:スタビリティファクタ N:ステアリングギヤ比 L:ホイールベース Lf:車両重心と前輪との間の距離 Lr:車両重心と後輪との間の距離 m:車両質量 kf:後輪1輪当りのコーナリングパワー 次に、物体検出手段31によって検出された自車両前方
に存在する物体が静止物体であるか否かが静止物体検出
手段32によって判定され(ステップT2)、静止物体
があれば、第1進行路第2推定手段33により、静止物
体の属性に基づき第1進行路の曲率半径R12が次式に
より演算される(ステップT3)。
Next, referring to FIG. 15, the contents of control relating to the estimation of the first traveling route by the first traveling route estimating means 30 will be described. First, the first traveling path first estimating means 34 calculates the radius of curvature R11 and the slip angle β1 of the first traveling path according to the vehicle speed and the steering angle by the following equation (step T).
1). R11 = (1 + A ・ v 2 ) ・ N ・ L / θ β1 = [{-1 + m / 2mL ・ Lf / (Lr ・ kf) ・ v 2 } / (1 + A ・
v 2 )] ・ Lr / L ・ θ / N where A: Stability factor N: Steering gear ratio L: Wheel base Lf: Distance between vehicle center of gravity and front wheels Lr: Between vehicle center of gravity and rear wheels Distance m: vehicle mass kf: cornering power per rear wheel Next, the stationary object detection means 32 determines whether or not the object existing in front of the vehicle detected by the object detection means 31 is a stationary object. (Step T2) If there is a stationary object, the first traveling path second estimating means 33 calculates the radius of curvature R12 of the first traveling path based on the attribute of the stationary object by the following equation (step T3).

【0025】R12=L・(v・cosφ/vt−si
nφ) 尚、上記静止物体の属性に基づき第1進行路(曲率半径
R12)を推定する式は、次のようにして導かれる(図
16参照)。ここで、Lは自車両Mから静止物体までの
距離、φは自車両Mに対する静止物体の方位、vは相対
速度、vtは横移動速度である。 sinθ=h/(R12+x) h=L・cosφ (R12+x)・cosφ=R12+L・sinφ R12+x=(R12+L・sinφ)/cosθ sinθ=(L・cosφ・cosθ)/(R12+L
・sinφ) sinθ・(R12+L・sinφ)=L・cosφ・
cosθ R12=−L・sinφ+L・cosφ・cosθ/s
inθ =L・cosφ・(1/tanθ)−L・sinφ =L・(v/vt・cosφ−sinφ) このようにして第1進行路第2推定手段33により推定
された第1進行路の曲率半径R12に基づいて第1進行
路が推定される(ステップT4)。
R12 = L (vcosφ / vt-si
nφ) An equation for estimating the first traveling path (curvature radius R12) based on the attribute of the stationary object is derived as follows (see FIG. 16). Here, L is the distance from the host vehicle M to the stationary object, φ is the azimuth of the stationary object with respect to the host vehicle M, v is the relative speed, and vt is the lateral moving speed. sin θ = h / (R12 + x) h = L · cos φ (R12 + x) · cos φ = R12 + L · sin φ R12 + x = (R12 + L · sin φ) / cos θ sin θ = (L · cos φ · cos θ) / (R12 + L
・ Sinφ) sinθ ・ (R12 + L ・ sinφ) = L ・ cosφ ・
cos θ R12 = −L · sin φ + L · cos φ · cos θ / s
inθ = L · cosφ · (1 / tanθ) −L · sinφ = L · (v / vt · cosφ−sinφ) Thus, the curvature of the first traveling path estimated by the first traveling path second estimating means 33. The first traveling path is estimated based on the radius R12 (step T4).

【0026】一方、静止物体がなければ、スリップアン
グル演算手段34aによってスリップアングルが演算さ
れ(ステップT5)、それを考慮して、第1進行路第1
推定手段34で推定された第1進行路の曲率半径R11
に基づき第1進行路が推定される(ステップT4)。上
記第2実施例は、基本的には1つの静止物体を利用して
行う制御の例であるが、第2実施例によれば、自車両前
方に複数の静止物体が存在する場合には、それら複数の
静止物体を利用して、次のように第1進行路を推定する
こともできる。図17及び図18において、先ず、物体
識別番号iをリセットしてi=0とし(ステップT1
1)、それから、物体識別番号iをインクリメントし
て、i+1とする(ステップT12)。それから、物体
識別番号iが、物体総個数(object-max)+1に等しいか
否かを判定し(ステップT13)、等しくなければ、相
対速度viが自車速vに等しいか否かを判定する(ステ
ップT14)。相対速度viが自車速vに等しければ、
それぞれの静止物体に基づいて物体の属性(例えば自車
両から静止物体までの距離Li、自車両に対する静止物
体の方位φi、相対速度vi、横移動速度vti)によ
る第1進行路の推定を次式により行い(ステップT1
5)、ステップT12に戻る。一方、相対速度viが自
車速vに等しくなければ、移動物体であるので、第1進
行路の曲率半径Riを無限大として(ステップT1
6)、ステップT12に戻る。
On the other hand, if there is no stationary object, the slip angle calculating means 34a calculates the slip angle (step T5).
The radius of curvature R11 of the first traveling path estimated by the estimating means 34
The first traveling path is estimated based on (step T4). The second embodiment is basically an example of control performed using one stationary object, but according to the second embodiment, when there are a plurality of stationary objects in front of the vehicle, The first traveling path can be estimated as follows using the plurality of stationary objects. 17 and 18, first, the object identification number i is reset to i = 0 (step T1).
1) Then, the object identification number i is incremented to i + 1 (step T12). Then, it is determined whether or not the object identification number i is equal to the total number of objects (object-max) +1 (step T13). If they are not equal, it is determined whether or not the relative speed vi is equal to the own vehicle speed v ( Step T14). If the relative speed vi is equal to the vehicle speed v,
The following equation is used to estimate the first traveling path based on the attributes of each stationary object (for example, the distance Li from the own vehicle to the stationary object, the direction φi of the stationary object with respect to the own vehicle, the relative speed vi, and the lateral movement speed vti). (Step T1
5) and returns to step T12. On the other hand, if the relative speed vi is not equal to the vehicle speed v, it is a moving object, and therefore the radius of curvature Ri of the first traveling path is set to infinity (step T1).
6) and returns to step T12.

【0027】R12i=Li・(vi・cosφi/v
ti−sinφi) 一方、ステップT13において、物体識別番号iが、物
体総個数(object-max)+1に等しければ、静止物体が3
つ以上あるか否かを判定し(ステップT17)、3つ以
上あれば、最も遠い距離に存在する物体から順に3つの
静止物体を選択し(ステップT18)、それら曲率半径
R121、R122、R123の平均値R12を第1進
行路の曲率半径として(ステップT19)、第1進行路
を推定する(ステップT20)。静止物体が3つ以上な
ければ、第1進行路第1推定手段34により車両状態量
から曲率半径R11を求めて第1進行路の推定を行い
(ステップT21)、スリップアングルを計算し(ステ
ップT22)、第1進行路を推定する(ステップT2
0)。また、この第2実施例においては、図18に示し
たステップT17以降の内容を次のようにすることもで
きる。図19に示すように、ステップT13(図17参
照)において、物体識別番号iが、物体総個数(object-
max)+1に等しいとき、Rフラグが1であるか否かが判
定され(ステップT31)、Rフラグが1でないときに
は、静止物体が3つ以上存在するか否かを判定する(ス
テップT32)。ここで、Rフラグ=1の判定を行うの
は、最初の段階では、ステップT32に移行するように
するためである。
R12i = Li · (vi · cos φi / v
ti-sin φi) On the other hand, if the object identification number i is equal to the total number of objects (object-max) +1 in step T13, the number of stationary objects is 3
It is judged whether or not there are three or more (step T17), and if there are three or more, three stationary objects are selected in order from the object existing at the farthest distance (step T18), and those radii of curvature R121, R122, R123 are selected. The average value R12 is set as the radius of curvature of the first traveling path (step T19), and the first traveling path is estimated (step T20). If there are not three or more stationary objects, the first traveling path first estimating means 34 calculates the radius of curvature R11 from the vehicle state quantity to estimate the first traveling path (step T21), and calculates the slip angle (step T22). ), Estimating the first traveling path (step T2)
0). Further, in this second embodiment, the contents after step T17 shown in FIG. 18 can be made as follows. As shown in FIG. 19, in step T13 (see FIG. 17), the object identification number i is the total number of objects (object-
When it is equal to (max) +1, it is determined whether the R flag is 1 (step T31), and when the R flag is not 1, it is determined whether three or more stationary objects exist (step T32). Here, the reason why the R flag = 1 is determined is to shift to step T32 at the initial stage.

【0028】ステップT32の判定で、静止物体が3つ
以上あれば、最も遠い距離に存在する物体から順に3つ
の静止物体を選択し(ステップT33)、自車Mと各物
体間の距離La、Lb、Lcを演算し(ステップT3
4)、それら各物体から推定された各曲率半径R12
1,R122,R123の平均値R12を第1進行路の
曲率半径として推定し(ステップT35)、Rフラグを
1とし(ステップT36)、第1進行路を推定する(ス
テップT37)。静止物体が3つ以上なければ、自車両
Mの走行状態量(車速、舵角)による第1進行路の曲率
半径R11の推定を行い(ステップT38)、スリップ
アングルを計算し(ステップT39)、第1進行路を推
定する(ステップT37)。一方、ステップ31でRフ
ラグが1であると判定された場合には、ステップT40
に進み、ステップT33で選ばれたものと同じ物体の物
体間距離データLa’,Lb’,Lc’を演算した後、
前回の物体間データと比較して等しいか否かを判定する
(ステップT41)。前回の物体間データと比較して等
しければ、それらは静止物体であるから、静止物体の場
合には、それらの物体から推定された進行路の曲率半径
の平均値を計算し(ステップT42)、進行路を推定す
る(ステップT37)。一方、前回の物体間データと等
しくなければ、ステップT32に移行する。
If it is determined in step T32 that there are three or more stationary objects, the three stationary objects are selected in order from the object located at the farthest distance (step T33), and the distance La between the vehicle M and each object is calculated. Lb and Lc are calculated (step T3
4), each radius of curvature R12 estimated from each of these objects
The average value R12 of 1, R122 and R123 is estimated as the radius of curvature of the first traveling path (step T35), the R flag is set to 1 (step T36), and the first traveling path is estimated (step T37). If there are not three or more stationary objects, the radius of curvature R11 of the first traveling path is estimated from the running state amount (vehicle speed, steering angle) of the host vehicle M (step T38), and the slip angle is calculated (step T39). The first traveling path is estimated (step T37). On the other hand, if it is determined in step 31 that the R flag is 1, step T40
After calculating the inter-object distance data La ′, Lb ′, Lc ′ of the same object selected in step T33,
It is determined whether or not they are equal by comparing with the previous data between objects (step T41). If they are equal to the previous inter-object data, they are stationary objects. Therefore, in the case of stationary objects, the average value of the curvature radii of the traveling paths estimated from those objects is calculated (step T42), The traveling path is estimated (step T37). On the other hand, if it is not equal to the previous inter-object data, the process proceeds to step T32.

【0029】このように、本発明の第2実施例において
は、自車両前方の静止物体を検出して、該静止物体の属
性に基づき第1進行路第2推定手段33が自車両が今後
進行すると推定される第1進行路を推定するようにして
いるので、物体検出手段31により検出される自車両前
方の静止物体を有効に利用して、ヨーレートセンサを用
いることなく、自車両が今後進行する第1進行路を推定
することができる。また、第2実施例によれば、静止物
体の属性として簡単に検出することができる自車両と静
止物体との距離、自車両からみた静止物体の方位、自車
両と静止物体との相対速度及び横移動速度を用いて、第
1進行路を推定することができる。さらに、第2実施例
においては、第1進行路第2推定手段33により第1進
行路を推定するほか、車速、舵角等の車両状態量に基づ
き、第1進行路第1推定手段34によっても第1進行路
を推定するようにしているので、自車両前方に静止物体
が存在しない場合には、第1進行路第1推定手段34を
利用することで、常時進行路を推定することが可能とな
る。また、第2実施例によれば、自車両のスリップアン
グルを演算しているので、自車両前方に静止物体が存在
しないとき、第1進行路第1推定手段34による推定値
に対しスリップアングルを考慮して、自車両の第1進行
路を推定することができる。
As described above, in the second embodiment of the present invention, the stationary object ahead of the host vehicle is detected, and the first traveling path second estimating means 33 causes the host vehicle to proceed in the future based on the attribute of the stationary object. Since the estimated first traveling path is estimated, the stationary vehicle in front of the own vehicle detected by the object detection means 31 is effectively used and the own vehicle travels in the future without using the yaw rate sensor. It is possible to estimate the first path of travel. Further, according to the second embodiment, the distance between the own vehicle and the stationary object, which can be easily detected as the attribute of the stationary object, the direction of the stationary object as seen from the own vehicle, the relative speed between the own vehicle and the stationary object, The lateral traveling speed can be used to estimate the first traveling path. Further, in the second embodiment, the first traveling road second estimating means 33 estimates the first traveling road, and the first traveling road first estimating means 34 uses the vehicle state quantities such as the vehicle speed and the steering angle. Since the first traveling path is also estimated, when there is no stationary object in front of the host vehicle, the first traveling path first estimating means 34 can be used to constantly estimate the traveling path. It will be possible. Further, according to the second embodiment, since the slip angle of the host vehicle is calculated, when there is no stationary object in front of the host vehicle, the slip angle is set to the estimated value by the first traveling path first estimating means 34. In consideration of this, the first traveling path of the own vehicle can be estimated.

【0030】また、第2実施例によれば、複数個の静止
物体の属性に基づき自車両の第1進行路を推定するの
で、精度よく第1進行路を推定することができる。次
に、本発明の第3実施例について図20乃至図23を参
照して説明する。この第3実施例は、自車の走行状態に
関する情報(例えば、車速、ハンドル舵角及びヨーレー
ト等)に基づいて自車の第1進行路を推定した第1実施
例及び道路の路側に設けられた路側リフレクタ等の静止
物体を用いて自車の第1進行路を推定した第2実施例と
異なり、自車の前方を走行する先行車の走行状態に関す
る情報に基づいて自車の第1進行路を推定するようにし
たものである。以下、第1実施例と異なる部分のみ説明
し、同一部分の説明は省略する。図20は第3実施例に
よる自車の第1進行路の推定の基本制御内容を示すフロ
ーチャートであり、図21は図20のステップP4のサ
ブルーチンを示すフローチャートであり、図22は先行
車Aが自車と同一車線を走行している場合を示し、図2
3は先行車が自車の隣接車線を走行している場合を示し
ている。先ず、図20により、第3実施例による自車の
第1進行路の推定の基本制御内容を説明する。
Further, according to the second embodiment, the first traveling path of the vehicle is estimated based on the attributes of the plurality of stationary objects, so that the first traveling path can be estimated accurately. Next, a third embodiment of the present invention will be described with reference to FIGS. The third embodiment is provided on the roadside of the first embodiment in which the first traveling path of the own vehicle is estimated based on the information on the traveling state of the own vehicle (for example, vehicle speed, steering wheel steering angle, yaw rate, etc.). Unlike the second embodiment in which the first traveling path of the own vehicle is estimated using a stationary object such as a roadside reflector, the first traveling of the own vehicle is performed based on the information regarding the traveling state of the preceding vehicle traveling in front of the own vehicle. It is designed to estimate the road. Hereinafter, only the parts different from the first embodiment will be described, and the description of the same parts will be omitted. 20 is a flowchart showing the basic control contents of the estimation of the first traveling path of the own vehicle according to the third embodiment, FIG. 21 is a flowchart showing the subroutine of step P4 of FIG. 20, and FIG. Fig. 2 shows the case where the vehicle is traveling in the same lane as the vehicle.
3 shows a case where the preceding vehicle is traveling in the adjacent lane of the own vehicle. First, the basic control contents for estimating the first traveling path of the own vehicle according to the third embodiment will be described with reference to FIG.

【0031】図20において、先ず、自車の前方に静止
物体が存在するか否かを判定する(ステップP1)。静
止物体が存在すれば、静止物体の属性に基づいて自車の
第1進行路を推定する(ステップP2)。なお、この静
止物体の属性に基づく自車の第1進行路の推定の仕方
は、上述した第2実施例の場合と同一であるため、その
説明は省略する。一方、静止物体が存在しない場合は、
ステップP3に進み、自車の前方に移動物体即ち先行車
が存在するか否かを判定する。移動物体が存在する場合
には、この移動物体である先行車の走行状態に基づいて
自車の第1進行路を推定する(ステップP4)。この先
行車の走行状態に基づいて自車の第1進行路を推定する
ステップP4の詳細内容を図21により説明する。この
第3実施例では、先行車が自車と同一車線を走行してい
る場合と、先行車が自車の隣接車線を走行している場合
とに分けて自車の第1進行路を推定するようにしてい
る。図21において、先ず、dθ/dLを計算する(ス
テップP11)。ここで、図22及び図23に示すよう
に、Lは自車Mと先行車Aとの車間距離、θは自車Mと
先行車Aとを結ぶ直線が自車Mの進行方向(前後中心
線)となす角度である。次に、dθ/dLの値が前回及
び前々回の値と同一であるか否かを判定する(ステップ
P12)。同一であれば、先行車Mは自車Mと同一車線
を走行していると考えられるので、ステップP13に進
み、R=1/(2dθ/dL)と設定し、自車の第1進
行路を推定する(ステップP14)。
In FIG. 20, first, it is determined whether or not there is a stationary object in front of the vehicle (step P1). If the stationary object exists, the first traveling path of the own vehicle is estimated based on the attribute of the stationary object (step P2). The method of estimating the first traveling path of the own vehicle based on the attribute of the stationary object is the same as that in the case of the second embodiment described above, and thus the description thereof will be omitted. On the other hand, if there is no stationary object,
In step P3, it is determined whether or not a moving object, that is, a preceding vehicle exists in front of the own vehicle. When the moving object exists, the first traveling path of the own vehicle is estimated based on the traveling state of the preceding vehicle which is the moving object (step P4). The detailed content of step P4 for estimating the first traveling path of the own vehicle based on the traveling state of the preceding vehicle will be described with reference to FIG. In the third embodiment, the first traveling path of the own vehicle is estimated by dividing the case where the preceding vehicle is traveling in the same lane as the own vehicle and the case where the preceding vehicle is traveling in the adjacent lane of the own vehicle. I am trying to do it. In FIG. 21, first, dθ / dL is calculated (step P11). Here, as shown in FIGS. 22 and 23, L is the inter-vehicle distance between the host vehicle M and the preceding vehicle A, and θ is the straight line connecting the host vehicle M and the preceding vehicle A in the traveling direction of the host vehicle M (front-rear center). Angle). Next, it is determined whether or not the value of dθ / dL is the same as the value of the previous time and the value of the time before last (step P12). If they are the same, it is considered that the preceding vehicle M is traveling in the same lane as the own vehicle M, so the process proceeds to step P13, where R = 1 / (2dθ / dL) is set, and the first traveling path of the own vehicle is set. Is estimated (step P14).

【0032】ここで、図22に示すように、先行車Mが
自車Mと同一車線を走行している場合には、以下の関係
があり、上記R=1/(2dθ/dL)が求められる。 L=2h h=R・sinθ L=2Rsinθ R=1/(2sinθ/L)≒1/(2θ/L) 但し、sinθ≒θ 次に、ステップ12においてdθ/dLの値が前回及び
前々回の値と同一でないと判定された場合には、先行車
Aは自車Mの隣接車線を走行していると考えられるた
め、ステップP15に進む。ここで、自車Mと先行車A
との車間距離Lの変更量が正か否かを判定する。車間距
離Lの変更量が正であれば、ステップP16にて、dθ
/dLが小さくなったか否かを判定し、小さくなった場
合には、先行車Aが自車の車線の外側の隣接車線を走行
していると考えられるため、ステップP17に進み、R
=1/{2(dθ/dL−d/L2 )}と設定し、自車
の第1進行路を推定する(ステップP14)。ステップ
P16にて、dθ/dLが小さくなってはいないと判定
された場合には、先行車Aが自車の車線の内側の隣接車
線を走行していると考えられるため、ステップP18に
進み、R=1/{2(dθ/dL+d/L2 )}と設定
し、自車の第1進行路を推定する(ステップP14)。
Here, as shown in FIG. 22, when the preceding vehicle M is traveling in the same lane as the own vehicle M, there is the following relationship, and the above R = 1 / (2dθ / dL) is obtained. To be L = 2h h = R · sin θ L = 2R sin θ R = 1 / (2 sin θ / L) ≈1 / (2θ / L) where sin θ≈θ Next, in step 12, the value of dθ / dL is the value of the previous time and the value of the previous two times. If it is determined that the preceding vehicle A is not in the same lane, it is considered that the preceding vehicle A is traveling in the lane adjacent to the own vehicle M, and the process proceeds to step P15. Here, the own vehicle M and the preceding vehicle A
It is determined whether or not the amount of change in the inter-vehicle distance L with is positive. If the change amount of the inter-vehicle distance L is positive, dθ is set in Step P16.
It is determined whether or not / dL has decreased, and if it has decreased, it is considered that the preceding vehicle A is traveling in an adjacent lane outside the lane of the own vehicle, so the routine proceeds to step P17, where R
= 1 / {2 (dθ / dL−d / L 2 )} is set and the first traveling path of the own vehicle is estimated (step P14). When it is determined in step P16 that dθ / dL is not small, it is considered that the preceding vehicle A is traveling in the adjacent lane inside the lane of the own vehicle, so the process proceeds to step P18. R = 1 / {2 (dθ / dL + d / L 2 )} is set, and the first traveling path of the own vehicle is estimated (step P14).

【0033】次に、ステップP15において、自車Mと
先行車Mとの車間距離Lの変更量が正ではないと判定さ
れた場合には、ステップP19にて、dθ/dLが小さ
くなったか否かを判定し、小さくなった場合には、先行
車Mが自車の車線の内側の隣接車線を走行していると考
えられるため、ステップP18進み、R=1/{2(d
θ/dL+d/L2 )}と設定し、自車の第1進行路を
推定する(ステップP14)。ステップP19にて、d
θ/dLが小さくなってはいないと判定された場合に
は、先行車Mが自車の車線の外側の隣接車線を走行して
いると考えられるため、ステップP17に進み、R=1
/{2(dθ/dL−d/L2 )}と設定し、自車の第
1進行路を推定する(ステップP14)。ここで、図2
3に示すように、先行車Mが自車Mの外側の隣接車線を
走行している場合には、以下の関係があり、上記R=1
/{2(dθ/dL−d/L2 )}が求められる。ここ
で、dは1車線分の距離(約3.5m)を表している。 R2 +L2 −2RL・cos(90°−θ’)=(R+
d)22 +L2 −2RL・sinθ’=R2 +2Rd+d22 −2RL・sinθ’=2Rd+d22 −d(2R+d)=2RL・sinθ’≒2RL・
θ dθ/dL=1/2R+d/L2 ・(2R+d)/2R
≒1/2R+d/L2 R=1/{2(dθ/dL−d/L2 )} 但し、sinθ’≒θ、(2R+d)/2R≒1 また、先行車Mが自車Mの内側の隣接車線を走行してい
る場合にも、同様にして、上記R=1/{2(dθ/d
L+d/L2 )}が求められる。
Next, when it is determined in step P15 that the amount of change in the inter-vehicle distance L between the own vehicle M and the preceding vehicle M is not positive, it is determined in step P19 whether dθ / dL has decreased. If it becomes smaller, it is considered that the preceding vehicle M is traveling in an adjacent lane inside the lane of the own vehicle, so the process proceeds to step P18 and R = 1 / {2 (d
θ / dL + d / L 2 )}, and estimates the first traveling path of the own vehicle (step P14). In Step P19, d
If it is determined that θ / dL is not small, it is considered that the preceding vehicle M is traveling in an adjacent lane outside the lane of the own vehicle, so the routine proceeds to step P17, where R = 1.
/ {2 (dθ / dL-d / L 2 )} is set, and the first traveling path of the own vehicle is estimated (step P14). Here, FIG.
As shown in FIG. 3, when the preceding vehicle M is traveling in the adjacent lane outside the own vehicle M, the following relationships are established, and R = 1 above.
/ {2 (dθ / dL−d / L 2 )} is obtained. Here, d represents the distance for one lane (about 3.5 m). R 2 + L 2 -2RL · cos (90 ° −θ ′) = (R +
d) 2 R 2 + L 2 -2RL · sin θ ′ = R 2 + 2Rd + d 2 L 2 −2RL · sin θ ′ = 2Rd + d 2 L 2 −d (2R + d) = 2RL · sin θ′≈2RL ·
θ dθ / dL = 1 / 2R + d / L 2 · (2R + d) / 2R
≈1 / 2R + d / L 2 R = 1 / {2 (dθ / dL−d / L 2 )} However, sin θ′≈θ, (2R + d) / 2R≈1 In addition, the preceding vehicle M is located inside the own vehicle M. Similarly, when traveling in an adjacent lane, the above R = 1 / {2 (dθ / d
L + d / L 2 )} is obtained.

【0034】このように、本発明の第3実施例において
は、自車前方に静止物体(例えば、路側リフレクタ等)
が存在する場合には、その静止物体の属性に基づいて自
車の第1進行路を推定し、一方、静止物体が存在しない
場合には、自車の前方を走行する先行車の走行状態に関
する情報に基づいて自車の第1進行路を推定するように
しているので、常時精度良く第1進行路を推定すること
ができる。また、第3実施例においては、先行車が自車
と同一車線を走行している場合と、先行車が自車の隣接
車線を走行している場合とに分けて自車の第1進行路を
推定するようにしているので、その分精度良く第1進行
路を推定することができる。
As described above, in the third embodiment of the present invention, a stationary object (for example, a roadside reflector) is placed in front of the host vehicle.
When there is a stationary object, the first traveling path of the vehicle is estimated based on the attribute of the stationary object. On the other hand, when there is no stationary object, the traveling state of a preceding vehicle traveling in front of the vehicle is estimated. Since the first traveling path of the own vehicle is estimated based on the information, it is possible to always estimate the first traveling path with high accuracy. In addition, in the third embodiment, the first traveling path of the own vehicle is divided into a case where the preceding vehicle is traveling in the same lane as the own vehicle and a case where the preceding vehicle is traveling in the adjacent lane of the own vehicle. Therefore, the first traveling path can be estimated with high accuracy.

【0035】[0035]

【発明の効果】以上説明したように本発明の車両の走行
制御装置によれば、自車の進行方向の推定が不安定な状
態のときに進行路上の先行車の検出を適切に行うことが
できる。また、本発明によれば、自車の走行状態等に基
づいて予測する第1の進行路と、先行車の位置に基づい
て予測する第2の進行路とを併用することにより、曲線
道路上で先行車と自車との間に割り込んで来る車をも早
期に検出できる。
As described above, according to the vehicle travel control device of the present invention, it is possible to appropriately detect the preceding vehicle on the traveling road when the estimation of the traveling direction of the vehicle is unstable. it can. Further, according to the present invention, the first traveling path predicted based on the traveling state of the own vehicle and the second traveling path predicted based on the position of the preceding vehicle are used together, so that the curved road With, it is possible to detect a vehicle that comes in between the preceding vehicle and the own vehicle at an early stage.

【図面の簡単な説明】[Brief description of drawings]

【図1】 本発明の自動車の走行制御装置の第1実施例
の全体構成を示すブロック図
FIG. 1 is a block diagram showing the overall configuration of a first embodiment of a vehicle travel control device according to the present invention.

【図2】 本発明の第1実施例のコントロールユニット
を示すブロック図
FIG. 2 is a block diagram showing a control unit according to the first embodiment of the present invention.

【図3】 本発明の第1実施例による追従走行時の制御
のメインルーチンを示すフローチャート
FIG. 3 is a flowchart showing a main routine of control during follow-up traveling according to the first embodiment of the present invention.

【図4】 本発明の第1実施例による第1進行路の推定
のサブルーチンを示すフローチャート
FIG. 4 is a flowchart showing a subroutine for estimating a first traveling path according to the first embodiment of the present invention.

【図5】 本発明の第1実施例によるロックオン対象車
の登録のサブルーチンを示すフローチャート
FIG. 5 is a flowchart showing a subroutine for registering a lock-on target vehicle according to the first embodiment of the present invention.

【図6】 本発明の第1実施例によるロックオンの実行
のサブルーチンを示すフローチャート
FIG. 6 is a flowchart showing a subroutine of lock-on execution according to the first embodiment of the present invention.

【図7】 本発明の第1実施例によるロックオンの変更
及び解除のサブルーチンを示すフローチャートの部分図
FIG. 7 is a partial view of a flowchart showing a subroutine for changing and releasing lock-on according to the first embodiment of the present invention.

【図8】 本発明の第1実施例によるロックオンの変更
及び解除のサブルーチンを示すフローチャートの部分図
FIG. 8 is a partial view of a flowchart showing a subroutine for changing and releasing lock-on according to the first embodiment of the present invention.

【図9】 本発明の第1実施例による第2進行路の推定
を説明するための図
FIG. 9 is a diagram for explaining estimation of a second traveling path according to the first embodiment of the present invention.

【図10】 第1進行路と第2進行路とが異なる状態を
示す図
FIG. 10 is a diagram showing a state in which the first traveling road and the second traveling road are different from each other.

【図11】 本発明の第1実施例の変形例を示す図8相
当図
FIG. 11 is a view corresponding to FIG. 8 showing a modification of the first embodiment of the present invention.

【図12】 本発明の第1実施例における所定値Ra設
定用のマップを示す図
FIG. 12 is a diagram showing a map for setting a predetermined value Ra in the first embodiment of the present invention.

【図13】 本発明の第1実施例における車間距離及び
相対速度と減速制御量との関係を示す図
FIG. 13 is a diagram showing a relationship between an inter-vehicle distance and a relative speed and a deceleration control amount in the first embodiment of the present invention.

【図14】 本発明の第2実施例によるコントロールユ
ニットを示すブロック図
FIG. 14 is a block diagram showing a control unit according to a second embodiment of the present invention.

【図15】 本発明の第2実施例による制御の流れを示
すフローチャート
FIG. 15 is a flowchart showing the flow of control according to the second embodiment of the present invention.

【図16】 本発明の第2実施例における静止物体の属
性データで基づく進行路の曲率半径推定の説明図
FIG. 16 is an explanatory diagram of estimation of a radius of curvature of a traveling path based on attribute data of a stationary object according to the second embodiment of the present invention.

【図17】 本発明の第2実施例の変形例によるフロー
チャートの一部分
FIG. 17 is a part of a flowchart according to a modification of the second embodiment of the present invention.

【図18】 本発明の第2実施例の変形例によるフロー
チャートの一部分
FIG. 18 is a part of a flowchart according to a modification of the second embodiment of the present invention.

【図19】 本発明の第2実施例の他の変形例によるフ
ローチャートの一部分(図18相当図)
FIG. 19 is a part of a flowchart according to another modification of the second embodiment of the present invention (corresponding to FIG. 18).

【図20】 本発明の第3実施例による基本制御内容を
示すフローチャート
FIG. 20 is a flowchart showing the basic control contents according to the third embodiment of the present invention.

【図21】 本発明の第3実施例のサブルーチンを示す
フローチャート
FIG. 21 is a flowchart showing a subroutine of the third embodiment of the present invention.

【図22】 本発明の第3実施例において先行車が自車
と同一車線を走行している状態を示す図
FIG. 22 is a diagram showing a state in which the preceding vehicle is traveling in the same lane as the own vehicle in the third embodiment of the present invention.

【図23】 本発明の第3実施例において先行車が自車
の隣接車線を走行している状態を示す図
FIG. 23 is a diagram showing a state in which the preceding vehicle is traveling in the adjacent lane of the own vehicle in the third embodiment of the present invention.

【符号の説明】[Explanation of symbols]

4 コントールユニット 7 レーダ装置 12 車速センサ 13 舵角センサ 14 ヨーレートセンサ 18 ロックオンスイッチ 22 第1進行路推定手段 23 先行車識別手段 24 第2進行路推定手段 30 第1進行路推定手段 31 物体検出手段 32 静止物体検出手段 33 第1進行路第2推定手段 34 第1進行路第1推定手段 35 選択手段 M 自車 A,B,C 先行車 4 control unit 7 radar device 12 vehicle speed sensor 13 rudder angle sensor 14 yaw rate sensor 18 lock-on switch 22 first traveling road estimating means 23 preceding vehicle identifying means 24 second traveling road estimating means 30 first traveling road estimating means 31 object detecting means 32 stationary object detecting means 33 first traveling road second estimating means 34 first traveling road first estimating means 35 selecting means M own vehicle A, B, C preceding vehicle

フロントページの続き (72)発明者 安藤 悟 広島県安芸郡府中町新地3番1号 マツダ 株式会社内 (72)発明者 奥田 和徳 広島県安芸郡府中町新地3番1号 マツダ 株式会社内 (72)発明者 石原 敏広 広島県安芸郡府中町新地3番1号 マツダ 株式会社内 (72)発明者 稲田 貴裕 広島県安芸郡府中町新地3番1号 マツダ 株式会社内 (72)発明者 奥田 恒久 広島県安芸郡府中町新地3番1号 マツダ 株式会社内Front page continued (72) Inventor Satoru Ando 3-1, Shinchu, Fuchu-cho, Aki-gun, Hiroshima Prefecture Mazda Co., Ltd. (72) Inventor, Kazunori Okuda 3-3-1 Shinchi, Fuchu-cho, Aki-gun, Hiroshima Prefecture (72) ) Inventor Toshihiro Ishihara 3-1, Shinchi Fuchu-cho, Aki-gun, Hiroshima Prefecture Mazda Co., Ltd. (72) Inventor Takahiro Inada 3-3 Shinchi, Fuchu-cho, Aki-gun, Hiroshima Prefecture (72) Inventor Tsunehisa Okuda Hiroshima 3-1, Shinchi, Fuchu-cho, Aki-gun, Makida

Claims (8)

【特許請求の範囲】[Claims] 【請求項1】 自車の前方に存在する物体を検出する物
体検出手段と、 自車が走行すべき第1進行路を推定する第1進行路推定
手段と、 上記物体検出手段により検出された上記第1進行路上に
存在する先行車の中から自車の対象車となる先行車を識
別する先行車識別手段と、 少なくとも上記先行車が第1進行路から外れたときこの
先行車に基づいて自車の第2進行路を推定する第2進行
路推定手段と、を有し、 上記先行車識別手段は、上記先行車が第1進行路から外
れたときこの第1進行路上に存在する先行車と上記第2
進行路上に存在する先行車の中から自車の対象車となる
先行車を識別するように設けられていることを特徴とす
る自動車の走行制御装置。
1. An object detecting means for detecting an object existing in front of the own vehicle, a first traveling road estimating means for estimating a first traveling road on which the own vehicle should travel, and an object detecting means for detecting the first traveling road. Based on a preceding vehicle identifying means for identifying a preceding vehicle that is a target vehicle of the own vehicle from preceding vehicles existing on the first traveling path, and based on the preceding vehicle at least when the preceding vehicle deviates from the first traveling path A second traveling road estimating means for estimating a second traveling road of the host vehicle, wherein the preceding vehicle identifying means is a leading vehicle existing on the first traveling road when the preceding vehicle deviates from the first traveling road. Car and above second
A traveling control device for an automobile, which is provided so as to identify a preceding vehicle that is a target vehicle of the own vehicle from among preceding vehicles existing on a traveling road.
【請求項2】 上記第1進行路推定手段は、自車の走行
状態に基づいて第1進行路を推定するように設けられた
請求項1記載の自動車の走行制御装置。
2. The vehicle traveling control device according to claim 1, wherein the first traveling path estimating means is provided so as to estimate the first traveling path based on a traveling state of the vehicle.
【請求項3】 更に、上記第1進行路上に存在する物体
が静止物体であるか否かを判定する静止物体判定手段を
有し、上記第1進行路推定手段は、上記静止物体判定手
段により判定された静止物体の属性に基づいて第1進行
路を推定するように設けられた請求項1記載の自動車の
走行制御装置。
3. A stationary object determining means for determining whether or not an object existing on the first traveling path is a stationary object, and the first traveling path estimating means is configured to detect the stationary object by the stationary object determining means. The vehicle traveling control device according to claim 1, wherein the traveling control device is provided so as to estimate the first traveling path based on the determined attribute of the stationary object.
【請求項4】 上記先行車識別手段は、上記先行車を追
従対象車として識別するように設けられ、上記第2進行
路推定手段は、この追従対象車として識別された先行車
に基づいて第2進行路を推定するように設けられた請求
項1記載の自動車の走行制御装置。
4. The preceding vehicle identifying means is provided so as to identify the preceding vehicle as a target vehicle to be followed, and the second traveling path estimating means is configured to identify the preceding vehicle based on the preceding vehicle identified as the target vehicle. The traveling control device for a vehicle according to claim 1, which is provided so as to estimate two traveling paths.
【請求項5】 上記先行車識別手段は、上記先行車が第
1進行路から外れた時点からその外れた地点に自車が到
達するまでの間は上記第2進行路上に存在する先行車の
中から自車の対象車となる先行車を識別し、自車がその
外れた時点に到着するまでに上記先行車が第1進行路に
戻らないときは、その後第1進行路上に存在する先行車
の中から自車の対象車となる先行車を識別するように設
けられ、上記第2進行路推定手段は、この識別された自
車の対象車となる先行車を基にして第2進行路を推定す
るように設けられた請求項1記載の自動車の走行制御装
置。
5. The preceding vehicle identifying means detects the number of preceding vehicles existing on the second traveling road from the time when the preceding vehicle deviates from the first traveling path to the time when the vehicle arrives at a point deviating from the first traveling path. If the preceding vehicle that is the target vehicle of the own vehicle is not identified and the preceding vehicle does not return to the first traveling path before the vehicle arrives at the time when the vehicle deviates from the inside, the preceding vehicles existing on the first traveling path thereafter. The second traveling path estimating means is provided so as to identify a preceding vehicle that is a target vehicle of the own vehicle from among the vehicles, and the second traveling path estimating means performs the second traveling based on the identified preceding vehicle that is the target vehicle of the own vehicle. The vehicle travel control device according to claim 1, which is provided so as to estimate a road.
【請求項6】 上記先行車識別手段は、上記追従対象車
として識別された先行車よりも第1進行路又は第2進行
路上に自車の追従対象車とすべき先行車が存在する場合
には、その追従対象車とすべき先行車を追従対象車とし
て識別するように設けられている請求項4記載の自動車
の走行制御装置。
6. The preceding vehicle identifying means, when there is a preceding vehicle to be followed by the own vehicle on the first traveling path or the second traveling path than the preceding vehicle identified as the following object vehicle. The vehicle traveling control device according to claim 4, wherein the vehicle is provided so as to identify a preceding vehicle that should be the following target vehicle as the following target vehicle.
【請求項7】 上記第1進行路推定手段は、自車の前方
に存在する先行車に基づいて第1進行路を推定するよう
に設けられた請求項1記載の自動車の走行制御装置。
7. The vehicle traveling control device according to claim 1, wherein the first traveling path estimating means is provided so as to estimate the first traveling path based on a preceding vehicle existing ahead of the own vehicle.
【請求項8】 上記第2進行路推定手段により推定され
る第2進行路は、自車と先行車を所定幅を有するように
結んだものである請求項1記載の自動車の走行制御装
置。
8. The vehicle traveling control device according to claim 1, wherein the second traveling path estimated by the second traveling path estimating means is a connection between the own vehicle and the preceding vehicle having a predetermined width.
JP29272994A 1993-12-07 1994-11-28 Car driving control device Expired - Fee Related JP3582071B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP29272994A JP3582071B2 (en) 1993-12-07 1994-11-28 Car driving control device

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP30645493 1993-12-07
JP5-306454 1993-12-07
JP29272994A JP3582071B2 (en) 1993-12-07 1994-11-28 Car driving control device

Publications (2)

Publication Number Publication Date
JPH07220199A true JPH07220199A (en) 1995-08-18
JP3582071B2 JP3582071B2 (en) 2004-10-27

Family

ID=26559115

Family Applications (1)

Application Number Title Priority Date Filing Date
JP29272994A Expired - Fee Related JP3582071B2 (en) 1993-12-07 1994-11-28 Car driving control device

Country Status (1)

Country Link
JP (1) JP3582071B2 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002341027A (en) * 2001-05-16 2002-11-27 Fujitsu Ten Ltd Curve r correction method and device for acc system of vehicle
JP2004102421A (en) * 2002-09-05 2004-04-02 Mitsubishi Electric Corp Road curvature computing method
US6853906B1 (en) * 1998-12-01 2005-02-08 Robert Bosch Gmbh Method and device for determining a future travel-path area of a vehicle
JP2008254551A (en) * 2007-04-04 2008-10-23 Honda Motor Co Ltd Vehicle travel control device
JP2012066777A (en) * 2010-09-27 2012-04-05 Mazda Motor Corp Yaw rate deviation detection apparatus
JP2012198730A (en) * 2011-03-21 2012-10-18 Denso Corp Recognition method and device of road shape for vehicle, and recording medium
KR20150110713A (en) * 2013-01-25 2015-10-02 바브코 게엠베하 Method for determining a triggering criterion for braking and an emergency braking system for a vehicle

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6853906B1 (en) * 1998-12-01 2005-02-08 Robert Bosch Gmbh Method and device for determining a future travel-path area of a vehicle
JP2002341027A (en) * 2001-05-16 2002-11-27 Fujitsu Ten Ltd Curve r correction method and device for acc system of vehicle
JP2004102421A (en) * 2002-09-05 2004-04-02 Mitsubishi Electric Corp Road curvature computing method
JP2008254551A (en) * 2007-04-04 2008-10-23 Honda Motor Co Ltd Vehicle travel control device
US8290698B2 (en) 2007-04-04 2012-10-16 Honda Motor Co., Ltd. Vehicle travel control apparatus
JP2012066777A (en) * 2010-09-27 2012-04-05 Mazda Motor Corp Yaw rate deviation detection apparatus
JP2012198730A (en) * 2011-03-21 2012-10-18 Denso Corp Recognition method and device of road shape for vehicle, and recording medium
KR20150110713A (en) * 2013-01-25 2015-10-02 바브코 게엠베하 Method for determining a triggering criterion for braking and an emergency braking system for a vehicle

Also Published As

Publication number Publication date
JP3582071B2 (en) 2004-10-27

Similar Documents

Publication Publication Date Title
US5648905A (en) Traveling control system for motor vehicle
US8423250B2 (en) Vehicle control device, vehicle control method and computer program
JP3658519B2 (en) Vehicle control system and vehicle control device
US8040253B2 (en) Lane-change assistant for motor vehicles
EP2009464B1 (en) Object detection device
US6114973A (en) Method and apparatus for recognizing whether traffic drives on the right or on the left
US7275431B2 (en) Vehicle mounted system for detecting objects
JP2002022832A (en) Method and apparatus for recognizing object, recording medium
JPS61278775A (en) Preceding vehicle detecting device
JP2000147115A (en) On-vehicle radar apparatus
US8165797B2 (en) Vehicular control object determination system and vehicular travel locus estimation system
EP2060455B1 (en) Vehicle control device, vehicle control method, and computer program
JP2002098758A (en) Method and device for finding position of automobile with respect to traveling lane
JP3575352B2 (en) Vehicle position locating device and recording medium
JPH07220199A (en) Travel controller for automobile
JP2002175599A (en) Lane position estimating device for precedent vehicle or target
JP2002029348A (en) Outside recognizer for vehicle
JP3937540B2 (en) Vehicle object recognition device
JP3521292B2 (en) Car driving control device
JPH11144198A (en) Object identifying device for vehicle
JP3433553B2 (en) Car driving control device
JPH08216726A (en) Travel control device for automobile
JP2002319100A (en) Device for estimating locus of vehicle, and travel safety device for vehicle using the same
JPH11118925A (en) Distance-between-vehicles alarm apparatus
JP5645103B2 (en) Leading vehicle detector

Legal Events

Date Code Title Description
TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20040705

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20040718

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20080806

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20090806

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20090806

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20100806

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20110806

Year of fee payment: 7

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

Free format text: PAYMENT UNTIL: 20120806

Year of fee payment: 8

LAPS Cancellation because of no payment of annual fees