JP3433553B2 - Car driving control device - Google Patents

Car driving control device

Info

Publication number
JP3433553B2
JP3433553B2 JP02687795A JP2687795A JP3433553B2 JP 3433553 B2 JP3433553 B2 JP 3433553B2 JP 02687795 A JP02687795 A JP 02687795A JP 2687795 A JP2687795 A JP 2687795A JP 3433553 B2 JP3433553 B2 JP 3433553B2
Authority
JP
Japan
Prior art keywords
vehicle
interpolation
lock
data
traveling
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.)
Expired - Fee Related
Application number
JP02687795A
Other languages
Japanese (ja)
Other versions
JPH08216725A (en
Inventor
知示 和泉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
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 JP02687795A priority Critical patent/JP3433553B2/en
Publication of JPH08216725A publication Critical patent/JPH08216725A/en
Application granted granted Critical
Publication of JP3433553B2 publication Critical patent/JP3433553B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Description

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

【0001】[0001]

【産業上の利用分野】本願発明は、自車の進行路上に存
在する前方物体(例えば、先行車)に追従して自車を走
行させる自動車の走行制御装置に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a traveling control device for an automobile which allows the subject vehicle to travel by following a front object (for example, a preceding vehicle) existing on the traveling path of the subject vehicle.

【0002】[0002]

【従来の技術】この種の自動車の走行制御装置として
は、例えば自車の前方にレーダ波を発信し、前方に存在
する物体からの反射波を検出して前方物体の有無を検出
するスキャン式レーダ装置により水平方向に比較的広角
度での走査を行い、該走査により得られる情報の中か
ら、マイクロコンピュータを利用して、自車のステアリ
ング舵角やヨーレート等の走行状態に基づいて推定され
る自車の進行路に沿った領域内のもののみをピックアッ
プすることにより、スキャン式レーダ装置による前方物
体の検出をソフト的に上記領域内に限定して行うように
したものが既に開発されている。
2. Description of the Related Art An example of a traveling control apparatus for an automobile of this type is a scan type which emits a radar wave in front of the vehicle and detects a reflected wave from an object existing in the front to detect the presence or absence of a front object. The radar device scans in a horizontal direction at a relatively wide angle, and from the information obtained by the scanning, a microcomputer is used to estimate based on the traveling state such as the steering angle and yaw rate of the vehicle. By picking up only those in the area along the traveling path of the own vehicle, the one in which the detection of the front object by the scanning radar device is limited to the above area by software has already been developed. There is.

【0003】ところで、上記のようにしてスキャン式レ
ーダ装置による前方物体の検出を行う場合において、進
行路上に物体が存在しているにもかかわらず、道路のカ
ント等に起因してレーダ波の反射波が検出できない(換
言すれば、スキャン式レーダ装置による検出データが消
滅する)という現象が生ずるおそれがある。このような
場合、マイクロコンピュータによる進行路上に存在する
前方物体の検出処理を初めから再度行わなければならな
いという不具合が生ずる。
By the way, when a forward object is detected by the scanning type radar device as described above, the radar wave is reflected due to the cant of the road despite the existence of the object on the traveling road. There is a possibility that a phenomenon in which a wave cannot be detected (in other words, the detection data by the scanning radar device disappears) occurs. In such a case, there arises a problem that the detection process of the front object existing on the traveling path by the microcomputer has to be performed again from the beginning.

【0004】上記のような不具合に対処するために、追
尾している前方物体が消滅した後に再出現した時同一物
体として自動追尾を再開するようにしたもの(換言すれ
ば、追尾していた検出データを所定時間に限り補間する
もの)が提案されている(例えば、特開平3−2069
89号後方参照)。
In order to deal with the above-mentioned problems, automatic tracking is restarted as the same object when the tracked front object disappears and then reappears (in other words, the detection of tracking has been completed). A device that interpolates data only for a predetermined time) has been proposed (for example, JP-A-3-2069).
(See No. 89 rear).

【0005】[0005]

【発明が解決しようとする課題】ところで、上記したよ
うに前方物体が消滅した場合に所定時間に限りそのデー
タを補間する場合、前方物体が移動物体であると、消滅
前に検出された検出データを固定した状態で補間する
と、スキャン間隔毎に前方物体も移動するところから的
確なデータ補間ができない場合が生ずる。つまり、消滅
後再出現するまでの補間時間において、補間データを消
滅前の前方物体の移動状況に対応させて位置補間する必
要が生ずるのである。
When the front object disappears as described above and the data is interpolated for a predetermined time, if the front object is a moving object, the detection data detected before the disappearance is detected. If the interpolation is performed with the fixed value, the front object also moves at each scan interval, which may result in inaccurate data interpolation. In other words, it is necessary to interpolate the interpolation data in correspondence with the moving state of the front object before disappearance during the interpolation time after disappearance and before reappearing.

【0006】上記のような補間を行っていると、補間中
の物体の補間位置近傍に補間中の物体とは異なる物体
(例えば、道路脇のリフレクタ等)のデータが検出され
ることがある。その時、補間中の物体とは異なる物体で
あるにもかかわらず、補間中の物体の実像と誤判断して
しまうおそれがある。このような誤判断が生じると、自
動車の追従走行制御を行う上で問題となるところから、
上記誤判断をなくすることが要求されている。
When the above interpolation is performed, data of an object different from the object being interpolated (for example, a roadside reflector) may be detected near the interpolation position of the object being interpolated. At that time, there is a possibility that the object may be erroneously determined as a real image of the object being interpolated even though the object is different from the object being interpolated. If such an erroneous judgment occurs, it will be a problem in performing follow-up running control of the vehicle.
It is required to eliminate the above erroneous judgment.

【0007】本願発明は、上記の点に鑑みてなされたも
ので、前方物体の消滅時における物体データの補間中に
おいて、補間中の物体と異なる物体を補間中の物体の実
像と誤判断することのないようにすることを目的とする
ものである。
The present invention has been made in view of the above points, and during interpolation of object data when a front object disappears, an object different from the object being interpolated is erroneously determined as a real image of the object being interpolated. The purpose is to prevent.

【0008】[0008]

【課題を解決するための手段】本願発明の基本構成で
は、上記課題を解決するための手段として、自車の前方
に存在する物体の有無を検出する物体検出手段(例え
ば、自車の前方に向けてレーザレーダ波を発信し、前方
物体からの反射波を検出するレーザレーダ装置)と、自
車の走行状態(例えば、自車の舵角データおよび車速デ
ータ、あるいは自車のヨーレートデータおよび車速デー
タ)に基づいて自車前方の進行路を推定する進行路推定
手段と、前記物体検出手段により検出された物体データ
が消滅した場合に所定時間その物体データを補間する補
間手段とを備えた自動車の走行制御装置において、前記
物体検出手段により検出された物体データにおける移動
ベクトル量(例えば、物体の移動方向に関するベクトル
量あるいは物体の移動量に関するベクトル量)を算出す
る算出手段と、前記補間手段による補間中において補間
物体の補間位置近傍に物体データが検出された際には当
該物体と補間物体とにおける移動ベクトル量を比較して
同一物体か否かを判定する判定手段と、前記物体検出手
段により検出された物体が前記進行路上に所定移動条件
をもって存在するかを判断し、これを自車の追従対象物
体と判定するロックオン判定手段と、自車と追従対象物
体との距離および相対速度に基づいて自車を追従対象物
体に追従させるように自車の車速を制御する追従制御手
段と、前記補間手段による補間が追従対象物体に対して
行われている場合であって前記判定手段により否定判定
された場合にのみ前記補間物体に対する補間を継続する
補間継続手段とを付設している。
In the basic configuration of the present invention, as means for solving the above-mentioned problems, an object detecting means for detecting the presence or absence of an object existing in front of the vehicle (for example, in front of the vehicle) Laser radar device that emits a laser radar wave toward the vehicle and detects a reflected wave from a front object), and the running state of the vehicle (for example, the steering angle data and vehicle speed data of the vehicle, or the yaw rate data and vehicle speed of the vehicle). A vehicle equipped with a traveling path estimating means for estimating a traveling path ahead of the own vehicle based on the data) and an interpolating means for interpolating the object data for a predetermined time when the object data detected by the object detecting means disappears. In the traveling control device, the movement vector amount in the object data detected by the object detection means (for example, the vector amount in the moving direction of the object or the movement of the object). Calculation means for calculating the vector amount), and when the object data is detected in the vicinity of the interpolation position of the interpolation object during the interpolation by the interpolation means, the movement vector amounts of the object and the interpolation object are compared to determine the same object. Determination means for determining whether or not the object detection hand
The object detected by the step has a predetermined movement condition on the traveling path.
It is determined whether there is a
Lock-on determination means for determining the body, the vehicle, and the object to be followed
Follows your vehicle based on its distance and relative speed
A tracking control hand that controls the speed of the vehicle so that it follows the body.
Stage, and the interpolation by the interpolation means
If it has been done, the determination means makes a negative determination
Interpolation is continued for the interpolated object only when
Interpolation continuation means is attached.

【0009】[0009]

【作用】本願発明の基本構成では、上記手段によって次
のような作用が得られる。
In the basic configuration of the present invention, the following actions can be obtained by the above means.

【0010】即ち、自車前方の物体に関する物体検出手
段(例えば、レーザレーダ装置)により検出される物体
データが何らかの原因により消滅した場合には、補間手
段により前記物体データが所定時間だけ補間されるが、
その補間中において、補間中の物体の補間位置近傍にお
いて物体データが検出されると、当該物体と補間物体と
の移動ベクトル量(例えば、物体の移動方向に関するベ
クトル量あるいは物体の移動量に関するベクトル量)が
比較され、当該移動ベクトル量の差により補間中に検出
された物体データを有する物体と補間物体との同一性
(換言すれば、補間中に検出された物体データを有する
物体が補間物体の実像であるか否か)が判定される。
して、前記物体検出手段により検出された物体が前記進
行路上に所定移動条件をもって存在するかを判断し、こ
れを自車の追従対象物体と判定するロックオン判定手段
と、自車と追従対象物体との距離および相対速度に基づ
いて自車を追従対象物体に追従させるように自車の車速
を制御する追従制御手段と、前記補間手段による補間が
追従対象物体に対して行われている場合であって前記判
定手段により否定判定された場合にのみ前記補間物体に
対する追従制御を継続する補間継続手段とを付設するこ
とにより、補間中の物体とは異なる物体を自車の追従対
象物体の実像と誤判断することなく補間を継続実行でき
る。
That is, when the object data detected by the object detection means (for example, a laser radar device) for the object in front of the vehicle disappears for some reason, the interpolation means interpolates the object data for a predetermined time. But,
During the interpolation, when the object data is detected in the vicinity of the interpolation position of the object being interpolated, the movement vector amount between the object and the interpolation object (for example, the vector amount related to the movement direction of the object or the vector amount related to the movement amount of the object). ) Are compared, and the sameness between the object having the object data detected during interpolation and the interpolation object due to the difference in the movement vector (in other words, the object having the object data detected during interpolation is Whether or not it is a real image) is determined. So
Then, it is determined whether the object detected by the object detection means exists on the traveling path with a predetermined movement condition, and lock-on determination means for determining this as an object to be followed by the own vehicle, and own vehicle and the following object. A tracking control means for controlling the vehicle speed of the own vehicle so that the own vehicle follows the object to be followed based on the distance to the object and the relative speed, and the interpolation by the interpolation means is performed on the object to be followed. And an interpolation continuation unit that continues the follow-up control for the interpolation object only when the determination unit makes a negative determination .
Thus , the interpolation can be continuously executed without erroneously determining the object different from the object being interpolated as the real image of the tracking target object of the vehicle.

【0011】[0011]

【発明の効果】本願発明の基本構成によれば、自車前方
の物体に関する物体検出手段(例えば、レーザレーダ装
置)により検出される物体データが何らかの原因により
消滅した場合において、補間手段により前記物体データ
を所定時間だけ補間している間に、補間中の物体の補間
位置近傍において物体データが検出された場合、当該物
体と補間物体との移動ベクトル量(例えば、物体の移動
方向に関するベクトル量あるいは物体の移動量に関する
ベクトル量)を比較し、当該移動ベクトル量の差により
補間中に検出された物体データを有する物体と補間物体
との同一性(換言すれば、補間中に検出された物体デー
タを有する物体が補間物体の実像であるか否か)を判定
するとともに、否定判定された場合にのみ前記補間物体
に対する補間を継続するようにしたので、補間中におけ
る物体識別(換言すれば、補間物体の正確な認識)が得
られるという優れた効果がある。
According to the basic configuration of the present invention, when the object data detected by the object detecting means (for example, a laser radar device) for the object in front of the vehicle disappears for some reason, the interpolating means causes the object to be detected. When the object data is detected in the vicinity of the interpolation position of the object being interpolated while the data is being interpolated for a predetermined time, the movement vector amount between the object and the interpolation object (for example, the vector amount relating to the movement direction of the object or The vector amount relating to the moving amount of the object) is compared, and the identity of the object having the object data detected during interpolation by the difference in the moving vector amount and the interpolated object (in other words, the object data detected during interpolation) Whether or not the object having is a real image of an interpolating object) is determined, and the interpolating object is determined only when a negative determination is made.
Since the interpolation for is continued, there is an excellent effect that the object identification during the interpolation (in other words, the accurate recognition of the interpolated object) can be obtained.

【0012】[0012]

【実施例】以下、添付の図面を参照して本願発明の好適
な実施例を説明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Preferred embodiments of the present invention will be described below with reference to the accompanying drawings.

【0013】図1には、本願発明の実施例にかかる自動
車の走行制御装置の全体構成が示されている。ここで、
符号1はエンジン吸気系のスロットル弁(図示省略)の
開度を自動調整するスロットル制御装置、2は電子制御
式自動変速機(EAT)の制御装置、3は各車輪に付与
する制動力を自動調整するブレーキ制御装置であり、こ
れら三種類の制御装置1〜3は、いずれも図示していな
いアクチュエータを有し、該各アクチュエータは、コン
トロールユニット4により制御されることとなってい
る。
FIG. 1 shows the overall construction of a vehicle travel control device according to an embodiment of the present invention. here,
Reference numeral 1 is a throttle control device for automatically adjusting 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 automatic braking force applied to each wheel. These three types of control devices 1 to 3 are brake control devices for adjustment, and each of them has an actuator (not shown), and each actuator is controlled by the control unit 4.

【0014】即ち、前記コントロールユニット4は、ス
ロットル制御装置1のアクチュエータに対し目標スロッ
トル開度信号を出力して制御を行うとともに、ブレーキ
制御装置3のアクチュエータに対し目標ブレーキ量信号
を出力して制御を行う。また、コントロールユニット4
は、EAT制御装置2のシフト位置を検出するセンサー
(図示省略)からのシフト位置信号を受けつつ、該EA
T制御装置2のアクチュエータに対しシフト制御信号を
出力して制御を行う。
That is, the control unit 4 outputs a target throttle opening signal to the actuator of the throttle control device 1 for control, and outputs a target brake amount signal to the actuator of the brake control device 3 for control. I do. Also, the control unit 4
Receives a shift position signal from a sensor (not shown) that detects the shift position of the EAT control device 2,
A shift control signal is output to the actuator of the T control device 2 for control.

【0015】符号5で示す情報表示装置は、車室内のイ
ンストルメントパネル等に設けられ、図示していない
が、前記コントロールユニット4からの警報信号を受け
て点灯する警報ランプと、コントロールユニット4から
の自己診断信号を受けて画面表示する表示部とを備えて
いる。
The information display device indicated by the reference numeral 5 is provided on an instrument panel or the like in the vehicle compartment, and although not shown, an alarm lamp which is turned on upon receiving an alarm signal from the control unit 4 and the control unit 4 are turned on. And a display unit for displaying the self-diagnosis signal on the screen.

【0016】符号6で示すレーザレーダ装置は、自車の
前方に存在する物体(例えば、先行車等)を検出する物
体検出手段として作用するものであり、レーザレーダ波
を自車の前方に向けて発信し、前方物体に当たって反射
してくる反射波を受信し、その受信時点と発信時点との
時間差によって自車と前方物体との間の距離を測定する
ように構成されている。このレーザレーダ装置6により
検出された検出信号は、車間距離信号として前記コント
ロールユニット4に入力される。また、本実施例のレー
ザレーダ装置6は、レーザレーダ波を水平方向に比較的
広角度で走査するスキャン式のものとされている。
The laser radar device shown by reference numeral 6 acts as an object detecting means for detecting an object (for example, a preceding vehicle) existing in front of the own vehicle, and directs the laser radar wave to the front of the own vehicle. It is configured so that the reflected wave that is transmitted by the vehicle and that is reflected by hitting the front object is received, and the distance between the vehicle and the front object is measured by the time difference between the reception time and the transmission time. The detection signal detected by the laser radar device 6 is input to the control unit 4 as an inter-vehicle distance signal. Further, the laser radar device 6 of the present embodiment is of a scan type that scans the laser radar wave in the horizontal direction at a relatively wide angle.

【0017】符号7はスロットル弁の開度を検出するス
ロットル開度センサー、8は車速を検出する車速センサ
ー、9はステアリング舵角(以下、単に舵角という)を
検出する舵角センサー、10は自車に発生するヨーレー
トを検出するヨーレートセンサー、11は自車に発生す
る横加速度を検出する横Gセンサー、12はブレーキペ
ダルの踏み込み時にON作動するブレーキスイッチ、1
3はクラッチの作動状態に応じてON作動するクラッチ
スイッチ、14はロックオンスイッチ、15は自車のオ
ークルーズ運転時ON作動されるオークルーズスイッチ
であり、これらのセンサー・スイッチ類7〜15の検出
信号は、いずれもコントロールユニット4に入力され
る。なお、図示していないエンジン回転数センサーやそ
の他のセンサー・スイッチ類の検出信号もコントロール
ユニット4に入力されるが、これらについての詳細な説
明は省略する。
Reference numeral 7 is a throttle opening sensor for detecting the opening of the throttle valve, 8 is a vehicle speed sensor for detecting the vehicle speed, 9 is a steering angle sensor for detecting a steering steering angle (hereinafter, simply referred to as steering angle), and 10 is a steering angle sensor. A yaw rate sensor for detecting the yaw rate generated in the host vehicle, 11 a lateral G sensor for detecting lateral acceleration generated in the host vehicle, 12 a brake switch that is turned on when the brake pedal is depressed, 1
Reference numeral 3 is a clutch switch that is turned on according to the operating state of the clutch, 14 is a lock-on switch, and 15 is an au-cruise switch that is turned on during au-cruise operation of the vehicle. All the detection signals are input to the control unit 4. Although detection signals of an engine speed sensor (not shown) and other sensors and switches are also input to the control unit 4, detailed description thereof will be omitted.

【0018】上記コントロールユニット4は、図2に示
すように、レーザレーダ装置6からの検出信号を始め、
各種のセンサー・スイッチ類7〜15からの検出信号を
受けて所定の情報処理を行う入力情報処理部16と、該
入力情報処理部16から自車の走行状態に関する情報
(例えば、車速センサー8からの車速、舵角センサー9
からの舵角およびヨーレートセンサー10からのヨーレ
ート等)を受け、これらに基づいて自車の進行路を推定
する進行路推定手段17と、前記入力情報処理部16の
情報のうち、特にレーザレーダ装置6で検出された前方
物体に関する検出データ(即ち、物体データ)を受け、
当該物体が前記進行路上に所定移動条件をもって存在す
るかを判断し、これを自車の追従対象物体(即ち、ロッ
クオン対象車)と判定するロックオン判定手段18と、
該ロックオン判定手段18により追従対象物体と判定さ
れたロックオン対象車の情報(即ち、自車とロックオン
対象車との距離および相対速度)に基づいて自車をロッ
クオン対象車に追従させるように自車の車速を制御する
追従制御手段19と、前記入力情報処理部16の情報の
うち、特にレーザレーダ装置6からの追従対象物体(即
ち、ロックオン対象車)に関する物体データが消滅した
場合に所定時間その物体データを補間する補間手段20
と、前記レーザレーダ装置6により検出された物体デー
タにおける移動ベクトル量を算出する算出手段21と、
前記補間手段20による補間中において補間物体の補間
位置近傍に物体データが検出された際には当該物体と補
間物体とにおける移動ベクトル量を比較して同一物体か
否かを判定する判定手段22と、前記補間手段20によ
る補間が追従対象物体に対して行われている場合であっ
て前記判定手段22により否定判定された場合にのみ前
記補間物体に対する補間を継続する補間継続手段23と
を備えている。前記追従制御手段19からの出力信号
は、出力情報処理部24を介して各種アクチュエータに
出力されることとされている。
The control unit 4 starts the detection signal from the laser radar device 6 as shown in FIG.
An input information processing unit 16 that receives detection signals from various sensors and switches 7 to 15 and performs predetermined information processing, and information regarding the running state of the vehicle from the input information processing unit 16 (for example, from the vehicle speed sensor 8). Vehicle speed, rudder angle sensor 9
The steering angle from the vehicle and the yaw rate from the yaw rate sensor 10), and based on these, the traveling path estimating means 17 for estimating the traveling path of the own vehicle, and among the information of the input information processing unit 16, particularly the laser radar device. Receiving detection data (ie, object data) relating to the front object detected in 6,
A lock-on determination unit 18 that determines whether the object exists on the traveling path with a predetermined movement condition and determines that the object is a tracking target object of the own vehicle (that is, a lock-on target vehicle),
The own vehicle is made to follow the lock-on target vehicle based on the information of the lock-on target vehicle determined to be the follow-up target object by the lock-on determination means 18 (that is, the distance and relative speed between the own vehicle and the lock-on target vehicle). As described above, among the information of the tracking control means 19 for controlling the vehicle speed of the own vehicle and the information processing unit 16, the object data regarding the tracking target object (that is, the lock-on target vehicle) from the laser radar device 6 disappears. In this case, the interpolation means 20 for interpolating the object data for a predetermined time
And a calculating means 21 for calculating a movement vector amount in the object data detected by the laser radar device 6,
When the object data is detected in the vicinity of the interpolation position of the interpolation object during the interpolation by the interpolation means 20, the determination means 22 compares the movement vector amounts of the object and the interpolation object to determine whether they are the same object or not. And an interpolation continuation unit 23 that continues the interpolation for the interpolation object only when the interpolation unit 20 is performing interpolation on the tracking target object and the determination unit 22 makes a negative determination. There is. The output signal from the tracking control means 19 is output to various actuators via the output information processing section 24.

【0019】図3には、前記コントロールユニット4に
よる制御のうち、特にロックオンスイッチ14がONに
切り換えられ、自車が先行車に追従して走行する追従走
行時の制御のメインルーチンを示すフローチャートが示
されている。
FIG. 3 is a flow chart showing the main routine of the following control in which the lock-on switch 14 is turned on and the host vehicle follows the preceding vehicle among the controls by the control unit 4. It is shown.

【0020】前記メインルーチンは、進行路の推定(ス
テップS1)と、ロックオン対象車の登録(ステップ
2)と、ロックオンの実行(ステップS3)と、存在物
体の認定と補間(ステップS4)と、補間物体の識別
(ステップS5)、ロックオンの継続、変更および解除
(ステップS6)とからなっており、進行路の推定のサ
ブルーチンは図4に示し、ロックオン対象車の登録のサ
ブルーチンは図5に示し、ロックオンの実行のサブルー
チンは図6に示し、存在物体の認定と補間のサブルーチ
ンは図7に示し、補間物体の識別のサブルーチンは図8
に示し、さらにロックオンの継続、変更および解除のサ
ブルーチンは図9に示す。以下、これらについて順次説
明する。
The main routine is for estimating the traveling path (step S 1 ), registering the lock-on target vehicle (step S 2 ), executing lock-on (step S 3 ), recognizing and interpolating existing objects (step S 3 ). and step S 4), the identification of the interpolation object (step S 5), the continuation of the lock-on, has become since changes and released (step S 6), the subroutine of the estimation of the traveling path is shown in FIG. 4, the lock-on target The subroutine for vehicle registration is shown in FIG. 5, the subroutine for lock-on execution is shown in FIG. 6, the subroutine for recognizing existing objects and the interpolation is shown in FIG. 7, and the subroutine for identifying the interpolated objects is shown in FIG.
Further, a subroutine for continuing, changing and releasing the lock-on is shown in FIG. These will be sequentially described below.

【0021】(進行路の推定) 図4において、まずステップS11において自車データ
(舵角θ、車速v、ヨーレートψ)を読み込んだ後、ス
テップS12において舵角θに基づいて自車の旋回半径R
1を下記の式により、 R1=(1+A・v2)(N・L/θ) 演算する。但し、Aはスタビリティファクタ、Nはステ
アリングギヤ比、Lはホイールベースである。
[0021] In (traveling estimation of path) 4, first the vehicle data in step S 11 (steering angle theta, the vehicle speed v, yaw rate [psi) after reading, in step S 12 of the vehicle based on the steering angle theta Turning radius R
1 by the following formula, R 1 = (1 + A · v 2) (N · L / θ) computed. However, A is a stability factor, N is a steering gear ratio, and L is a wheel base.

【0022】続いて、ステップS13においてヨーレート
ψに基づいて自車の旋回半径R2を下記の式により、 R2=v/ψ 演算する。
Then, in step S 13 , the turning radius R 2 of the vehicle is calculated based on the yaw rate ψ by the following formula, R 2 = v / ψ.

【0023】そして、ステップS14において上記両旋回
半径R1,R2のうち、いずれが小さいかを判断し、ステ
ップS15およびステップS16でその小さい方を進行路の
曲率半径Rとするとともに、ステップS17において前記
曲率半径Rに所定幅を設けて進行路を生成し、リターン
する。ここで、旋回半径R1,R2の小さい方を進行路の
曲率半径Rとしたのは、センサー類の応答遅れ等を考慮
したことによるものである。以上のような進行路の推定
は、コントロールユニット4における進行路推定手段1
7により行われる。なお、進行路の推定は、旋回半径R
1あるいは旋回半径R2のみにより求めても良い。
Then, in step S 14 , it is determined which of the two turning radii R 1 and R 2 is smaller, and in steps S 15 and S 16 , the smaller one is set as the radius of curvature R of the traveling path. In step S 17 , a predetermined width is provided for the radius of curvature R to generate a traveling path, and the process returns. Here, the smaller turning radius R 1 , R 2 is set as the radius of curvature R of the traveling path because the response delay of the sensors is taken into consideration. The estimation of the traveling route as described above is performed by the traveling route estimating means 1 in the control unit 4.
It is performed by 7. In addition, the estimation of the traveling path is performed by the turning radius R
Alternatively, it may be determined by 1 or only the turning radius R 2 .

【0024】(ロックオン対象車の登録) 図5において、まずステップS21においてレーザレーダ
装置6により検出された前方物体の検出データ(距離お
よび方向を示す物体データ)を読み込んだ後、ステップ
22により前記検出データが連続して検出されているか
否かを判定し、ステップS23により検出データが所定の
エリア内で所定の確定度以上のものであるか否かを判定
する。ここで、確定度とは時間当たりの検出回数をい
い、該確定度が所定値以上でないものおよび検出データ
が所定のエリア外にまで広く散在するものは共に物体と
は見做されない。上記両判定が共に肯定判定のときに
は、ステップS24において物体と見做されたものについ
て物体識別番号を付与する。
[0024] In (lock-on registration of the subject vehicle) FIG. 5, after reading the detected data of the forward object detected by the laser radar device 6 in step S 21 (distance and object data indicating a direction), Step S 22 It determines whether the determination whether or not the detected data are continuously detected, or detected data in step S 23 is not less than a predetermined definite level in the predetermined area by. Here, 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 degree that the detection data is widely scattered outside a predetermined area are not considered to be objects. Above when both determination are both affirmative determination imparts an object identification number for those objects regarded in step S 24.

【0025】続いて、ステップS25において上記物体識
別番号を付与した物体が移動体であるか否かを判定す
る。この判定は、自車と物体との間の相対速度と自車速
とから物体の速度を求め、物体の速度が所定のしきい値
以上であるか否かを検討することにより行われる。次
に、ステップS26において物体が進行路上に存在するも
のであるか否かを判定する。上記両判定が共に肯定判定
のときには、ステップS27において物体が進行路上の先
行車であるとしてロックオン(L/O)対象候補とす
る。
[0025] Subsequently, it is determined whether an object that grants the object identification number is a mobile in step S 25. This determination is performed by obtaining the speed of the object from the relative speed between the own vehicle and the object and the own vehicle speed, and examining whether the speed of the object is equal to or higher than a predetermined threshold value. Next, it is determined whether or not an object is present in the traveling path at step S 26. When the affirmative determination the both determination are both the object and lock-on (L / O) candidates as a preceding vehicle traveling road in step S 27.

【0026】しかる後、ステップS18においてロックオ
ン対象候補になった先行車のうち自車との車間距離が最
も近いものであるか、つまり最も近い先行車であるか否
かを判定し、該判定が肯定判定のときには、ステップS
29において当該先行車をロックオン対象車として登録
し、リターンする。以上のようなロックオン対象車の登
録は、コントロールユニット4におけるロックオン判定
手段18により行われる。
Thereafter, in step S 18 , it is determined whether or not the preceding vehicle which is the lock-on target candidate has the shortest vehicle-to-vehicle distance, that is, the closest preceding vehicle. If the determination is affirmative, step S
At 29 , 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 lock-on determination means 18 in the control unit 4.

【0027】(ロックオンの実行) 図6において、まずステップS31においてロックオン対
象車が登録されていることを確認した後、ステップS32
においてロックオンを実行し、リターンする。ロックオ
ンは、ロックオン対象車に対し、所定の車間距離を保ち
且つ同じ車速で追従して走行するように自車速を制御す
るものであり、コントロールユニット4における追従制
御手段19により行われる。
(Execution of lock-on) In FIG. 6, first, in step S 31 , it is confirmed that the lock-on target vehicle is registered, and then in step S 32.
Perform lock-on at and return. The lock-on is to control the own vehicle speed so that the lock-on target vehicle travels at the same vehicle speed while keeping a predetermined vehicle-to-vehicle distance, and is performed by the follow-up control means 19 in the control unit 4.

【0028】(存在物体の認定と補間) 図7において、まずステップS41においてレーザレーダ
装置6により検出された前方物体の検出データ(距離お
よび方向を有する物体データ)を読み込んだ後、ステッ
プS42においてロックオン対象車の登録のサブルーチン
において物体識別番号を付与した物体毎の所定エリア内
に検出データが存在するか否かを判定し、該判定が肯定
判定のときには、ステップS43において物体識別番号毎
にロックオン対象車であるか否かを判定し、該判定が肯
定判定のときには、ステップS44においてロックオン対
象車用の補間カウンタ(例えば、20回のデータ検出の
間当該物体に係る検出データを補間するカウンタ)をセ
ットし、該判定が否定判定のときには、ステップS45
おいて前記ロックオン対象車用の補間カウンタより短い
非ロックオン対象車用の補間カウンタ(例えば、4回の
データ検出の間当該物体に係る検出データを補間するカ
ウンタ)をセットした後リターンする。これらの処理
は、コントロールユニット4における補間手段20によ
り行われる。
(Identification and Interpolation of Existing Object) In FIG. 7, first, in step S 41 , the detection data (object data having distance and direction) of the front object detected by the laser radar device 6 is read, and then step S 42 It determines whether the detected data existing within a predetermined area of each object imparted with the object identification number at a subroutine of the registration of the lock-on target vehicle in, when the determination is affirmative determination, the object identification number at step S 43 it is determined whether the lock-on target vehicle for each, when the determination is affirmative determination, the interpolation counter for lock-on target vehicle in step S 44 (for example, detection of the between the object 20 times of the data detection set the counter) for interpolating the data, the determination is at the negative determination, for the lock-on target vehicle in step S 45 After setting an interpolation counter shorter than the interpolation counter for the non-lock-on target vehicle (for example, a counter that interpolates the detection data related to the object during four times of data detection), the process returns. These processes are performed by the interpolating means 20 in the control unit 4.

【0029】ステップS42において否定判定されたとき
(即ち、レーザレーダ装置6による検出データが消滅し
たとき)には、ステップS46において物体識別番号毎に
ロックオン対象車であるか否かを判定し、該判定が肯定
判定のときには、ステップS47においてロックオン対象
車用の補間カウンタをデクリメントし、該判定が否定判
定のときには、ステップS48において非ロックオン対象
車用の補間カウンタをデクリメントする。ついで、ステ
ップS49において補間カウンタが0以下となっているか
否かを判定し、該判定が肯定判定のときには、ステップ
50において物体識別番号を剥奪し(即ち、物体として
消滅したものとし)、リターンする。この時、ロックオ
ン対象車については後述するロックオンの継続・変更・
解除のサブルーチンにより処理する。なお、ステップS
49において否定判定された場合には、そのままリターン
する。
When a negative determination is made in step S 42 (that is, when the detection data by the laser radar device 6 disappears), it is determined in step S 46 whether or not the vehicle is a lock-on target vehicle for each object identification number. and, when the determination is affirmative determination, the interpolation counter for lock-on target vehicle is decremented in step S 47, the determination is at the negative judgment decrements the interpolation counter for non-lock-on target vehicle in step S 48 . Then, it is determined whether or not interpolation counter is 0 or less at step S 49, when the determination is affirmative determination, and stripped of object identification number at step S 50 (i.e., assumed to have been extinguished as an object), To return. At this time, the lock-on target vehicle will continue to lock-on / change /
It is processed by the release subroutine. Note that step S
When the negative determination is made in 49 , the process directly returns.

【0030】上記補間について、図10を参照してさら
に詳述すると、自車Mの進行路K上にロックオン対象車
Aが存在し且つ進行路K上以外にも物体(即ち、先行
車)B,C,Dが存在する場合において、例えば、先行
車B,C,Dのうちのいずれか(例えば、先行車B)の
検出データが消滅した場合には、当該先行車Bの検出デ
ータが、非ロックオン対象車用の補間カウンタが0以下
となるまで(本実施例の場合、4回のデータ検出の間)
補間される一方、ロックオン対象車Aの検出データが消
滅した場合には、当該ロックオン対象車Aの検出データ
が、ロックオン対象車用の補間カウンタが0以下となる
まで(本実施例の場合、20回のデータ検出の間)補間
される。従って、補間カウンタがデクリメントしている
間に、先行車Bあるいはロックオン対象車Aの検出デー
タが得られた場合には、継続して先行車Bあるいはロッ
クオン対象車Aについての制御処理が行えることとな
る。しかも、ロックオン対象車Aについては検出データ
の補間を長く行うようになっているため、自車Mにとっ
ての追従対象であるロックオン対象車Aについての追従
制御のつながりが悪くなるということはなくなるのであ
る。
The above-mentioned interpolation will be described in more detail with reference to FIG. 10. The lock-on target vehicle A exists on the traveling path K of the host vehicle M and an object (that is, a preceding vehicle) other than the traveling path K is present. In the case where B, C, and D are present, for example, when the detection data of one of the preceding vehicles B, C, and D (for example, the preceding vehicle B) disappears, the detection data of the preceding vehicle B is , Until the interpolation counter for the non-lock-on target vehicle becomes 0 or less (in the case of this embodiment, during four data detections)
On the other hand, when the detection data of the lock-on target vehicle A disappears while the interpolation is performed, the detection data of the lock-on target vehicle A becomes 0 or less until the interpolation counter for the lock-on target vehicle becomes 0 or less (in the present embodiment. In case of 20 data detections). Therefore, when the detection data of the preceding vehicle B or the lock-on target vehicle A is obtained while the interpolation counter is decrementing, the control process for the preceding vehicle B or the lock-on target vehicle A can be continuously performed. It will be. Moreover, since the detection data is interpolated for the lock-on target vehicle A for a long time, the connection of the follow-up control for the lock-on target vehicle A, which is the follow-up target for the own vehicle M, is not deteriorated. Of.

【0031】(補間物体の識別) 次に、補間物体の識別のサブルーチンを説明するが、そ
の際図11を参照して説明する。
(Identification of Interpolated Object) Next, a subroutine for identifying an interpolated object will be described, in which case it will be described with reference to FIG.

【0032】図8において、まずステップS51において
補間手段20による補間がロックオン対象車Aに対して
補間が実行されていることが確認されると、ステップS
52において当該ロックオン対象車Aの移動ベクトル量
(例えば、移動方向に関するベクトル量および移動量に
関するベクトル量=相対速度)が算出手段21により算
出される。ついで、ステップS53においてロックオン対
象車Aの補間エリア内に物体データXがあるか否かの判
定がなされ、肯定判定の場合には、ステップS54に進ん
で当該物体データXに関する移動ベクトル量(例えば、
移動方向に関するベクトル量および移動量に関するベク
トル量=相対速度)が算出手段21により算出され、そ
の後ステップS55において移動ベクトル量の比較がなさ
れ、両者の差が所定値以内に存在していると判定された
場合には、ステップS56に進んで当該物体データXをロ
ックオン対象車Aの実像とし、ロックオン対象車として
物体識別する。該物体識別は判定手段22により行われ
る。つまり、図11において符号Xで示す物体データと
ロックオン対象車Aとにおいては、移動ベクトル量に差
がない(換言すれば、同じ動きをしている)とされると
ころから、物体データXはロックオン対象車Aの実像と
されるのである。
In FIG. 8, first, in step S 51 , when it is confirmed that the interpolation by the interpolating means 20 is executed for the lock-on target vehicle A, step S 51
At 52 , the moving vector amount of the lock-on target vehicle A (for example, the vector amount regarding the moving direction and the vector amount regarding the moving amount = relative speed) is calculated by the calculating means 21. Then, it is determined whether there is an object data X made in the interpolation area of the lock-on target vehicle A in step S 53, in the case of affirmative determination, the motion vector amount relating to the object data X proceeds to step S 54 (For example,
The vector amount relating to the moving direction and the vector amount relating to the moving amount = relative speed) are calculated by the calculating means 21, and then the moving vector amounts are compared in step S 55 , and it is determined that the difference between them is within a predetermined value. If so, the process proceeds to step S 56 and the object data X is set as a real image of the lock-on target vehicle A, and the object is identified as the lock-on target vehicle. The object identification is performed by the determination means 22. That is, since there is no difference in the movement vector amount between the object data indicated by the symbol X in FIG. 11 and the lock-on target vehicle A (in other words, the same movement is made), the object data X is This is the real image of the lock-on target vehicle A.

【0033】一方、ステップS55において否定判定され
た場合には、物体データXとロックオン対象車Aとは別
物体であることを示しているので、ステップS57に進ん
で物体データXをロックオン対象車Aの実像とせず、こ
れまでの補間を継続し、その後リターンする。当該補間
の継続は、補間継続手段23により行われる。つまり、
図11において符号X′で示す物体データは、リフレク
タLの一つを示しているため、ロックオン対象車Aの実
像とはし得ないのである。
On the other hand, if a negative determination is made in step S 55 , it means that the object data X and the lock-on target vehicle A are different objects, so the flow proceeds to step S 57 to lock the object data X. The actual image of the ON target vehicle A is not set, and the interpolation so far is continued, and then the process returns. The interpolation is continued by the interpolation continuation unit 23. That is,
Since the object data indicated by the symbol X'in FIG. 11 indicates one of the reflectors L, it cannot be a real image of the lock-on target vehicle A.

【0034】ステップS56において物体データXをロッ
クオン対象車Aの実像とした場合、ロックオン対象車A
が出現したことになるので、ステップS58において補間
カウンタをクリアし、ステップS59において物体データ
Xに基づいて移動ベクトル量の算出を行い、その後リタ
ーンする。
When the object data X is the real image of the lock-on target vehicle A in step S 56 , the lock-on target vehicle A is
Has occurred, the interpolation counter is cleared in step S 58 , the movement vector amount is calculated based on the object data X in step S 59 , and then the process returns.

【0035】上記したように、本実施例においては、補
間中において物体データの検出があった場合に、当該物
体データがロックオン対象車の実像であるか否かを判定
し、該判定に基づいて補間を継続するか否かを決定する
ようにしているので、補間中における物体識別(特に、
ロックオン対象車の識別)が正確にできるのである。
As described above, in this embodiment, when the object data is detected during the interpolation, it is determined whether or not the object data is the real image of the lock-on target vehicle, and based on the determination. Since it is determined whether or not to continue the interpolation, the object identification during interpolation (in particular,
It is possible to accurately identify the lock-on target vehicle.

【0036】なお、本実施例の場合、判定手段22によ
る判定の基準となる移動ベクトル量として、移動方向に
関するベクトル量および移動量に関するベクトル量の両
方を用いているが、どちらか一方とすることもできる。
In the present embodiment, both the vector amount relating to the moving direction and the vector amount relating to the moving amount are used as the moving vector amount serving as the criterion for the determination by the determining means 22, but either one may be used. You can also

【0037】また、本実施例の場合、ロックオン対象車
の補間について説明したが、ロックオン対象車以外の物
体(例えば、他の先行車)における補間の場合にも本願
発明は適用可能である。
Further, in the case of the present embodiment, the interpolation of the lock-on target vehicle has been described, but the present invention is also applicable to the case of interpolation on an object other than the lock-on target vehicle (for example, another preceding vehicle). .

【0038】(ロックオンの継続・変更・解除) 次に、ロックオンの継続・変更・解除のサブルーチンを
説明するが、その際図12を参照しつつ説明する。
(Continuation / Change / Release of Lock-On) Next, a subroutine of continuation / change / cancellation of lock-on will be described with reference to FIG. 12 at that time.

【0039】図9において、まずステップS61において
ロックオン対象車Aおよび進行路Kの曲率半径Rを認識
した後、ステップS62において進行路K上にロックオン
対象車Aより近い先行車A′が存在するか否かを判定
し、該判定が肯定判定のときには、ステップS63におい
て先行車A′をロックオン対象車に変更する一方、該判
定が否定判定のときには、ステップS64においてロック
オン対象車Aに対するロックオンを継続する。この判定
は、コントロールユニット4におけるロックオン判定手
段18により行われる。
In FIG. 9, first, in step S 61 , the radius of curvature R of the lock-on target vehicle A and the traveling road K is recognized, and then in step S 62 , the preceding vehicle A ′ on the travel route K closer to the lock-on target vehicle A '. If the determination is affirmative, the preceding vehicle A ′ is changed to the lock-on target vehicle in step S 63 , while if the determination is negative, the lock-on is performed in step S 64 . The lock-on for the target vehicle A is continued. This determination is made by the lock-on determination means 18 in the control unit 4.

【0040】しかる後、前述した「存在物体の認定と補
間」のサブルーチンにおけるステップS51においてロッ
クオン対象車の物体識別番号が剥奪される場合があるの
で、ステップS65においてロックオン対象車に相当する
検出データが存在するか否かを判定し、該判定が肯定判
定のときには、ステップS66においてロックオン対象車
の物体識別番号に対してロックオン対象車用の補間カウ
ンタ値を与え、該判定が否定判定のときには、ステップ
67においてロックオン対象車の物体識別番号が存在す
るか否かを判定し、該判定が否定判定のときには、ステ
ップS68においてロックオン対象車がロストしたとす
る。上記処理は、コントロールユニット4における補間
手段20により行われる。
[0040] Thereafter, since there is a case where the lock-on target vehicle of object identification number is stripped in step S 51 in the subroutine of "certified interpolation presence object" described above, corresponds to the lock-on target vehicle in step S 65 It is determined whether or not there is detection data for the lock-on target vehicle. When the determination is affirmative, the interpolation counter value for the lock-on target vehicle is given to the object identification number of the lock-on target vehicle in step S 66 , and the determination there when negative determination determines whether the lock-on target vehicle in the object identification number exists in step S 67, the determination is at the negative determination, the lock-on target vehicle is lost in step S 68. The above processing is performed by the interpolation means 20 in the control unit 4.

【0041】ついで、ステップS69においてロックオン
対象車がロストしたか否かを判定し、該判定が否定判定
の(即ち、ロストしていない)ときには、ステップS61
に戻り、ロックオンを続行する一方、該判定が肯定判定
の(即ち、ロストしている)ときには、ステップS70
おいてロックオンを解除し、リターンする。なお、ロッ
クオン解除から次のロックオン対象車の登録がなされる
までの間は、追従制御手段19により自車速が所定車速
になるように制御される。
[0041] Then, the lock-on target vehicle is judged whether or not lost in step S 69, the determination is negative (i.e., not lost) Sometimes, the step S 61
Returning to, while continuing the lock-on, the determination is affirmative (i.e., lost) sometimes, release the lock-on in a step S 70, the process returns. During the period from the lock-on release to the registration of the next lock-on target vehicle, the follow-up control means 19 controls the own vehicle speed to be the predetermined vehicle speed.

【0042】なお、本願発明は、上記各実施例に限定さ
れるものではなく、その他種々の変形例を包含するもの
である。例えば、上記実施例では、レーザレーダ装置6
として、レーザレーダ波を水平方向に比較的広角度で走
査するスキャン式のものを用いているが、本願発明は、
このスキャン式レーザレーダ装置6に限らず、比較的狭
い角度の範囲内でのみ物体を検出するレーザレーダ装置
を用い、該レーザレーダ装置をアクチュエータで垂直軸
回りに回動させるように構成したものにも同様に適用す
ることができる。
The invention of the present application is not limited to the above-mentioned embodiments, but includes various modifications. For example, in the above embodiment, the laser radar device 6
As a scanning type of scanning laser radar waves at a relatively wide angle in the horizontal direction is used, the present invention is
Not only the scanning laser radar device 6 but also a laser radar device that detects an object only within a relatively narrow angle range, and the laser radar device is configured to rotate about a vertical axis by an actuator. Can be similarly applied.

【0043】また、上記実施例では、ロックオン判定手
段18によりロックオン対象車を判定するに当たり、自
車と先行車との車間距離および相対速度に基づいて判定
するようにしているが、車間距離と先行車の速度とに基
づいて判定するようにしてもよい。
In the above embodiment, when the lock-on judging means 18 judges the lock-on target vehicle, the judgment is made based on the inter-vehicle distance and the relative speed between the own vehicle and the preceding vehicle. Alternatively, the determination may be made based on the speed of the preceding vehicle.

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

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

【図2】本願発明の実施例にかかる自動車の走行制御装
置におけるコントロールユニットのブロック図である。
FIG. 2 is a block diagram of a control unit in the vehicle travel control device according to the embodiment of the present invention.

【図3】本願発明の実施例における自動車の走行制御装
置における追従走行時の制御のメインルーチンを示すフ
ローチャートである。
FIG. 3 is a flowchart showing a main routine of control during follow-up traveling in the vehicle traveling control device in the embodiment of the present invention.

【図4】本願発明の実施例における自動車の走行制御装
置における進行路の推定のサブルーチンを示すフローチ
ャートである。
FIG. 4 is a flowchart showing a subroutine for estimating a traveling path in the vehicle travel control device in the embodiment of the present invention.

【図5】本願発明の実施例にかかる自動車の走行制御装
置におけるロックオン対象車の登録のサブルーチンを示
すフローチャートである。
FIG. 5 is a flowchart showing a subroutine for registering a lock-on target vehicle in the vehicle travel control device according to the embodiment of the present invention.

【図6】本願発明の実施例にかかる自動車の走行制御装
置におけるロックオンの実行のサブルーチンを示すフロ
ーチャートである。
FIG. 6 is a flowchart showing a subroutine of lock-on execution in the vehicle travel control device according to the embodiment of the present invention.

【図7】本願発明の実施例にかかる自動車の走行制御装
置における存在物体の認定と補間のサブルーチンを示す
フローチャートである。
FIG. 7 is a flowchart showing a subroutine of recognizing an existing object and interpolating in a vehicle travel control device according to an embodiment of the present invention.

【図8】本願発明の実施例にかかる自動車の走行制御装
置における補間物体の識別のサブルーチンを示すフロー
チャートである。
FIG. 8 is a flowchart showing a subroutine for identifying an interpolated object in the vehicle travel control device according to the embodiment of the present invention.

【図9】本願発明の実施例にかかる自動車の走行制御装
置におけるロックオンの継続・変更・解除のサブルーチ
ンを示すフローチャートである。
FIG. 9 is a flowchart showing a subroutine of lock-on continuation / change / release in the vehicle travel control device according to the embodiment of the present invention.

【図10】本願発明の実施例にかかる自動車の走行制御
装置における補間を説明するための説明図である。
FIG. 10 is an explanatory diagram for explaining interpolation in the vehicle travel control device according to the embodiment of the present invention.

【図11】本願発明の実施例にかかる自動車の走行制御
装置における補間物体の識別の態様を示す説明図であ
る。
FIG. 11 is an explanatory diagram showing a mode of identifying an interpolated object in the vehicle travel control device according to the embodiment of the present invention.

【図12】本願発明の実施例にかかる自動車の走行制御
装置におけるロックオンの継続・変更・解除を説明する
ための説明図である。
FIG. 12 is an explanatory diagram for explaining continuation / change / cancellation of lock-on in the vehicle travel control device according to the embodiment of the present invention.

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

6は物体検出手段(レーザレーダ装置)、17は進行路
推定手段、18はロックオン判定手段、19は追従制御
手段、20は補間手段、21は算出手段、22は判定手
段、23は補間継続手段。
6 is an object detection means (laser radar device), 17 is a traveling path estimation means, 18 is a lock-on determination means, 19 is a follow-up control means, 20 is an interpolation means, 21 is a calculation means, 22 is a determination means, and 23 is interpolation continuation. means.

Claims (6)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 自車の前方に存在する物体の有無を検出
する物体検出手段と、自車の走行状態に基づいて自車前
方の進行路を推定する進行路推定手段と、前記物体検出
手段により検出された物体データが消滅した場合に所定
時間その物体データを補間する補間手段と、前記物体検
出手段により検出された物体データにおける移動ベクト
ル量を算出する算出手段と、前記補間手段による補間中
において補間物体の補間位置近傍に物体データが検出さ
れた際には当該物体と補間物体とにおける移動ベクトル
量を比較して同一物体か否かを判定する判定手段と、前
記物体検出手段により検出された物体が前記進行路上に
所定移動条件をもって存在するかを判断し、これを自車
の追従対象物体と判定するロックオン判定手段と、自車
と追従対象物体との距離および相対速度に基づいて自車
を追従対象物体に追従させるように自車の車速を制御す
る追従制御手段と、前記補間手段による補間が追従対象
物体に対して行われている場合であって前記判定手段に
より否定判定された場合にのみ前記補間物体に対する補
間を継続する補間継続手段とを備えていることを特徴と
する自動車の走行制御装置。
1. An object detecting means for detecting the presence / absence of an object existing in front of the own vehicle, a traveling road estimating means for estimating a traveling road in front of the own vehicle based on a traveling state of the own vehicle, and the object detecting means. When the object data detected by the object disappears, an interpolating means for interpolating the object data for a predetermined time, a calculating means for calculating a movement vector amount in the object data detected by the object detecting means, and an interpolation by the interpolating means. In the case where the object data is detected in the vicinity of the interpolation position of the interpolated object, the determination means for comparing the movement vector amounts of the object and the interpolated object to determine whether they are the same object ,
The object detected by the object detection means is on the traveling path.
It is judged whether the vehicle exists under a predetermined movement condition, and this
Lock-on determination means for determining the following target object of
Based on the distance and relative speed between the
Controls the vehicle speed of the vehicle so that the vehicle follows the target object.
Tracking control means and the interpolation by the interpolation means
If it is performed on the object,
Complementary to the interpolated object only when a negative determination is made.
A traveling control device for an automobile, comprising: an interpolation continuation means for continuing the interval .
【請求項2】 前記算出手段により算出される移動ベク
トル量は物体の移動方向に関するベクトル量とされてい
ることを特徴とする前記請求項記載の自動車の走行制
御装置。
2. A movement vector quantity calculated by said calculating means is an automobile cruise control system of claim 1, wherein that it is a vector amount on the movement direction of the object.
【請求項3】 前記算出手段により算出される移動ベク
トル量は物体の移動量に関するベクトル量とされている
ことを特徴とする前記請求項記載の自動車の走行制御
装置。
3. A movement vector quantity calculated by said calculating means is an automobile cruise control system of claim 1, wherein the there is a vector quantity related to the amount of movement of the object.
【請求項4】 前記進行路推定手段による自車の進行路
推定は、自車の舵角データおよび車速データに基づいて
なされることを特徴とする前記請求項記載の自動車の
走行制御装置。
4. A traveling path estimation of the vehicle by the traveling path estimating means, vehicle running control device of claim 1, characterized in that it is made on the basis of the steering angle data and the vehicle speed data of the vehicle.
【請求項5】 前記進行路推定手段による自車の進行路
推定は、自車のヨーレートデータおよび車速データに基
づいてなされることを特徴とする前記請求項記載の自
動車の走行制御装置。
5. A traveling path estimation of the vehicle by the traveling path estimating means, vehicle running control device of claim 1, characterized in that it is made on the basis of the yaw rate data and vehicle speed data of the vehicle.
【請求項6】 前記物体検出手段は、自車の前方に向け
てレーザレーダ波を発信し、前方物体からの反射波を検
出するレーザレーダ装置とされていることを特徴とする
前記請求項記載の自動車の走行制御装置。
Wherein said object detecting means, said claim, characterized in that originated the laser radar wave toward the front of the vehicle, there is a laser radar device for detecting a reflected wave from the forward object 1 The traveling control device for the automobile described.
JP02687795A 1995-02-15 1995-02-15 Car driving control device Expired - Fee Related JP3433553B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP02687795A JP3433553B2 (en) 1995-02-15 1995-02-15 Car driving control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP02687795A JP3433553B2 (en) 1995-02-15 1995-02-15 Car driving control device

Publications (2)

Publication Number Publication Date
JPH08216725A JPH08216725A (en) 1996-08-27
JP3433553B2 true JP3433553B2 (en) 2003-08-04

Family

ID=12205532

Family Applications (1)

Application Number Title Priority Date Filing Date
JP02687795A Expired - Fee Related JP3433553B2 (en) 1995-02-15 1995-02-15 Car driving control device

Country Status (1)

Country Link
JP (1) JP3433553B2 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5093020B2 (en) * 2008-09-18 2012-12-05 トヨタ自動車株式会社 Radar equipment
JP5471936B2 (en) * 2010-07-27 2014-04-16 トヨタ自動車株式会社 Other vehicle recognition system

Also Published As

Publication number Publication date
JPH08216725A (en) 1996-08-27

Similar Documents

Publication Publication Date Title
EP0657857B1 (en) Traveling control system for motor vehicle
EP2009464B1 (en) Object detection device
JP3658519B2 (en) Vehicle control system and vehicle control device
JP3891011B2 (en) Cruise control device, program
JP2002022832A (en) Method and apparatus for recognizing object, recording medium
US8165797B2 (en) Vehicular control object determination system and vehicular travel locus estimation system
JPH0776237A (en) Traveling controller for automobile
JP4442520B2 (en) Course estimation device for vehicle
EP1977947B1 (en) Vehicle travel control apparatus
JP5947279B2 (en) Course estimation device and program
JP4163695B2 (en) Leading vehicle recognition device
JP2002175599A (en) Lane position estimating device for precedent vehicle or target
JP3521292B2 (en) Car driving control device
JP3433553B2 (en) Car driving control device
JP3512063B2 (en) How to measure the relative speed of the preceding vehicle in the lateral direction
JP3582071B2 (en) Car driving control device
JP3937540B2 (en) Vehicle object recognition device
JPH08219799A (en) Traveling route estimating apparatus for vehicle
JP3475543B2 (en) Car driving control device
JPH11144198A (en) Object identifying device for vehicle
JP3575092B2 (en) Car driving control device
JP2002099904A (en) Vehicle travel section lane detector
JP4535585B2 (en) Perimeter monitoring device
JPH08216726A (en) Travel control device for automobile
JPH11118925A (en) Distance-between-vehicles alarm apparatus

Legal Events

Date Code Title Description
FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090530

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20090530

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20100530

Year of fee payment: 7

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

Free format text: PAYMENT UNTIL: 20110530

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20110530

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20120530

Year of fee payment: 9

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

Free format text: PAYMENT UNTIL: 20130530

Year of fee payment: 10

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

Free format text: PAYMENT UNTIL: 20140530

Year of fee payment: 11

LAPS Cancellation because of no payment of annual fees