Nothing Special   »   [go: up one dir, main page]

JPH1145398A - Self-lane object detection device and vehicle travel controller provided with the device - Google Patents

Self-lane object detection device and vehicle travel controller provided with the device

Info

Publication number
JPH1145398A
JPH1145398A JP9200655A JP20065597A JPH1145398A JP H1145398 A JPH1145398 A JP H1145398A JP 9200655 A JP9200655 A JP 9200655A JP 20065597 A JP20065597 A JP 20065597A JP H1145398 A JPH1145398 A JP H1145398A
Authority
JP
Japan
Prior art keywords
vehicle
lane
probability
self
distance
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
JP9200655A
Other languages
Japanese (ja)
Other versions
JP3516841B2 (en
Inventor
Hirochika Miyakoshi
博規 宮越
Nobuyuki Furui
信之 古居
Tsuneo Miyakoshi
恒雄 宮越
Yasuhiko Sato
泰彦 佐藤
Eiji Teramura
英司 寺村
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.)
Denso Corp
Toyota Motor Corp
Original Assignee
Denso Corp
Toyota Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Denso Corp, Toyota Motor Corp filed Critical Denso Corp
Priority to JP20065597A priority Critical patent/JP3516841B2/en
Publication of JPH1145398A publication Critical patent/JPH1145398A/en
Application granted granted Critical
Publication of JP3516841B2 publication Critical patent/JP3516841B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Controls For Constant Speed Travelling (AREA)
  • Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

PROBLEM TO BE SOLVED: To securely detect the preceding vehicle of a target by converting the position of a detection object into the position of a straight road and judging that the object whose probability of existence in a self-lane is not less than a prescribed value and whose distance with a self-vehicle is not more than the prescribed value exists in the self-lane. SOLUTION: A CPU in a laser radar groups data considered to be the same object from data on an obtained direction and the distance and extracts the objects 300, 400 and 500. It detects the positions (Xc and Z) on the objects 300 and 400 except for a static object 500. CPU receives estimated curve radius data from vehicle distance control ECU and converts it into the positions (Xs and Z) of the detection objects. Then, probability that the object exists in the self-lane is calculated from the position in the straight road. When the self-lane existence probability extracts the object of not less than the prescribed threshold and the extracted object is one, the object is judged to be the preceding vehicle. When plural extracted objects exist, the object having the shortest distance Z with the self-vehicle is judged to be the following preceding vehicle.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は自車線物体検出装置
及びこれを備えた車両走行制御装置、特にカーブ路にお
ける自車線物体の検出に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a vehicle lane object detection device and a vehicle travel control device provided with the same, and more particularly to the detection of a vehicle lane object on a curved road.

【0002】[0002]

【従来の技術】従来より、レーザレーダ等を用いて先行
車を検出する技術が知られている。例えば、特開平6−
150195号公報には、過去のターゲットと今回検出
のターゲットが同一であればターゲットの存在確率を増
大させて認識率を向上させる技術が開示されている。
2. Description of the Related Art Conventionally, there has been known a technique for detecting a preceding vehicle using a laser radar or the like. For example, Japanese Unexamined Patent Publication
Japanese Patent Application Publication No. 150195 discloses a technique for improving the recognition rate by increasing the presence probability of a target if the past target and the target detected this time are the same.

【0003】[0003]

【発明が解決しようとする課題】一方、検出したターゲ
ット(先行車)が自車線上に存在するかどうかを検出す
ることも極めて重要であり、特にカーブ路においてその
必要性は大きい。隣接車線に存在する車両を自車線上の
先行車と誤認識し、あるいはその逆に自車線上に存在す
る先行車をターゲットを認識しない場合が起こりやす
く、制御が不安定となるからである。
On the other hand, it is also very important to detect whether the detected target (preceding vehicle) exists on the own lane, and the necessity is particularly large on a curved road. This is because it is likely that a vehicle existing in an adjacent lane is erroneously recognized as a preceding vehicle on the own lane, or conversely, a target existing on a preceding lane on the own lane is not recognized, and control becomes unstable.

【0004】カーブ路において検出したターゲットが自
車線上に存在するか否かを判定するためには、例えばス
テアリングや自車速に基づいて走行しているカーブ半径
を算出し、このカーブ半径に基づいて判定することが考
えられるが、カーブ半径算出にも誤差が含まれているた
め、この誤差を考慮した処理が必要となる。
In order to determine whether or not a target detected on a curved road is present on the own lane, for example, the radius of a curve running based on the steering speed or the own vehicle speed is calculated, and based on this curve radius. Although it is conceivable to make a determination, an error is also included in the calculation of the curve radius, so a process that takes this error into consideration is necessary.

【0005】本発明は、上記従来技術の有する課題に鑑
みなされたものであり、その目的は、ターゲットとなる
先行車を確実に検出できる装置を提供するとともに、こ
れを用いて従来以上に確実な走行制御を実現することに
ある。
The present invention has been made in view of the above-mentioned problems of the prior art, and an object of the present invention is to provide an apparatus capable of reliably detecting a preceding vehicle as a target, and to provide a more reliable apparatus using the apparatus. The purpose is to realize travel control.

【0006】[0006]

【課題を解決するための手段】上記目的を達成するため
に、第1の発明は、自車線物体検出装置であって、レー
ダ装置で検出した自車周囲の物体から自車線に存在する
物体を検出する装置であって、検出した物体の位置を直
線路における位置に換算する換算手段と、換算された位
置に基づいて自車線に存在する確率を算出する確率算出
手段と、前記確率が所定値以上であり、かつ、自車との
距離が所定値以下の物体を自車線に存在する物体と判定
する判定手段とを有することを特徴とする。
To achieve the above object, a first aspect of the present invention is a self-lane object detecting device, which detects objects existing in the own lane from objects around the own vehicle detected by a radar device. An apparatus for detecting, a conversion means for converting the position of the detected object into a position on a straight road, a probability calculation means for calculating a probability of being in the own lane based on the converted position, and wherein the probability is a predetermined value. Determining means for determining an object whose distance to the own vehicle is equal to or less than a predetermined value as an object existing in the own lane.

【0007】また、第2の発明は、第1の発明におい
て、前記所定値は、カーブ半径に応じて設定されること
を特徴とする。
In a second aspect based on the first aspect, the predetermined value is set according to a curve radius.

【0008】また、第3の発明は、第1、第2の発明に
おいて、前記確率算出手段は、前記換算された位置に応
じて決定される今回の確率と、前回得られた確率との重
み付け平均により自車線存在確率を算出し、かつ、検出
した物体の距離に応じて前記重み付け平均の重みを変化
させることを特徴とする。
In a third aspect based on the first and second aspects, the probability calculating means weights a current probability determined according to the converted position and a previously obtained probability. The present invention is characterized in that the own lane existence probability is calculated by the average, and the weight of the weighted average is changed according to the distance of the detected object.

【0009】また、第4の発明は、車両走行制御装置で
あって、第1〜第3の発明に係る自車線物体検出装置を
備え、検出した自車線物体との間隔を所定値に維持すべ
く自車速を制御する制御手段を備えたことを特徴とす
る。
According to a fourth aspect of the present invention, there is provided a vehicle traveling control device including the own lane object detecting device according to the first to third aspects of the present invention, wherein the distance between the detected own lane object and the detected own lane object is maintained at a predetermined value. In order to control the vehicle speed, control means is provided.

【0010】[0010]

【発明の実施の形態】以下、図面に基づき本発明の実施
形態について説明する。なお、以下の説明において、
「クルーズコントロール」あるいは「クルーズ機能」と
は、先行車が存在する場合にはその先行車との間隔を目
標間隔に維持しつつ追従走行し、先行車が存在しない場
合にはドライバにより設定された車速で定速走行するこ
とを意味する。
Embodiments of the present invention will be described below with reference to the drawings. In the following description,
"Cruise control" or "cruise function" means that if there is a preceding vehicle, the vehicle follows the vehicle while keeping the distance to the preceding vehicle at the target distance, and if there is no preceding vehicle, it is set by the driver This means running at a constant speed at the vehicle speed.

【0011】図1には、本実施形態の全体構成ブロック
図が示されている。車両の前部バンパーにスキャン型レ
ーザレーダ10が設けられており、レーザビームを前方
に送出してその反射光から前方物体までの距離や方向、
相対速度を検出する。スキャン型レーザレーダ10には
車間制御ECU(電子制御装置)12が接続されてお
り、レーザレーダ10からのデータに基づいて追従すべ
き車両を決定し、追従車との間隔が目標間隔となるよう
に加速度(あるいは減速度)を決定する。車間制御EC
U12にはエンジンECU14が接続されており、車間
制御ECU12からのデータに基づいてクルーズコント
ロール機能を実現する。具体的には、このエンジンEC
U14には電子スロットルアクチュエータ24及びEC
T(電子制御トランスミッション)ソレノイド26が接
続されており、車間制御ECU12から供給された目標
加速度に応じて電子スロットルアクチュエータを駆動
し、あるいは車間制御ECU12から供給されたシフト
ダウン要求(減速要求)に応じてシフトを低速側に変化
させてエンジンブレーキを生じさせる。
FIG. 1 is a block diagram showing the overall configuration of the present embodiment. A scanning type laser radar 10 is provided on a front bumper of the vehicle, and sends a laser beam forward, and a distance and a direction from a reflected light to an object ahead,
Detect relative speed. An inter-vehicle control ECU (electronic control unit) 12 is connected to the scan type laser radar 10 to determine a vehicle to follow based on data from the laser radar 10 so that an interval with the following vehicle becomes a target interval. The acceleration (or deceleration) is determined. Vehicle control EC
An engine ECU 14 is connected to U12, and implements a cruise control function based on data from the headway control ECU12. Specifically, this engine EC
U14 has an electronic throttle actuator 24 and EC
A T (electronic control transmission) solenoid 26 is connected to drive an electronic throttle actuator in accordance with a target acceleration supplied from the headway control ECU 12 or in response to a downshift request (deceleration request) supplied from the headway control ECU 12. The shift is changed to a low speed side to cause engine braking.

【0012】また、エンジンECU14にはECTモー
ドスイッチ16、クルーズコントロールスイッチ18、
ストップランプスイッチ20、車速センサ22が接続さ
れている。クルーズコントロールスイッチ18は、エン
ジンECU14のクルーズ機能のON/OFF、車速の
設定、加速、減速及び制御のキャンセルの各操作を行う
ためのものであり、その詳細については後述する。EC
Tモードスイッチ16は、ドライバがECTのモード
(例えばパワーモードやスノーモード等)を設定するた
めのスイッチであり、ドライバがスノーモード(セカン
ドギアでの発進を可能とするモード)に設定した場合に
は、エンジンECU14はクルーズ機能をキャンセルす
る。これは、雪道や凍結路など滑りやすい路面でクルー
ズ制御を行わないようにするためであり、クルーズ機能
のキャンセルには動作中のクルーズ機能のキャンセルの
他、クルーズコントロールスイッチ18によるクルーズ
機能ON操作時であってもクルーズ機能への遷移を禁止
することも含まれる。なお、ドライバがECTモードス
イッチ16を操作するのではなく、エンジンECU14
の内部で車輪速やGセンサからの出力に基づいて車輪が
滑っていることを検出し、低摩擦路(低μ路)と判定し
てエンジン及びトランスミッションを自動的にECTの
スノーモードと同様の制御にする場合にも、該判定と同
時にクルーズ機能をキャンセルすることが望ましい。ス
トップランプスイッチ20はドライバによるブレーキ操
作を検出するためのものであり、ドライバがブレーキ操
作を行った場合にはエンジンECU14はクルーズ機能
をキャンセルする。
The engine ECU 14 has an ECT mode switch 16, a cruise control switch 18,
A stop lamp switch 20 and a vehicle speed sensor 22 are connected. The cruise control switch 18 is for performing each operation of ON / OFF of the cruise function of the engine ECU 14, setting of the vehicle speed, acceleration, deceleration, and control cancellation, and details thereof will be described later. EC
The T mode switch 16 is a switch for the driver to set an ECT mode (for example, a power mode or a snow mode). When the driver sets the ECT mode to a snow mode (a mode in which the vehicle can start in a second gear). Means that the engine ECU 14 cancels the cruise function. This is to prevent the cruise control from being performed on slippery roads such as snowy roads and icy roads. The cruise function can be canceled by canceling the cruise function in operation or by turning on the cruise function using the cruise control switch 18. This includes prohibiting the transition to the cruise function even at times. Note that the driver does not operate the ECT mode switch 16 but the engine ECU 14
It detects that the wheel is slipping based on the wheel speed and the output from the G sensor inside, determines that the road is a low friction road (low μ road), and automatically sets the engine and transmission to the same as the ECT snow mode. Also in the case of control, it is desirable to cancel the cruise function simultaneously with the determination. The stop lamp switch 20 is for detecting the brake operation by the driver, and when the driver performs the brake operation, the engine ECU 14 cancels the cruise function.

【0013】また、エンジンECU14にはVSC(車
両姿勢安定制御)−ECU28が接続されており、VS
C−ECU28にはステアリングセンサ30及び警報ブ
ザー32が接続されている。VSC−ECU28は、ス
テアリングセンサ30からの検出に基づいて車両がオー
バステアまたはアンダーステアになったことを検知する
と、エンジンの出力を下げるとともに前輪または後輪に
制動力を与えて車両の旋回運動の安定性を確保するもの
であり、このシステムが作動する際に警報ブザー32を
駆動させてドライバに注意を促すが、クルーズ機能中に
おいて追従先行車との車間距離が近づきすぎた場合、エ
ンジンECU14はVSC−ECU28を介して警報ブ
ザー32を駆動してドライバに注意を促す(例えば、
「ピピピッ」という警報音を出す等)。すなわち、警報
ブザー32はVSC作動警報とクルーズ機能時の車間警
報の両機能を兼用している。なお、ステアリングセンサ
30で検出した操舵角はVSCに利用される他、エンジ
ンECU14に供給され、特にカーブ路におけるクルー
ズ機能に用いられる。 また、エンジンECU14には
ボデー多重通信系34を介して種々の装置が接続されて
おり、具体的にはテールランプスイッチ36、ワイパー
スイッチ38、メータ40が接続されている。テールラ
ンプスイッチ36はテールランプの点灯、すなわち夜間
走行を検知するためのもので、このテールランプスイッ
チがON状態となっている場合に、エンジンECU14
は目標車間距離を日中よりも長く設定する。具体的な設
定方法については後述する。また、ワイパースイッチ3
8はワイパーの作動状態、つまり雨天走行を検知するた
めであり、このワイパースイッチ38がON状態となっ
ている場合には、エンジンECU14はクルーズ機能を
キャンセルする。メータ・ディスプレイ40は本実施形
態の特徴の一つであり、通常の速度やエンジン回転数の
他、クルーズ機能特有の情報を表示する。クルーズ機能
特有の情報には、先行車検知、車間距離を表現する車間
時間、設定車速、クルーズ機能の状態、フェールモード
等が含まれる。車間時間とは、車間距離を時間で表現し
た物理量で、車間時間=車間距離/車速の関係がある。
従って、追従制御の目標である目標車間距離に1:1で
対応する目標車間時間があり、本実施形態ではこの目標
車間時間をドライバが適宜調整できるように車間時間切
替スイッチ44が設けられている。車間時間切替スイッ
チ44はメータ・デイスプレイ40に接続され、ドライ
バが設定した車間時間がそのままディスプレイ上に表示
されるとともに、ボデー多重通信系34を介してエンジ
ンECU14に供給され、クルーズコントロールに用い
られる。ドライバが設定できる車間時間としては、以下
のように長、中、短の3段階が用意される。
A VSC (vehicle attitude stabilization control) -ECU 28 is connected to the engine ECU 14.
A steering sensor 30 and a warning buzzer 32 are connected to the C-ECU 28. When the VSC-ECU 28 detects that the vehicle has over-steered or under-steered based on the detection from the steering sensor 30, the VSC-ECU 28 lowers the output of the engine and applies a braking force to the front wheels or the rear wheels to stabilize the turning motion of the vehicle. When the system operates, the warning buzzer 32 is driven to alert the driver. However, if the inter-vehicle distance with the following vehicle is too close during the cruise function, the engine ECU 14 sets the VSC-. The alarm buzzer 32 is driven via the ECU 28 to call the driver's attention (for example,
(E.g., an audible alarm sounds). That is, the alarm buzzer 32 has both functions of the VSC operation alarm and the inter-vehicle alarm during the cruise function. The steering angle detected by the steering sensor 30 is used for the VSC and is also supplied to the engine ECU 14 to be used particularly for a cruise function on a curved road. Various devices are connected to the engine ECU 14 via a body multiplex communication system 34. Specifically, a tail lamp switch 36, a wiper switch 38, and a meter 40 are connected. The tail lamp switch 36 is for detecting the lighting of the tail lamp, that is, night running, and when the tail lamp switch is in the ON state, the engine ECU 14
Sets the target inter-vehicle distance longer than during the day. A specific setting method will be described later. Wiper switch 3
Numeral 8 is for detecting the operating state of the wiper, that is, running in rainy weather. When the wiper switch 38 is ON, the engine ECU 14 cancels the cruise function. The meter display 40 is one of the features of the present embodiment, and displays information specific to the cruise function in addition to the normal speed and the engine speed. The information specific to the cruise function includes detection of a preceding vehicle, an inter-vehicle time representing an inter-vehicle distance, a set vehicle speed, a state of the cruise function, a fail mode, and the like. The inter-vehicle time is a physical quantity expressing the inter-vehicle distance by time, and has a relation of inter-vehicle time = inter-vehicle distance / vehicle speed.
Therefore, there is a target inter-vehicle time corresponding to the target inter-vehicle distance that is the target of the follow-up control at a ratio of 1: 1. In this embodiment, the inter-vehicle time switch 44 is provided so that the driver can appropriately adjust the target inter-vehicle time. . The inter-vehicle time switch 44 is connected to the meter display 40, and the inter-vehicle time set by the driver is displayed on the display as it is, and is supplied to the engine ECU 14 via the body multiplex communication system 34 and used for cruise control. As the inter-vehicle time that can be set by the driver, three stages of long, medium and short are prepared as follows.

【0014】 長:2.4(sec) 中:2.0(sec) 短:1.8(sec) 車両が時速80km/hで走行している場合、それぞれ
の車間時間を距離で表すと、長は約55m、中は約45
m、短は約40mとなる。これらの車間時間はメータ・
ディスプレイ40上に表示され、現在どの車間時間が設
定されているかが一目で分かるようになっている。な
お、上記ではテールランプスイッチ36がON状態の時
は車間距離を日中より長く設定するとしたが、具体的に
はこの車間時間を長く設定しており、α1、α2、α3を
定数として日中では長で2.4(sec)のところを
2.4+α1(sec)に変化させ、中で2.0(se
c)のところを2.0+α2(sec)に変化させ、短
で1.8(sec)のところを1.8+α3(sec)
に変化させる。車間時間の設定の長、中、短に応じてα
1>α2>α3となるように上記各定数を変化させるのが
好適である。また、これらのα1、α2、α3は予めドラ
イバに選択できるようにしてもよい。
Long: 2.4 (sec) Medium: 2.0 (sec) Short: 1.8 (sec) When the vehicle is traveling at a speed of 80 km / h, the time between vehicles can be represented by a distance. Length is about 55m, inside is about 45
m and short are about 40 m. These inter-vehicle times are
It is displayed on the display 40 so that it is possible to see at a glance which inter-vehicle time is currently set. In the above description, when the tail lamp switch 36 is in the ON state, the inter-vehicle distance is set to be longer than during the day. Change the length of 2.4 (sec) to 2.4 + α1 (sec), and change it to 2.0 (sec)
c) is changed to 2.0 + α2 (sec), and 1.8 (α) is changed to 1.8 + α3 (sec) in a short time of 1.8 (sec).
To change. Α according to the long, middle, short
It is preferable to change the above constants so that 1>α2> α3. Further, these α1, α2, and α3 may be selected in advance by the driver.

【0015】図2には、レーザレーダ10の構成が示さ
れている。CPU10aからの指令に基づいて発光回路
10bがレーザダイオードLD10cをパルス駆動す
る。レーザダイオードLD10cからのパルスレーザ光
はレンズ10dで整形され、ミラー10eで反射されて
ポリゴンミラーfに入射する。ポリゴンミラーは6面を
有して回転軸の周りに回転しており、このポリゴンミラ
ー10fの回転により水平面内で(進行方向に対して左
右方向に)パルスレーザ光をスキャンする。また、ポリ
ゴンミラー10fの各面は順次異なる傾斜角度を有して
おり、パルスレーザ光の入射面が変化する毎に進行方向
に対して上下方向にパルスレーザ光をスキャンする。
FIG. 2 shows the configuration of the laser radar 10. The light emitting circuit 10b pulse-drives the laser diode LD10c based on a command from the CPU 10a. The pulse laser light from the laser diode LD10c is shaped by the lens 10d, reflected by the mirror 10e, and enters the polygon mirror f. The polygon mirror has six surfaces and rotates around a rotation axis. The rotation of the polygon mirror 10f scans a pulse laser beam in a horizontal plane (in the horizontal direction with respect to the traveling direction). Further, each surface of the polygon mirror 10f has a different inclination angle sequentially, and scans the pulse laser light in the vertical direction with respect to the traveling direction each time the incident surface of the pulse laser light changes.

【0016】一方、先行車が存在する場合には、先行車
で反射したパルスレーザ光が受光レンズ10gを介して
フォトダイオード10hに入射し、電気信号に変換され
て受光回路10iに供給される。そして、受光パルス信
号はさらに時間計測IC10jに供給されてパルスレー
ザ光が送出されてから先行車で反射されて受光されるま
での時間が計測され、CPU10aに供給されて先行車
までの距離が検出されるとともにその時間変化としての
相対速度が検出される。検出された車間距離及び相対速
度はCPU10kに供給され、CPU10kはこれらの
検出データを車間制御ECU12に供給する。
On the other hand, when there is a preceding vehicle, the pulse laser beam reflected by the preceding vehicle enters the photodiode 10h via the light receiving lens 10g, is converted into an electric signal, and is supplied to the light receiving circuit 10i. The received light pulse signal is further supplied to a time measurement IC 10j, and the time from when the pulse laser light is transmitted to the time when it is reflected and received by the preceding vehicle is measured, and supplied to the CPU 10a to detect the distance to the preceding vehicle. And a relative speed as a time change is detected. The detected inter-vehicle distance and relative speed are supplied to the CPU 10k, and the CPU 10k supplies these detection data to the inter-vehicle control ECU 12.

【0017】図3には、レーザレーダ10のスキャン範
囲100が模式的に示されている。ポリゴンミラー10
fの6個の反射面内の一つの反射面内で反射することに
より、パルスレーザ光はある水平面内で進行方向に対し
て左右方向にスキャンする。また、ポリゴンミラー10
fの他の反射面で反射することにより、異なる水平面内
で左右方向にスキャンする。垂直方向のパルスレーザ光
はポリゴンミラーの反射面のそれぞれに対応して合計6
本であり、左右方向は一つの反射面内の回転角に対応し
て合計105本である。レーザ光の到達範囲は晴天時で
約100mであり、従って100m以内に先行車が存在
する場合には先行車有りとなり、100m以遠に存在す
る場合には先行車無しとなる。
FIG. 3 schematically shows a scan range 100 of the laser radar 10. Polygon mirror 10
The pulsed laser light scans in a horizontal plane in a horizontal direction with respect to the traveling direction by being reflected on one of the six reflecting surfaces f. Also, the polygon mirror 10
By scanning off the other reflecting surface of f, scanning is performed in the horizontal direction in a different horizontal plane. The pulsed laser light in the vertical direction has a total of 6 corresponding to each of the reflection surfaces of the polygon mirror.
There are a total of 105 books in the left-right direction corresponding to the rotation angle in one reflection surface. The reach of the laser beam is about 100 m in fine weather. Therefore, if there is a preceding vehicle within 100 m, there is a preceding vehicle, and if it is more than 100 m, there is no preceding vehicle.

【0018】図4には、車室内のステアリングホイール
50近傍の配置図である。ステアリング軸の向かって右
側にはレバー状のクルーズコントロールスイッチ18が
設けられており、ステアリングホイール50には車間時
間切替スイッチ44が設けられている。上述したよう
に、クルーズコントロールスイッチ18はクルーズ機能
のON/OFFや定速走行時(先行車不存在時)におけ
る車速や追従走行時の上限車速を設定する機能、アクセ
ルペダルによることなく加減速を行う機能、制御非動作
状態から動作状態に復帰させるリジューム機能等を有
し、車間時間切替スイッチは追従走行時の目標車間時間
を切り替える(本実施形態では長、中、短の3段階)機
能を有する。
FIG. 4 is a layout diagram of the vicinity of the steering wheel 50 in the vehicle interior. A lever-shaped cruise control switch 18 is provided on the right side of the steering shaft, and an inter-vehicle time switch 44 is provided on the steering wheel 50. As described above, the cruise control switch 18 has a function to set ON / OFF of the cruise function, a vehicle speed at the time of constant speed running (when no preceding vehicle is present) and an upper limit vehicle speed at the time of following running, and acceleration / deceleration without using the accelerator pedal. It has a function to perform, a resume function to return from the control non-operation state to the operation state, and the like. The inter-vehicle time changeover switch switches a target inter-vehicle time during follow-up traveling (in this embodiment, three stages of long, medium, and short) Have.

【0019】図5には、クルーズコントロールスイッチ
18の拡大図が示されている。クルーズコントロールス
イッチ18はレバー状をなして上下方向に操作可能であ
り、側部には押し込み操作(図中矢印a方向)可能なメ
インスイッチ18aが設けられている。このメインスイ
ッチ18aを押し込むことにより、エンジンECU14
のクルーズ電源がONする。電源ON状態は、クルーズ
機能の待機状態であり、設定車速や車間時間が設定され
た後にドライバがクルーズ機能をセットすることにより
実際のクルーズ機能に移行する。クルーズ機能のセット
(SET)は、クルーズコントロールスイッチ18を下
げることにより実行される。なお、上述したように、メ
インスイッチ18aを押し込んでも、ECTのスノーモ
ード時やワイパー動作時にはクルーズ電源はONされず
OFFのままである。また、一旦設定した車速を増大さ
せたい場合には、クルーズコントロールスイッチを上げ
続け、設定車速を減少させたい場合には、クルーズコン
トロールスイッチを下げ続けるることによりエンジンE
CU14にこれらのデータが供給される。また、制御動
作中、すなわちクルーズ作動中にドライバがブレーキペ
ダル操作を行うと制御非動作状態(クルーズ機能のキャ
ンセル)となるが、この状態でクルーズコントロールス
イッチ18を上げる操作を行うことにより、もとの制御
状態に復帰する(リジューム機能)。
FIG. 5 is an enlarged view of the cruise control switch 18. The cruise control switch 18 is in the form of a lever and can be operated up and down. A main switch 18a which can be pushed (in the direction of arrow a in the figure) is provided on the side. By depressing the main switch 18a, the engine ECU 14
Cruise power is turned on. The power ON state is a standby state of the cruise function, and the driver shifts to the actual cruise function when the driver sets the cruise function after the set vehicle speed and the inter-vehicle time are set. The setting of the cruise function (SET) is executed by lowering the cruise control switch 18. As described above, even when the main switch 18a is pressed, the cruise power is not turned on but remains off during the ECT snow mode or the wiper operation. Further, when it is desired to increase the set vehicle speed, the cruise control switch is kept up, and when it is desired to decrease the set vehicle speed, the cruise control switch is kept down.
These data are supplied to the CU 14. When the driver performs the brake pedal operation during the control operation, that is, during the cruise operation, the control is not operated (the cruise function is cancelled). (Resume function).

【0020】図6には、車間時間切替スイッチ44の拡
大図が示されている。車間時間切替スイッチ44は3つ
のスイッチから構成され、車間時間を3段階に切り替え
るモード(MODE)スイッチ44a、ディスプレイ4
0を切り替える機能(FUNCTION)スイッチ44
b及びリセット(RESET)スイッチである。車間時
間は、エンジンONの初期状態では常に長にセットされ
ており、モードスイッチ44aを操作することにより長
から中、さらに短に切り替わる。短になってさらに操作
すると、車間時間は再び長に戻る。エンジンONの初期
状態で車間時間を一律に長に初期化するのは、追従走行
に移行した場合の安全性を確実に確保するためである。
機能スイッチ44bは、ディスプレイ40のクルーズ状
態表示と他の表示(例えば警報表示)を切り替えるため
のものであり、クルーズコントロール時にはエンジンE
CU14がその制御状態(先行車の有無や設定車速)を
表示するが、ドライバがこのスイッチ44bを操作する
と、警告表示画面やドライブモニタ画面に変化する。但
し、例えば警告表示画面を表示中に、クルーズ状態に何
からの変化(例えば先行車検出の有無や設定車速の変
化)が生じた場合には、ディスプレイ表示を警告画面か
らクルーズ状態画面に自動的に切り替える。
FIG. 6 is an enlarged view of the inter-vehicle time changeover switch 44. The inter-vehicle time switch 44 is composed of three switches, a mode (MODE) switch 44a for switching the inter-vehicle time in three stages, and a display 4
Function switch 44 for switching 0 (FUNCTION)
b and a reset switch. The inter-vehicle time is always set to be long in the initial state of the engine ON, and is switched from long to middle and further short by operating the mode switch 44a. When the vehicle becomes shorter and further operations are performed, the inter-vehicle time returns to a longer time. The reason why the inter-vehicle time is uniformly initialized in the initial state when the engine is ON is to ensure safety when the vehicle shifts to the following running.
The function switch 44b is for switching between a cruise state display and other displays (for example, an alarm display) on the display 40, and the engine E is turned on during cruise control.
The CU 14 displays the control state (presence / absence of a preceding vehicle and a set vehicle speed). When the driver operates the switch 44b, the display changes to a warning display screen or a drive monitor screen. However, if any change occurs in the cruise state (for example, whether the preceding vehicle is detected or the set vehicle speed changes) while the warning display screen is displayed, the display is automatically switched from the warning screen to the cruise state screen. Switch to

【0021】図7には、メータ・ディスプレイ40の表
示例が示されている。中央左側に速度、中央右側にエン
ジン回転数が表示され、下部にクルーズ状態画面41が
表示される。この画面41は例えば液晶で構成すること
ができる。クルーズ状態画面41の左側には警報ランプ
42が設けられ、さらに右側にクルーズ電源ランプ43
が設けられる。クルーズ状態画面41には、検出した先
行車、目標車間時間、自車、及び設定車速が表示され
る。ドライバが車間時間切替スイッチ44の機能スイッ
チ44bを操作すると、この画面が他の画面(警告画面
やドライブモニタ画面)に切り替わることは上述した通
りである。なお、テールランプ点灯時には車間時間を増
大するように調整するため、テールランプ点灯時にはこ
の画面41も日中とは異なる画面色とし、車間時間が増
大調整されている旨をドライバに報知することも好適で
ある。また、先行車追従中に先行車に異常接近した場合
には、VSCの警報ブザー32を用いてドライバに警報
を与えるが、この際、エンジンECU4は明暗の反転を
繰り返すように画面41の表示を制御して視覚的にドラ
イバに警報を与えることも好適である。
FIG. 7 shows a display example of the meter display 40. The speed is displayed on the center left side, the engine speed is displayed on the center right side, and the cruise state screen 41 is displayed on the lower part. This screen 41 can be composed of, for example, liquid crystal. An alarm lamp 42 is provided on the left side of the cruise status screen 41, and a cruise power lamp 43 is further provided on the right side.
Is provided. On the cruise state screen 41, the detected preceding vehicle, target inter-vehicle time, own vehicle, and set vehicle speed are displayed. As described above, when the driver operates the function switch 44b of the inter-vehicle time changeover switch 44, this screen is switched to another screen (warning screen or drive monitor screen). In addition, in order to adjust so that the inter-vehicle time is increased when the tail lamp is lit, it is also preferable that when the tail lamp is lit, the screen 41 has a screen color different from the daytime to notify the driver that the inter-vehicle time is adjusted to be increased. is there. If the vehicle approaches the preceding vehicle abnormally while following the preceding vehicle, a warning is given to the driver using the warning buzzer 32 of the VSC. At this time, the engine ECU 4 displays the screen 41 so as to repeat the inversion of light and dark. It is also preferred to control and visually alert the driver.

【0022】警報ランプ42はクルーズ機能に異常が生
じた場合に点灯するもので、エンジンECU14はこの
場合クルーズ機能をキャンセルするとともに、その異常
内容を画面41に表示する。もちろん、警報ブザー32
を用いて警告音でドライバに報知することもできる。警
告音としては、先行車追従時の警告音「ピピピッ」と区
別すべく、例えば「ポーン」等が考えられる。
The alarm lamp 42 is lit when an abnormality occurs in the cruise function. In this case, the engine ECU 14 cancels the cruise function and displays the details of the abnormality on the screen 41. Of course, the alarm buzzer 32
A warning sound can be used to notify the driver. As the warning sound, for example, a "pawn" or the like can be considered to distinguish it from the warning sound "pipipipi" at the time of following the preceding vehicle.

【0023】本実施形態の構成は以上のようであり、以
下その動作についてより詳細に説明する。
The configuration of this embodiment is as described above, and the operation will be described in more detail below.

【0024】図8には、車間制御ECU12及びエンジ
ンECU14が実行するクルーズコントロールの処理フ
ローチャートが示されている。ドライバがクルーズコン
トロールスイッチ18を用いてクルーズ機能をセットす
ると(メインスイッチをONにし、スイッチ18を下げ
てセット)、エンジンECU14はクルーズ機能がキャ
ンセルされたか否かを判定する(S101)。キャンセ
ルされていない場合には、次に車間制御ECU12が先
行車が検出されたか否かを判定し、先行車有りの場合に
は車間制御ECU12及びエンジンECU14が後述す
る車間クルーズ制御を実行する(S103)。また、先
行車がない場合には、エンジンECU14は現在の車速
Vnと設定車速Vmを大小比較し(S104)、Vn<
Vmであれば設定車速にすべく加速制御を行い(S10
5)、現在の車速Vnがほぼ設定車速Vmに等しけれ
ば、現在の車速を維持する定速クルーズ制御を実行する
(S106)。雨天時でワイパーが作動した場合やEC
Tのスノーモードに移行した場合、ドライバがクルーズ
コントロールスイッチ18を操作してキャンセルした場
合、ドライバがブレーキを操作した場合、車速が所定値
(例えば40km/h)以下となった場合、クルーズ機
能に異常が生じた場合等にはS101でYESと判定さ
れ、エンジンECU14はクルーズ機能をキャンセルす
る(S107)。
FIG. 8 is a flowchart showing the cruise control process executed by the following control ECU 12 and the engine ECU 14. When the driver sets the cruise function using the cruise control switch 18 (turns the main switch ON and sets the switch 18 down), the engine ECU 14 determines whether or not the cruise function has been canceled (S101). If the vehicle has not been cancelled, the following control ECU 12 determines whether or not a preceding vehicle has been detected, and if there is a preceding vehicle, the following control ECU 12 and the engine ECU 14 execute the following cruise control (S103). ). If there is no preceding vehicle, the engine ECU 14 compares the current vehicle speed Vn with the set vehicle speed Vm (S104) and determines that Vn <
If it is Vm, acceleration control is performed to set the vehicle speed (S10
5) If the current vehicle speed Vn is substantially equal to the set vehicle speed Vm, a constant speed cruise control for maintaining the current vehicle speed is executed (S106). If the wiper is activated in rainy weather or EC
When shifting to the snow mode of T, when the driver operates the cruise control switch 18 to cancel, when the driver operates the brake, when the vehicle speed falls below a predetermined value (for example, 40 km / h), the cruise function is activated. If an abnormality occurs, for example, YES is determined in S101, and the engine ECU 14 cancels the cruise function (S107).

【0025】図9には、S103で実行される車間クル
ーズの詳細フローチャートが示されている。まず、レー
ザレーダ10が先行車との車間距離及び相対速度を検出
し(S201)、車間制御ECU12が目標車間時間と
現在の車間時間との車間偏差を算出する(S202)。
そして、この車間偏差をゼロにするために必要な制御加
速度(目標加速度)を算出し(S203)、エンジンE
CU14に供給する。エンジンECU14は、この制御
加速度を得るために電子スロットルアクチュエータ24
を駆動してエンジン出力を制御する(S204)。な
お、算出された制御加速度が負の大きな値、すなわち大
きな減速側の場合には、車間制御ECUから供給される
シフトダウン要求を受けて、エンジンECU14はオー
バドライブをカットしてシフトダウンし、エンジンブレ
ーキで減速する。
FIG. 9 shows a detailed flowchart of the inter-vehicle cruise executed in S103. First, the laser radar 10 detects the inter-vehicle distance and the relative speed with the preceding vehicle (S201), and the inter-vehicle control ECU 12 calculates the inter-vehicle deviation between the target inter-vehicle time and the current inter-vehicle time (S202).
Then, the control acceleration (target acceleration) required to reduce the inter-vehicle deviation to zero is calculated (S203), and the engine E
Supply to CU14. The engine ECU 14 controls the electronic throttle actuator 24 to obtain this control acceleration.
Is driven to control the engine output (S204). If the calculated control acceleration is a large negative value, that is, a large deceleration side, the engine ECU 14 cuts off the overdrive and shifts down by receiving the downshift request supplied from the headway control ECU. Decelerate with the brakes.

【0026】図10には、以上の処理内容が模式的に示
されている。(A)は先行車が存在しない場合(100
m以遠に存在する場合を含む)であり、この場合にはド
ライバが設定した車速で定速走行する(図8のS106
における定速クルーズ)。(B)は定速走行中に設定車
速より遅い先行車が検出された場合であり、先行車に異
常接近しないように減速制御する(図8のS103にお
ける車間クルーズ)。(C)は先行車に追従する場合で
あり、設定車速を上限として先行車との車間時間が目標
車間時間となるように加減速制御する(図8のS103
における車間クルーズ)。(D)は先行車がインターチ
ェンジやサービスエリアなどに進入して存在しなくなっ
た場合であり、この場合には設定車速まで徐々に加速す
る(図8のS106における定速クルーズ)。なお、先
行車が存在しなくなった場合に設定車速まで徐々に加速
するのは、自車がインターチェンジやサービスエリアに
進入したために先行車が存在しなくなった場合に、設定
車速まで急加速するのは望ましくないことを考慮したも
のである。
FIG. 10 schematically shows the above processing contents. (A) shows a case where there is no preceding vehicle (100
m, and the vehicle runs at a constant speed at the vehicle speed set by the driver (S106 in FIG. 8).
Constant speed cruise in). (B) is a case where a preceding vehicle that is slower than the set vehicle speed is detected during traveling at a constant speed, and deceleration control is performed so as not to abnormally approach the preceding vehicle (inter-vehicle cruise in S103 in FIG. 8). (C) is a case where the vehicle follows the preceding vehicle, and acceleration / deceleration control is performed such that the inter-vehicle time with the preceding vehicle becomes the target inter-vehicle time with the set vehicle speed as an upper limit (S103 in FIG. 8).
Cruise between vehicles in). (D) is a case where the preceding vehicle has entered the interchange or the service area and is no longer present. In this case, the vehicle gradually accelerates to the set vehicle speed (constant speed cruise in S106 in FIG. 8). The reason why the vehicle gradually accelerates to the set vehicle speed when the preceding vehicle no longer exists is that if the vehicle ahead enters the interchange or the service area and the preceding vehicle disappears, the vehicle rapidly accelerates to the set vehicle speed. This is in consideration of undesirable effects.

【0027】このように、先行車が存在する場合には車
間クルーズを実行するが、その前提として自車線内に存
在する先行車を確実に検出しなければならない。自車が
直線路を走行している場合には、スキャン範囲と自車線
幅が既知であるので、レーザレーダ10で検出した車両
が自車線内に存在する先行車であるか否かの判定は容易
であるが、カーブ路を走行している場合には、検出した
車両が自車線内に存在するか否かをカーブ半径等を考慮
して決定しなければならない。
As described above, when the preceding vehicle is present, the inter-vehicle cruise is executed, but as a prerequisite, the preceding vehicle existing in the own lane must be reliably detected. When the own vehicle is traveling on a straight road, the scan range and the own lane width are known, so whether or not the vehicle detected by the laser radar 10 is the preceding vehicle existing in the own lane is determined. Although it is easy, when traveling on a curved road, it must be determined whether or not the detected vehicle is present in the own lane in consideration of a curve radius and the like.

【0028】図11には、カーブ路を走行している場合
の自車200と前方走行車両300、400との位置関
係が示されている。自車200に搭載されているレーザ
レーダ10で所定範囲をスキャンすると、前方走行車両
300及び400並びに場合によっては道路標識500
が検出される。この内、道路標識500は相対速度の大
きさから除外され(相対速度が一定値以上の場合には静
止物体と判定できる)、前方車両300と400のいず
れが自車線に存在する先行車であるかを決定する必要が
ある(図の場合では前方走行車両300が自車線内先行
車となる)。そこで、本実施形態では、以下のようにし
て先行車300を検出している。
FIG. 11 shows the positional relationship between the host vehicle 200 and the preceding vehicles 300 and 400 when traveling on a curved road. When a predetermined range is scanned by the laser radar 10 mounted on the own vehicle 200, the vehicles 300 and 400 traveling ahead and, in some cases, a road sign 500
Is detected. Among them, the road sign 500 is excluded from the magnitude of the relative speed (if the relative speed is equal to or more than a certain value, it can be determined as a stationary object), and any of the preceding vehicles 300 and 400 is the preceding vehicle existing in the own lane. (In the case of the figure, the preceding traveling vehicle 300 is the preceding vehicle in the own lane). Therefore, in the present embodiment, the preceding vehicle 300 is detected as follows.

【0029】まず、図12に示すように、レーザレーダ
10内のCPU10aは、得られた方向と距離のデータ
から同一物体と考えられるデータをグルーピングして物
体300、400、500を抽出する。この内、物体5
00は上述したように静止物体と判定できるので除外
し、物体300、400についてその位置(Xc、Z)
を検出する。ここで、Z軸は自車の進行方向に設定し、
X軸は道路面内においてZ軸と垂直な方向(自車の幅方
向)に設定する。
First, as shown in FIG. 12, the CPU 10a in the laser radar 10 extracts objects 300, 400 and 500 by grouping data considered to be the same object from the obtained data on the direction and the distance. Among them, object 5
00 is excluded because it can be determined as a stationary object as described above, and the position (Xc, Z) of the objects 300 and 400
Is detected. Here, the Z axis is set in the traveling direction of the own vehicle,
The X axis is set in a direction perpendicular to the Z axis (the width direction of the vehicle) in the road surface.

【0030】次に、CPU10aは車間制御ECU12
から推定カーブ半径データを受信し、これに基づいて検
出した物体の位置(Xc、Z)を直線路における位置
(Xs、Z)に変換する。具体的には、車間制御ECU
12が車速Vとステアリング角θに基づいてカーブ半径
Rを
Next, the CPU 10a controls the headway control ECU 12
From the estimated curve radius data, and converts the position (Xc, Z) of the detected object into a position (Xs, Z) on a straight road based on the data. Specifically, the headway control ECU
12 calculates the curve radius R based on the vehicle speed V and the steering angle θ.

【数1】R=KR(1+αV2+βV3)/θ により推定する。但し、KR、α、βは定数である。そ
して、レーザレーダ10のCPU10aは、この推定カ
ーブ半径Rに基づいて、直線路における位置Xsを
R = KR (1 + αV 2 + βV 3 ) / θ Here, KR, α and β are constants. Then, the CPU 10a of the laser radar 10 calculates the position Xs on the straight road based on the estimated curve radius R.

【数2】Xs=Xc−Z2/2R により算出する。カーブ路における物体の位置を直線路
における位置に換算した後、直線路における位置から自
車線内に存在する確率を算出する。確率の算出は、予め
作成された確率マップに基づいて行われる。
Xs = Xc−Z 2 / 2R After the position of the object on the curved road is converted into the position on the straight road, the probability of being present in the own lane is calculated from the position on the straight road. The calculation of the probability is performed based on a probability map created in advance.

【0031】図13には、CPU10aのメモリに記憶
されている確率マップの一例が示されている。横軸はX
sであり、図では簡略のためXと記している。縦軸はZ
軸である。X軸とZ軸の座標原点は(0、0)であり、
自車の位置である。a〜f及びa’〜f’の直線あるい
は曲線により複数のエリアに分割されている(a’〜
f’はa〜fをZ軸に対して対称に折り返した直線また
は曲線である)。
FIG. 13 shows an example of the probability map stored in the memory of the CPU 10a. The horizontal axis is X
s, and is represented by X in the figure for simplicity. The vertical axis is Z
Axis. The coordinate origin of the X axis and the Z axis is (0, 0),
This is the position of the vehicle. It is divided into a plurality of areas by straight lines or curves a to f and a ′ to f ′ (a ′ to
f ′ is a straight line or a curve obtained by folding a to f symmetrically with respect to the Z axis).

【0032】そして、曲線aとa’で囲まれた領域を
A、曲線bとb’で囲まれた領域(領域Aを除く)を
B、曲線cとc’で囲まれた領域(領域A、Bを除く)
をC、曲線dとd’で囲まれた領域をD、直線eとe’
及びZ=60の直線で囲まれた領域をEとして、各領域
における瞬時自車線確率Poiを以下のように決定する。
The area surrounded by the curves a and a 'is A, the area surrounded by the curves b and b' (excluding the area A) is B, and the area surrounded by the curves c and c '(the area A , B)
C, the area surrounded by the curves d and d 'is D, and the straight lines e and e'
Assuming that a region surrounded by a straight line of Z and Z = 60 is E, the instantaneous lane probability Poi in each region is determined as follows.

【0033】 領域Dを少しでも有する:Poi=100% 領域A内に中心が存在する:Poi=80% 領域B内に中心が存在する:Poi=60% 領域E内に中心が存在する:Poi=60% 領域C内に中心が存在する:Poi=30% 領域Eを少しでも有する:Poi=30% 領域A〜Fを満たさない:Poi=0% 以上のように物体がいずれの領域に位置するかを判定す
ることで物体の瞬時自車線確率Poiを決定し、その重み
付け平均値をもってその物体の自車線存在確率Piとす
る。すなわち、
Having any area D: Poi = 100% Center exists in area A: Poi = 80% Center exists in area B: Poi = 60% Center exists in area E: Poi = 60% The center exists in the area C: Poi = 30% Even the area E is at least: Poi = 30% Areas A to F are not satisfied: Poi = 0% The object is located in any area as described above. Then, the instantaneous lane probability Poi of the object is determined, and the weighted average value is used as the own lane existence probability Pi of the object. That is,

【数3】Pi=Pi(t-1)・α+Poi・(1−α) である。ここで、Pi(t-1)は前回の自車線存在確率であ
り、その初期値は0%である。また、αは重みであり、
この重みは物体までの距離(Zでも可)に応じて変化さ
せるのが好適である。具体的には、物体までの距離が小
さいほど小さく設定する。これにより、物体が近い程、
今回の検出結果Poiの重みを大きくして応答性を上げる
ことができる。
## EQU3 ## Pi = Pi (t-1) .alpha. + Poi.multidot. (1-.alpha.) Here, Pi (t-1) is the previous lane existence probability, and its initial value is 0%. Α is a weight,
It is preferable to change the weight according to the distance to the object (Z may be used). Specifically, the smaller the distance to the object, the smaller the setting. Thereby, the closer the object is,
The responsiveness can be increased by increasing the weight of the current detection result Poi.

【0034】物体の自車線存在確率を決定した後、レー
ザレーダ10のCPU10aは自車線存在確率が所定の
しきい値以上(例えば50%)の物体を抽出する。抽出
した物体が1個のみである場合にはその物体を追従すべ
き先行車と判定し、抽出した物体が複数存在する場合に
は、それらの中で最も自車との距離Zが短いものを追従
すべき先行車と判定する。これにより、例えば図12の
場合において、前方走行車両300と400の自車線存
在確率がそれぞれ60%と30%となって前方走行車両
300のみが先行車と判定されることになり、また、前
方走行車両の前に第3の車両が存在してその自車線存在
確率が約60%であったとしても、距離Zの短い前方走
行車両300が先行車と判定されることになる。
After determining the own lane existence probability of the object, the CPU 10a of the laser radar 10 extracts an object whose own lane existence probability is equal to or more than a predetermined threshold value (for example, 50%). If there is only one extracted object, the object is determined to be the preceding vehicle to follow, and if there are a plurality of extracted objects, the one with the shortest distance Z to the vehicle is selected. It is determined that the preceding vehicle to follow. Thus, for example, in the case of FIG. 12, the own lane existence probabilities of the forward traveling vehicles 300 and 400 become 60% and 30%, respectively, and only the forward traveling vehicle 300 is determined to be the preceding vehicle. Even if the third vehicle exists before the traveling vehicle and its own lane existence probability is about 60%, the forward traveling vehicle 300 with a short distance Z is determined to be the preceding vehicle.

【0035】また、図14(A)のように、自車線上の
先行車aが存在し、さらに隣接車線から車両bが自車線
内に進入しようとしている場合にも、それぞれの存在確
率が(B)のように90%、及び60%であり、ともに
しきい値以上であって車両bの方が距離が短いので、車
両bを追従すべき先行車として認識することになる。こ
れにより、より緊急性のある近い車両に対して迅速に制
御することができる。
Also, as shown in FIG. 14A, when a preceding vehicle a exists on the own lane, and the vehicle b attempts to enter the own lane from an adjacent lane, the respective existence probabilities are ( As shown in B), they are 90% and 60%, both of which are equal to or larger than the threshold value and the distance of the vehicle b is shorter, so that the vehicle b is recognized as a preceding vehicle to be followed. As a result, it is possible to quickly control a more urgent near vehicle.

【0036】なお、先行車を抽出するためのしきい値
は、カーブ半径に応じて変化させるのが好ましい。その
理由は、物体の位置はカーブ路から直線路に換算した値
を用いており、この換算値の信頼性(誤差)はカーブ半
径の値に依存するからである。具体的には、カーブ半径
Rが小さい程しきい値を下げることが望ましい。例え
ば、 1000m≦R:しきい確率=50% 500m≦R<1000m:しきい確率=45% R<500m:しきい確率=40% のごとくである。これにより、任意のカーブ路において
先行車を見失うなどの誤認識を防止して先行車を正しく
判定することができる。
It is preferable that the threshold value for extracting the preceding vehicle is changed according to the radius of the curve. The reason is that the position of the object uses a value converted from a curved road to a straight road, and the reliability (error) of the converted value depends on the value of the curve radius. Specifically, it is desirable to lower the threshold value as the curve radius R is smaller. For example, 1000m ≦ R: threshold probability = 50% 500m ≦ R <1000m: threshold probability = 45% R <500m: threshold probability = 40% Thus, it is possible to prevent erroneous recognition such as losing the leading vehicle on an arbitrary curved road and to correctly determine the leading vehicle.

【0037】[0037]

【発明の効果】以上説明したように、本発明によれば、
制御のターゲットとなる先行車を確実に検出することが
でき、これにより走行制御を確実なものとすることがで
きる。
As described above, according to the present invention,
The preceding vehicle that is the target of the control can be reliably detected, and thus the traveling control can be reliably performed.

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

【図1】 本発明の実施形態の全体構成図である。FIG. 1 is an overall configuration diagram of an embodiment of the present invention.

【図2】 実施形態のレーザレーダの構成図である。FIG. 2 is a configuration diagram of a laser radar according to the embodiment.

【図3】 実施形態のレーザレーダのスキャン範囲説明
図である。
FIG. 3 is an explanatory diagram of a scan range of the laser radar according to the embodiment.

【図4】 実施形態のステアリング近傍の配置説明図で
ある。
FIG. 4 is an explanatory view of an arrangement in the vicinity of a steering according to the embodiment;

【図5】 実施形態のクルーズコントロールスイッチの
拡大図である。
FIG. 5 is an enlarged view of the cruise control switch of the embodiment.

【図6】 実施形態の車間時間切替スイッチの拡大図で
ある。
FIG. 6 is an enlarged view of an inter-vehicle time switch according to the embodiment;

【図7】 実施形態のディスプレイ説明図である。FIG. 7 is an explanatory diagram of a display according to the embodiment.

【図8】 実施形態の全体処理フローチャートである。FIG. 8 is an overall processing flowchart of the embodiment.

【図9】 実施形態の車間制御フローチャートである。FIG. 9 is an inter-vehicle control flowchart of the embodiment.

【図10】 実施形態の処理態様を示す説明図である。FIG. 10 is an explanatory diagram illustrating a processing mode according to the embodiment;

【図11】 実施形態のカーブ路におけるレーダ検出の
説明図である。
FIG. 11 is an explanatory diagram of radar detection on a curved road according to the embodiment.

【図12】 実施形態のカーブ路におけるレーダ検出の
説明図(その2)である。
FIG. 12 is an explanatory diagram (part 2) of radar detection on a curved road according to the embodiment.

【図13】 実施形態の存在確率算出用のマップ説明図
である。
FIG. 13 is an explanatory diagram of a map for calculating an existence probability according to the embodiment.

【図14】 実施形態の車両割り込み時の存在確率説明
図である。
FIG. 14 is an explanatory diagram of the existence probability at the time of vehicle interruption according to the embodiment.

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

10 レーザレーダ、12 車間制御ECU、14 エ
ンジンECU、16ECTモードスイッチ、18 クル
ーズコントロールスイッチ(手元操作手段)、20 ス
トップランプスイッチ、22 車速センサ、24 電子
スロットルアクチュエータ、26 ECTソレノイド、
28 VSC−ECU、30 ステアリングセンサ、3
2 警報ブザー、34 ボデー多重通信、36 テール
ランプスイッチ、38 ワイパースイッチ、40 ディ
スプレイ、44 車間時間切替スイッチ。
10 laser radar, 12 inter-vehicle control ECU, 14 engine ECU, 16 ECT mode switch, 18 cruise control switch (hand operation means), 20 stop lamp switch, 22 vehicle speed sensor, 24 electronic throttle actuator, 26 ECT solenoid,
28 VSC-ECU, 30 steering sensor, 3
2 Alarm buzzer, 34 body multiplex communication, 36 tail lamp switch, 38 wiper switch, 40 display, 44 inter-vehicle time switch.

フロントページの続き (51)Int.Cl.6 識別記号 FI G01S 17/93 G01S 17/88 A (72)発明者 宮越 恒雄 愛知県豊田市トヨタ町1番地 トヨタ自動 車株式会社内 (72)発明者 佐藤 泰彦 愛知県刈谷市昭和町1丁目1番地 株式会 社デンソー内 (72)発明者 寺村 英司 愛知県刈谷市昭和町1丁目1番地 株式会 社デンソー内Continued on the front page (51) Int.Cl. 6 Identification symbol FI G01S 17/93 G01S 17/88 A (72) Inventor Tsuneo Miyakoshi 1 Toyota Town, Toyota City, Aichi Prefecture Inside Toyota Motor Corporation (72) Inventor Yasuhiko Sato 1-1-1, Showa-cho, Kariya-shi, Aichi Prefecture Inside Denso Corporation (72) Inventor Eiji Teramura 1-1-1, Showa-cho, Kariya City, Aichi Prefecture Inside Denso Corporation

Claims (4)

【特許請求の範囲】[Claims] 【請求項1】 レーダ装置で検出した自車周囲の物体か
ら自車線に存在する物体を検出する装置であって、 検出した物体の位置を直線路における位置に換算する換
算手段と、 換算された位置に基づいて自車線に存在する確率を算出
する確率算出手段と、 前記確率が所定値以上であり、かつ、自車との距離が所
定値以下の物体を自車線に存在する物体と判定する判定
手段と、 を有することを特徴とする自車線物体検出装置。
1. A device for detecting an object existing in a vehicle lane from objects around the vehicle detected by a radar device, comprising: conversion means for converting the position of the detected object into a position on a straight road; A probability calculating means for calculating a probability of being in the own lane based on the position; and determining an object whose probability is equal to or more than a predetermined value and whose distance to the own vehicle is equal to or less than a predetermined value as an object existing in the own lane. A self-lane object detection device, comprising: a determination unit.
【請求項2】 前記所定値は、カーブ半径に応じて設定
されることを特徴とする請求項1記載の自車線物体検出
装置。
2. The vehicle lane object detecting device according to claim 1, wherein the predetermined value is set according to a curve radius.
【請求項3】 前記確率算出手段は、前記換算された位
置に応じて決定される今回の確率と、前回得られた確率
との重み付け平均により自車線存在確率を算出し、か
つ、検出した物体の距離に応じて前記重み付け平均の重
みを変化させることを特徴とする請求項1、2のいずれ
かに記載の自車線物体検出装置。
3. The probability calculation means calculates the own lane existence probability by a weighted average of a current probability determined according to the converted position and a probability obtained last time, and detects the detected object lane. The self-lane object detection device according to any one of claims 1 and 2, wherein the weight of the weighted average is changed according to the distance of the vehicle.
【請求項4】 請求項1、2、3のいずれかに記載の自
車線物体検出装置を備え、検出した自車線物体との間隔
を所定値に維持すべく自車速を制御する制御手段を備え
た車両走行制御装置。
4. A vehicle lane object detecting apparatus according to claim 1, further comprising control means for controlling the vehicle speed so as to maintain a distance between the detected vehicle lane object and the vehicle lane object at a predetermined value. Vehicle travel control device.
JP20065597A 1997-07-25 1997-07-25 Own lane object detection device and vehicle travel control device provided with the same Expired - Lifetime JP3516841B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP20065597A JP3516841B2 (en) 1997-07-25 1997-07-25 Own lane object detection device and vehicle travel control device provided with the same

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP20065597A JP3516841B2 (en) 1997-07-25 1997-07-25 Own lane object detection device and vehicle travel control device provided with the same

Publications (2)

Publication Number Publication Date
JPH1145398A true JPH1145398A (en) 1999-02-16
JP3516841B2 JP3516841B2 (en) 2004-04-05

Family

ID=16428028

Family Applications (1)

Application Number Title Priority Date Filing Date
JP20065597A Expired - Lifetime JP3516841B2 (en) 1997-07-25 1997-07-25 Own lane object detection device and vehicle travel control device provided with the same

Country Status (1)

Country Link
JP (1) JP3516841B2 (en)

Cited By (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002056489A (en) * 2000-08-11 2002-02-22 Mazda Motor Corp Control device for vehicle
US6484087B2 (en) 2000-03-30 2002-11-19 Denso Corporation Method of selecting a preceding vehicle, a preceding vehicle selecting apparatus, and a recording medium for selecting a preceding vehicle
JP2002341027A (en) * 2001-05-16 2002-11-27 Fujitsu Ten Ltd Curve r correction method and device for acc system of vehicle
JP2003239791A (en) * 2002-02-20 2003-08-27 Mitsubishi Motors Corp Fuel supply control device of engine
JP2004220341A (en) * 2003-01-15 2004-08-05 Fujitsu Ten Ltd Preceding vehicle estimating method
JP2007161188A (en) * 2005-12-16 2007-06-28 Tokai Rika Co Ltd Shift device
CN1323878C (en) * 2003-07-03 2007-07-04 黄保家 Anticollision system for motor vehicle
JP2008037353A (en) * 2006-08-09 2008-02-21 Honda Motor Co Ltd Travel control device
US7373237B2 (en) 2001-10-05 2008-05-13 Robert Bosch Gmbh Speed regulator with distance regulating function
JP2010257378A (en) * 2009-04-28 2010-11-11 Honda Motor Co Ltd Vehicle surroundings monitoring apparatus
WO2014174734A1 (en) * 2013-04-25 2014-10-30 三洋電機株式会社 Beam irradiator, laser radar, and mirror actuator
JP2014213803A (en) * 2013-04-26 2014-11-17 トヨタ自動車株式会社 Brake control device, brake control method, program and medium
US9015100B2 (en) 2012-01-10 2015-04-21 Denso Corporation Preceding-vehicle identifying apparatus and following-distance control apparatus
JP2016045709A (en) * 2014-08-22 2016-04-04 株式会社アドヴィックス Vehicle controller
US9481369B2 (en) 2006-11-27 2016-11-01 Denso Corporation Cruise control system for determining object as target for cruise control
JP2016189097A (en) * 2015-03-30 2016-11-04 パイオニア株式会社 Abnormal driving detection device
JP2017062639A (en) * 2015-09-25 2017-03-30 日立オートモティブシステムズ株式会社 Three-dimensional object detector
CN108944946A (en) * 2018-07-11 2018-12-07 北京航空航天大学 A kind of bend risk based on truck traffic estimates calculation method
JPWO2022107308A1 (en) * 2020-11-20 2022-05-27

Cited By (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6484087B2 (en) 2000-03-30 2002-11-19 Denso Corporation Method of selecting a preceding vehicle, a preceding vehicle selecting apparatus, and a recording medium for selecting a preceding vehicle
JP2002056489A (en) * 2000-08-11 2002-02-22 Mazda Motor Corp Control device for vehicle
JP4605530B2 (en) * 2000-08-11 2011-01-05 マツダ株式会社 Vehicle control device
JP2002341027A (en) * 2001-05-16 2002-11-27 Fujitsu Ten Ltd Curve r correction method and device for acc system of vehicle
US7373237B2 (en) 2001-10-05 2008-05-13 Robert Bosch Gmbh Speed regulator with distance regulating function
JP2003239791A (en) * 2002-02-20 2003-08-27 Mitsubishi Motors Corp Fuel supply control device of engine
JP2004220341A (en) * 2003-01-15 2004-08-05 Fujitsu Ten Ltd Preceding vehicle estimating method
CN1323878C (en) * 2003-07-03 2007-07-04 黄保家 Anticollision system for motor vehicle
JP2007161188A (en) * 2005-12-16 2007-06-28 Tokai Rika Co Ltd Shift device
JP2008037353A (en) * 2006-08-09 2008-02-21 Honda Motor Co Ltd Travel control device
US9481369B2 (en) 2006-11-27 2016-11-01 Denso Corporation Cruise control system for determining object as target for cruise control
JP2010257378A (en) * 2009-04-28 2010-11-11 Honda Motor Co Ltd Vehicle surroundings monitoring apparatus
US9015100B2 (en) 2012-01-10 2015-04-21 Denso Corporation Preceding-vehicle identifying apparatus and following-distance control apparatus
WO2014174734A1 (en) * 2013-04-25 2014-10-30 三洋電機株式会社 Beam irradiator, laser radar, and mirror actuator
JPWO2014174734A1 (en) * 2013-04-25 2017-02-23 パナソニックIpマネジメント株式会社 Beam irradiation device, laser radar and mirror actuator
JP2014213803A (en) * 2013-04-26 2014-11-17 トヨタ自動車株式会社 Brake control device, brake control method, program and medium
JP2016045709A (en) * 2014-08-22 2016-04-04 株式会社アドヴィックス Vehicle controller
JP2016189097A (en) * 2015-03-30 2016-11-04 パイオニア株式会社 Abnormal driving detection device
JP2017062639A (en) * 2015-09-25 2017-03-30 日立オートモティブシステムズ株式会社 Three-dimensional object detector
CN108944946A (en) * 2018-07-11 2018-12-07 北京航空航天大学 A kind of bend risk based on truck traffic estimates calculation method
JPWO2022107308A1 (en) * 2020-11-20 2022-05-27
WO2022107308A1 (en) * 2020-11-20 2022-05-27 三菱電機株式会社 Physique estimation device, physique estimation method, seat belt reminder system, and airbag control system

Also Published As

Publication number Publication date
JP3516841B2 (en) 2004-04-05

Similar Documents

Publication Publication Date Title
JP3516841B2 (en) Own lane object detection device and vehicle travel control device provided with the same
JP3755248B2 (en) In-vehicle display device
US5485381A (en) Navigation system for land vehicles
JPH1142955A (en) Vehicular running control device
JP2000293782A (en) Automatic running controller
JPH05174296A (en) Inter-vehicle distance detection and alarm device
JPH09190600A (en) Automobile collision prevention device
JP2830576B2 (en) Inter-vehicle distance detection and alarm device
JPH1142956A (en) Vehicular running control device
KR20230130202A (en) Advanced driver assistance system and vehicle having the same
JPH04201643A (en) Between-vehicle distance detecting alarm device
JP2706930B2 (en) Inter-vehicle distance detection and alarm device
JPH09323566A (en) Safety travelling system
JP2830575B2 (en) Inter-vehicle distance detection and alarm device
JP2959255B2 (en) Inter-vehicle distance detection and alarm device
JP2697442B2 (en) Inter-vehicle distance detection and alarm device
JPH11118925A (en) Distance-between-vehicles alarm apparatus
JP2830577B2 (en) Inter-vehicle distance detection and alarm device
CN114851957B (en) Optical signal warning system and method for maintaining vehicle distance of vehicle
JP2591416Y2 (en) Inter-vehicle distance detection and alarm device
JPH04201642A (en) Between-vehicle distance detecting alarm device
JPH04213800A (en) Detecting/alarming device for distance between cars
JPH04201641A (en) Between-vehicle distance detecting alarm device
JPH04232130A (en) Vehicle-to-vehicle distance detector and alarm
JP2002316600A (en) Traveling safety device of vehicle

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20040113

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20040121

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

Free format text: PAYMENT UNTIL: 20080130

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20090130

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20090130

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20100130

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20110130

Year of fee payment: 7

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

Free format text: PAYMENT UNTIL: 20110130

Year of fee payment: 7

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

Free format text: PAYMENT UNTIL: 20120130

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20120130

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20130130

Year of fee payment: 9

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

Free format text: PAYMENT UNTIL: 20130130

Year of fee payment: 9

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

Free format text: PAYMENT UNTIL: 20140130

Year of fee payment: 10

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

EXPY Cancellation because of completion of term