JP5645103B2 - Leading vehicle detector - Google Patents

Leading vehicle detector Download PDF

Info

Publication number
JP5645103B2
JP5645103B2 JP2010113704A JP2010113704A JP5645103B2 JP 5645103 B2 JP5645103 B2 JP 5645103B2 JP 2010113704 A JP2010113704 A JP 2010113704A JP 2010113704 A JP2010113704 A JP 2010113704A JP 5645103 B2 JP5645103 B2 JP 5645103B2
Authority
JP
Japan
Prior art keywords
vehicle
target
preceding vehicle
detected
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.)
Expired - Fee Related
Application number
JP2010113704A
Other languages
Japanese (ja)
Other versions
JP2011240790A (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.)
Isuzu Motors Ltd
Original Assignee
Isuzu Motors Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Isuzu Motors Ltd filed Critical Isuzu Motors Ltd
Priority to JP2010113704A priority Critical patent/JP5645103B2/en
Priority to PCT/JP2011/061242 priority patent/WO2011145581A1/en
Publication of JP2011240790A publication Critical patent/JP2011240790A/en
Application granted granted Critical
Publication of JP5645103B2 publication Critical patent/JP5645103B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18145Cornering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T7/00Brake-action initiating means
    • B60T7/12Brake-action initiating means for automatic initiation; for initiation not subject to will of driver or passenger
    • B60T7/22Brake-action initiating means for automatic initiation; for initiation not subject to will of driver or passenger initiated by contact of vehicle, e.g. bumper, with an external object, e.g. another vehicle, or by means of contactless obstacle detectors mounted on the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14Adaptive cruise control
    • B60W30/16Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0953Predicting travel path or likelihood of collision the prediction being responsive to vehicle dynamic parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Controls For Constant Speed Travelling (AREA)
  • Regulating Braking Force (AREA)
  • Radar Systems Or Details Thereof (AREA)

Description

本発明は、車両等の最適車間維持装置に用いられる先行車検知装置に関する。   The present invention relates to a preceding vehicle detection device used in an optimal headway maintenance device such as a vehicle.

特開2007−253714号公報に記載の車載用レーダ装置では、車速センサが検出する自車速とヨーレートセンサが検出する自車のヨーレートとから自車が走行中の道路曲率を推定し、推定した道路曲率と自車速とに応じて自車線判定幅Lを設定し、自車線判定幅L上で自車からの車間距離が最も近いターゲットを先行車と認定する。自車線判定幅は、既に先行車として認定しているターゲットに対しては広い自車線判定幅L2が適用され、先行車として認定していないターゲットに対しては狭い自車線判定幅L1が適用される。   In the in-vehicle radar device described in Japanese Patent Application Laid-Open No. 2007-253714, the road curvature during which the vehicle is traveling is estimated from the vehicle speed detected by the vehicle speed sensor and the yaw rate of the vehicle detected by the yaw rate sensor. The own lane determination width L is set according to the curvature and the own vehicle speed, and the target having the closest distance from the own vehicle on the own lane determination width L is recognized as the preceding vehicle. As for the own lane determination width, a wide own lane determination width L2 is applied to a target already recognized as a preceding vehicle, and a narrow own lane determination width L1 is applied to a target not approved as a preceding vehicle. The

特開2007−253714号公報JP 2007-253714 A

特開2007−253714号公報に記載の車載用レーダ装置では、自車速と自車のヨーレートとから道路曲率を推定し、推定した道路曲率と自車速とに応じて自車線判定幅Lを設定する。推定される道路曲率は、自車の予想進路であり、自車が直進走行中の場合に、推定される予想進路も直線状である。このため、例えば、前方に右方向へのカーブが存在する片側二車線の右側車線を自車が直進走行している場合、自車の予想進路は、前方のカーブにおいて自車の走行車線と隣接する左側車線上を通過する。従って、前方のカーブの左側車線を他の車両が走行していると、この他の車両を自車の走行車線上の先行車として誤認識する可能性がある。   In the on-vehicle radar device described in Japanese Patent Laid-Open No. 2007-253714, the road curvature is estimated from the own vehicle speed and the yaw rate of the own vehicle, and the own lane determination width L is set according to the estimated road curvature and the own vehicle speed. . The estimated road curvature is the predicted course of the host vehicle, and when the host vehicle is traveling straight ahead, the estimated predicted path is also linear. For this reason, for example, when the host vehicle is traveling straight in the right lane of one side two lanes with a curve in the right direction ahead, the predicted course of the host vehicle is adjacent to the traveling lane of the host vehicle in the forward curve. Pass on the left lane. Therefore, if another vehicle is traveling in the left lane of the front curve, this other vehicle may be erroneously recognized as a preceding vehicle on the traveling lane of the own vehicle.

このような不都合は、自車の前方の道路上に設定された走行線をカメラ等によって画像として取得し、取得した画像を解析して自車の走行車線の実際の進行方向を検出することによって回避することも可能である。しかし、自車の走行車線の実際の進行方向を検出するためには、カメラや画像処理装置等を自車に搭載しなければならず、部品点数の増大や処理の複雑化やコストの増大を招く。   Such inconvenience is obtained by acquiring the travel line set on the road ahead of the host vehicle as an image by a camera or the like, and analyzing the acquired image to detect the actual traveling direction of the host vehicle's travel lane. It is also possible to avoid it. However, in order to detect the actual traveling direction of the traveling lane of the own vehicle, a camera, an image processing device, etc. must be mounted on the own vehicle, which increases the number of parts, increases the complexity of processing, and increases the cost. Invite.

そこで、本発明は、自車両の走行車線の実際の進行方向を検出することなく、隣接車線を走行中の前方車両が先行車として誤認識される可能性を低減させることが可能な先行車検知装置の提供を目的とする。   Therefore, the present invention detects a preceding vehicle that can reduce the possibility that a preceding vehicle traveling in an adjacent lane is erroneously recognized as a preceding vehicle without detecting the actual traveling direction of the traveling lane of the host vehicle. The purpose is to provide a device.

上記課題を達成すべく、本発明の先行車検知装置は、追従対象として設定可能な先行車を検知するための車両に搭載される先行車検知装置であって、物体検出手段と車両情報検出手段と進路推定手段と前方車両判別手段と判定距離設定手段と先行車検知手段とを備える。   In order to achieve the above object, a preceding vehicle detection device of the present invention is a preceding vehicle detection device mounted on a vehicle for detecting a preceding vehicle that can be set as a tracking target, and includes an object detection unit and a vehicle information detection unit. And a route estimation means, a forward vehicle determination means, a determination distance setting means, and a preceding vehicle detection means.

物体検出手段は、車両の進行方向の前方に存在する物体を検知し、物体と車両との相対速度及び車両に対する物体の位置を検出する。車両状態検出手段は、車両の走行状態情報を検出する。進路推定手段は、車両情報検出手段が検出した走行状態情報に基づいて、車両の予想進路を推定する。前方車両判別手段は、物体検出手段が検出した相対速度と車両情報検出手段が検出した走行状態情報とに基づいて、物体が車両と同方向へ走行する前方車両であるか否かを判別する。判定距離設定手段は、予想進路からの判定距離を設定する。先行車検知手段は、物体が前方車両であると前方車両判別手段が判別したとき、物体検出手段が検出した物体の位置と予想進路との距離が判定距離以下であるか否かを判定し、判定距離以下であると判定した物体を追従対象として設定可能な先行車として検知する。判定距離設定手段は、物体が前方車両であると車両判別手段が判別したとき、車両に対して物体が遠ざかるか否かを物体検出手段の検出結果を用いて判定し、車両に対して物体が遠ざかると判定した場合、車両からの物体の離間速度が速いほど判定距離が短くなるように、物体検出手段が検出した相対速度の増加に応じて判定距離を短く設定する。 The object detection means detects an object existing ahead in the traveling direction of the vehicle, and detects a relative speed between the object and the vehicle and a position of the object with respect to the vehicle. The vehicle state detection means detects travel state information of the vehicle. The course estimation means estimates the expected course of the vehicle based on the traveling state information detected by the vehicle information detection means. The forward vehicle determination means determines whether the object is a forward vehicle traveling in the same direction as the vehicle based on the relative speed detected by the object detection means and the running state information detected by the vehicle information detection means. The determination distance setting means sets a determination distance from the expected course. The preceding vehicle detection means determines whether or not the distance between the position of the object detected by the object detection means and the predicted course is equal to or less than the determination distance when the forward vehicle determination means determines that the object is a forward vehicle, An object determined to be less than the determination distance is detected as a preceding vehicle that can be set as a tracking target. The determination distance setting means determines whether or not the object is moving away from the vehicle using the detection result of the object detection means when the vehicle determination means determines that the object is a forward vehicle. If it is determined that the object is away from the vehicle, the determination distance is set to be short according to the increase in the relative speed detected by the object detection unit so that the determination distance is shortened as the separation speed of the object from the vehicle increases.

上記構成では、前方車両判別手段は、物体検出手段が検出した相対速度と車両情報検出手段が検出した走行状態情報とに基づいて、物体検出手段が検出した物体が車両(自車両)と同方向へ走行する前方車両であるか否かを判別する。すなわち、物体検出手段が検出した物体の中で、自車両と反対方向へ走行する対向車両や静止している停止車両及び構造物を除いた物体を、自車両と同方向へ走行する前方車両と判別する。   In the above configuration, the forward vehicle discriminating unit is configured such that the object detected by the object detecting unit is in the same direction as the vehicle (own vehicle) based on the relative speed detected by the object detecting unit and the running state information detected by the vehicle information detecting unit. It is determined whether or not the vehicle is a forward vehicle. That is, among the objects detected by the object detection means, an object other than an oncoming vehicle that travels in the opposite direction to the own vehicle, a stationary vehicle that is stationary, and a structure, and a front vehicle that travels in the same direction as the own vehicle, Determine.

判定距離設定手段は、予想進路からの判定距離を、固定の値ではなく、車両に対して物体が遠ざかる場合、すなわち前方車両が車両から離間していく場合には、物体検出手段が検出した相対速度の増加に応じて短くなるように設定する。例えば、前方車両が車両から高速で離間していく場合は、相対速度が増加するので、判定距離は短く設定される。 The determination distance setting means determines the relative distance detected by the object detection means when the object moves away from the vehicle, that is, when the object moves away from the vehicle. Set to shorten as speed increases. For example, if the vehicle ahead goes away at high speed from the vehicle, the relative speed increases, determining distance is shorter.

先行車検知手段は、前方車両であると判別された物体に対し、その物体の位置と予想進路との距離が判定距離以下であるか否かを判定し、判定距離以下であると判定した物体を追従対象として設定可能な先行車として検知する。   The preceding vehicle detection means determines whether or not the distance between the position of the object and the expected course is equal to or less than the determination distance with respect to the object determined to be the preceding vehicle, and determines that the distance is equal to or less than the determination distance. Is detected as a preceding vehicle that can be set as a tracking target.

従って、自車両からの離間速度が速い(相対速度が大きい)前方車両ほど、先行車として検知され難くなる。例えば、前方に右方向へのカーブが存在する片側二車線の右側車線を自車両が直進走行している場合、自車両の予想進路は、前方のカーブにおいて自車両の走行車線と隣接する左側車線上を通過する。このとき、前方のカーブの左側車線を走行している前方車両が加速して自車両から離れていく場合、この隣接車線を走行中の前方車両は先行車として検知され難くなる。すなわち、自車両の走行車線の実際の進行方向を検出することなく、隣接車線を走行中の前方車両を先行車として誤認識する可能性を低減させることができる。なお、前方に直線が続く車線を自車両が直線走行している場合においても、自車両から離れていく前方車両については、先行車として検知され難くなるが、このような前方車両は、追従対象として特定しても直ぐに検出不能となる可能性が高く、追従対象としての適性に欠けるため、先行車として検知されないことによる支障は生じ難い。
また、判定距離設定手段は、予想進路からの判定距離を、物体検出手段が検出した車両に対する物体の位置から求めた物体との距離の増加に応じて長くなるように設定してもよい。
Therefore, a vehicle ahead with a faster separation speed from the host vehicle (a higher relative speed) is less likely to be detected as a preceding vehicle. For example, when the host vehicle is traveling straight in the right lane of one side two lanes with a curve in the right direction ahead, the predicted course of the host vehicle is the left side vehicle adjacent to the traveling lane of the host vehicle in the forward curve. Pass on the line. At this time, when the forward vehicle traveling in the left lane of the forward curve accelerates away from the host vehicle, the forward vehicle traveling in the adjacent lane is hardly detected as a preceding vehicle. That is, it is possible to reduce the possibility of erroneously recognizing a preceding vehicle traveling in an adjacent lane as a preceding vehicle without detecting the actual traveling direction of the traveling lane of the host vehicle. In addition, even when the host vehicle is traveling in a straight line on a lane with a straight line ahead, it is difficult to detect the preceding vehicle moving away from the host vehicle as a preceding vehicle. Even if it is specified as, it is highly possible that it will be impossible to detect immediately, and since it is not suitable as a subject to be tracked, troubles due to the fact that it is not detected as a preceding vehicle are unlikely to occur.
Further, the determination distance setting means may set the determination distance from the expected course so as to increase as the distance from the object obtained from the position of the object with respect to the vehicle detected by the object detection means increases.

複数の先行車が検知され、それらの先行車の中から追従対象を特定する場合、一般に、自車両に最も近い先行車を追従対象として特定する。   When a plurality of preceding vehicles are detected and a tracking target is specified from among the preceding vehicles, generally the preceding vehicle closest to the host vehicle is specified as the tracking target.

上記構成では、自車両から離れている前方車両ほど先行車として検知され易く、自車両に近い前方車両ほど先行車として検知され難くなる。すなわち、追従対象として特定される可能性の低い前方車両ほど先行車としての判定条件が緩和されるため、幅広く検出された先行車の中から自車両に最も近い前方車両を追従対象として特定することができる。   In the above configuration, a vehicle ahead of the vehicle is more likely to be detected as a preceding vehicle, and a vehicle ahead of the vehicle is less likely to be detected as a preceding vehicle. That is, the determination condition as a preceding vehicle is eased for a forward vehicle that is less likely to be identified as a tracking target, so that the preceding vehicle closest to the host vehicle is identified as the tracking target among widely detected preceding vehicles. Can do.

本発明によれば、自車両の走行車線の実際の進行方向を検出することなく、隣接車線を走行中の前方車両が先行車として誤認識される可能性を低減させることができる。   According to the present invention, it is possible to reduce the possibility that a forward vehicle traveling in an adjacent lane is erroneously recognized as a preceding vehicle without detecting the actual traveling direction of the traveling lane of the host vehicle.

本発明に係わる先行車検知装置を用いた最適車間維持装置(ACC装置)を備えた車両の要部を示すブロック図である。It is a block diagram which shows the principal part of the vehicle provided with the optimal inter-vehicle distance maintenance apparatus (ACC apparatus) using the preceding vehicle detection apparatus concerning this invention. 図1の物体検出センサによる検出を説明するための模式図である。It is a schematic diagram for demonstrating the detection by the object detection sensor of FIG. 先行車検知処理を示すフローチャートである。It is a flowchart which shows a preceding vehicle detection process. トラッキング処理を説明するための模式図である。It is a schematic diagram for demonstrating tracking processing. ターゲットデータ作成処理を説明するための模式図である。It is a schematic diagram for demonstrating a target data creation process. 図3の先行車判定処理を示すフローチャートである。It is a flowchart which shows the preceding vehicle determination process of FIG. 図3の先行車継続判定処理を示すフローチャートである。It is a flowchart which shows the preceding vehicle continuation determination process of FIG. 物体検知センサが、前方のカーブする隣接車線を走行する車両を検知した状態の模式図である。It is a schematic diagram of the state which the object detection sensor detected the vehicle which drive | works the adjacent lane which curves ahead.

以下、本発明の一実施形態を図面に基づいて説明する。図1は本発明に係わる先行車検知装置を用いた最適車間維持装置(ACC装置)を備える車両の要部を示すブロック図、図2は図1の物体検知センサによる物体検出を説明するための模式図、図3は先行車検知処理を示すフローチャート、図4はトラッキング処理を説明するための模式図、図5はターゲットデータ作成処理を説明するための模式図、図6は図3の先行車判定処理を示すフローチャート、図7は図3の先行車継続判定処理を示すフローチャートである。図8は物体検知センサが、前方のカーブする隣接車線を走行する車両を検知した状態の模式図である。図1に示すように、本実施形態に係わる車両1は、車速センサ2と回転角速度センサ3と物体検出センサ4とECU5とブレーキアクチュエータ6とスロットルアクチュエータ7と表示器8とを備える。車速センサ2と回転角速度センサ3は、車両情報検出手段を構成し、物体検出センサ4は物体検出手段を構成する。   Hereinafter, an embodiment of the present invention will be described with reference to the drawings. FIG. 1 is a block diagram showing a main part of a vehicle equipped with an optimal headway distance maintenance device (ACC device) using a preceding vehicle detection device according to the present invention, and FIG. 2 is a diagram for explaining object detection by the object detection sensor of FIG. Fig. 3 is a flowchart showing the preceding vehicle detection process, Fig. 4 is a schematic diagram for explaining the tracking process, Fig. 5 is a schematic diagram for explaining the target data creation process, and Fig. 6 is the preceding vehicle of Fig. 3. FIG. 7 is a flowchart showing the preceding vehicle continuation determination process of FIG. 3. FIG. 8 is a schematic diagram of a state in which the object detection sensor detects a vehicle traveling in an adjacent lane that curves forward. As shown in FIG. 1, the vehicle 1 according to this embodiment includes a vehicle speed sensor 2, a rotational angular velocity sensor 3, an object detection sensor 4, an ECU 5, a brake actuator 6, a throttle actuator 7, and a display 8. The vehicle speed sensor 2 and the rotational angular velocity sensor 3 constitute vehicle information detection means, and the object detection sensor 4 constitutes object detection means.

車速センサ2は、車両1の走行状態情報として車速V(m/s)を検出し、検出した車速VをECU5に出力する。回転角速度センサ3は、車両1の走行状態情報として旋回走行時に車両1に発生するヨーレートYaw(回転角速度:rad/s)を、左回転を正方向として検出し、検出したヨーレートYawをECU5に出力する。   The vehicle speed sensor 2 detects the vehicle speed V (m / s) as the traveling state information of the vehicle 1 and outputs the detected vehicle speed V to the ECU 5. The rotational angular velocity sensor 3 detects the yaw rate Yaw (rotational angular velocity: rad / s) generated in the vehicle 1 during turning as the traveling state information of the vehicle 1, and detects the left rotation as the positive direction, and outputs the detected yaw rate Yaw to the ECU 5. To do.

物体検出センサ4は、図2に示すように、車両1の前端部から進行前方の所定角度Ωの範囲内に向けてレーザやミリ波等の電磁波を所定時間毎に発信し、その反射波を受信することによって、上記範囲内の物体を検知する。更に、検知した物体と車両1との相対速度RV(m/s)、検知した物体と車両1との距離L(m)及び検知した物体の位置データTGD(m)を検出し、検出した相対速度RV、距離L及び位置データTGDをECU5へ出力する。相対速度RVは、車両1と物体が互いに離間する方向を正方向として検出される。また、位置データTGDは車両座標系におけるX座標及びY座標として検出される。車両座標系とは、車両1の左方向をX軸正方向とし、車両1の進行方向をY軸正方向として、例えば図2に示すように座標(Xa、Ya)として設定される2次元座標系である。   As shown in FIG. 2, the object detection sensor 4 emits an electromagnetic wave such as a laser or millimeter wave at a predetermined angle Ω forward from the front end of the vehicle 1 and travels the reflected wave. By receiving, an object within the above range is detected. Further, the relative speed RV (m / s) between the detected object and the vehicle 1, the distance L (m) between the detected object and the vehicle 1, and the detected object position data TGD (m) are detected, and the detected relative The speed RV, distance L, and position data TGD are output to the ECU 5. The relative speed RV is detected with the direction in which the vehicle 1 and the object are separated from each other as the positive direction. The position data TGD is detected as an X coordinate and a Y coordinate in the vehicle coordinate system. The vehicle coordinate system is a two-dimensional coordinate set as, for example, coordinates (Xa, Ya) as shown in FIG. 2, where the left direction of the vehicle 1 is the positive X-axis direction and the traveling direction of the vehicle 1 is the positive Y-axis direction. It is a system.

ECU5は、CPU(Central Processing Unit)51とROM(Read Only Memory)52とRAM(Random Access Memory)53とを備える。CPU51はROMに格納されたプログラムを読み出して、後述する各処理を実行し、進路推定手段、前方車両判別手段、判定距離設定手段、先行車検知手段として機能する。RAMは、車速センサ2が検出した車速V、回転角速度センサ3が検出したヨーレートYaw、物体検出センサ4が検出した物体の相対速度RV、物体との距離Lならびに位置データTGD及び後述するオフセット量D、継続カウンタInCnt、OutCntのカウント値ならびに先行車フラグのオン・オフ値の記憶領域を有する。上記、物体の相対速度RV、距離L、位置データTGD、オフセット量D、継続カウンタInCnt、OutCntのカウント値、先行車フラグのオン・オフ値はターゲットTG毎に存在し、データの記憶にあたってECU5によりターゲットTG固有の識別番号IDが付与される。すなわち識別番号IDを指定して、特定のターゲットTGに属するこれらのデータの読み書きが可能である。また、位置データTGDは後述するトラッキング処理を実行するため、少なくとも現在データ、前回データ、前々回データの記憶領域を有する。   The ECU 5 includes a CPU (Central Processing Unit) 51, a ROM (Read Only Memory) 52, and a RAM (Random Access Memory) 53. The CPU 51 reads a program stored in the ROM, executes each process described later, and functions as a course estimation unit, a forward vehicle determination unit, a determination distance setting unit, and a preceding vehicle detection unit. The RAM includes a vehicle speed V detected by the vehicle speed sensor 2, a yaw rate Yaw detected by the rotational angular velocity sensor 3, a relative speed RV of the object detected by the object detection sensor 4, a distance L from the object, position data TGD, and an offset amount D described later. And a storage area for the count values of the continuation counters InCnt and OutCnt and the on / off value of the preceding vehicle flag. The object relative speed RV, distance L, position data TGD, offset amount D, continuation counter InCnt, OutCnt count value, and on / off value of the preceding vehicle flag exist for each target TG. An identification number ID unique to the target TG is given. That is, it is possible to read / write these data belonging to a specific target TG by specifying an identification number ID. Further, the position data TGD has a storage area for at least current data, previous data, and previous data in order to execute tracking processing described later.

ブレーキアクチュエータ6は、ECU5からの制御信号を受信したとき、図示しない前輪及び後輪のディスクブレーキを強制的に作動させて、各車輪に所定の制動力を発生させる。   When the brake actuator 6 receives the control signal from the ECU 5, the brake actuator 6 forcibly operates the disc brakes of the front wheels and the rear wheels (not shown) to generate a predetermined braking force on each wheel.

スロットルアクチュエータ7は、ECU5からの制御信号を受信したとき、図示しないエンジンのスロットル弁を加速方向に作動させる。   When the throttle actuator 7 receives a control signal from the ECU 5, the throttle actuator 7 operates an engine throttle valve (not shown) in the acceleration direction.

表示器8は、車室内の例えばインストルメントパネル(図示外)に設けられ、ECU5から表示指示信号を受信したとき、表示を行い運転者に注意を喚起する。
次に、ECU5が実行する処理について、図3のフローチャートに基づいて説明する。本処理は、所定時間毎に実行される。ECU5は先ず、車速センサ2が検出した車速Vと回転角速度センサ3が検出したヨーレートYaw及び物体検出センサが検出した車両1と物体との相対速度RV、距離L及び位置データTGDを取得する(テップS1)。
The indicator 8 is provided, for example, on an instrument panel (not shown) in the passenger compartment, and when it receives a display instruction signal from the ECU 5, displays it to alert the driver.
Next, processing executed by the ECU 5 will be described based on the flowchart of FIG. This process is executed every predetermined time. First, the ECU 5 acquires the vehicle speed V detected by the vehicle speed sensor 2, the yaw rate Yaw detected by the rotational angular velocity sensor 3, the relative speed RV, the distance L, and the position data TGD between the vehicle 1 and the object detected by the object detection sensor 4. step S1).

次に、ECU5は自車データの作成処理を実行する(ステップS2)。自車データの作成処理とは、車両1の現在の位置からの予想進路Trを推定する処理である。予想進路Trは、曲率半径R(m)を有する曲線として推定される。曲率半径Rは、ステップS1で取得した車速VとヨーレートYawとを用いて次式(1)に従って算出される。なお、予想進路は直線走行中の場合及び旋回走行中の場合何れにおいても次式(1)に従って算出される。   Next, the ECU 5 executes a process for creating own vehicle data (step S2). The vehicle data creation process is a process of estimating the expected course Tr from the current position of the vehicle 1. The expected course Tr is estimated as a curve having a curvature radius R (m). The curvature radius R is calculated according to the following equation (1) using the vehicle speed V and the yaw rate Yaw acquired in step S1. Note that the expected course is calculated according to the following equation (1) in both cases of straight running and turning.

R=V/Yaw・・・(1) R = V / Yaw (1)

次に、ECU5はトラッキング処理を実行する(ステップS3)。トラッキング処理とは、ステップS1で今回取得した位置データTGDに対応するターゲット(今回検出したターゲット)TGnewと、過去に検出して記憶したターゲットTGpastとを関連付けて時系列的に記憶する処理である。すなわち、今回検出したターゲットTGnewと、既に記憶しているターゲットTGpastとが同一ターゲットであるか否かを判定し、同一ターゲットであると判定した場合には、今回検出したターゲットTGnew対し、既に記憶したターゲットTGpastの識別番号IDと同一の識別番号IDを付与する。同一ターゲットではないと判定した場合は、新規のターゲットであるとして今回検出したターゲットTGnewに新規の識別番号IDを付与する。新規の識別番号IDを付与する場合には、同時に当該識別番号IDに関連付けられた継続カウンタInCnt、OutCntのカウント値をクリアし、当該識別番号IDに関連付けられた先行車フラグをオフにする。   Next, the ECU 5 executes a tracking process (step S3). The tracking process is a process for storing the target (currently detected target) TGnew corresponding to the position data TGD acquired this time in step S1 in association with the target TGpast detected and stored in the past in time series. That is, it is determined whether the target TGnew detected this time and the target TGpast already stored are the same target. If it is determined that they are the same target, the target TGnew detected this time is already stored. The same identification number ID as the identification number ID of the target TGpast is assigned. When it is determined that they are not the same target, a new identification number ID is assigned to the target TGnew detected this time as a new target. When assigning a new identification number ID, the count values of the continuation counters InCnt and OutCnt associated with the identification number ID are simultaneously cleared, and the preceding vehicle flag associated with the identification number ID is turned off.

今回検出したターゲットTGnewと既に記憶したターゲットTGpastとが同一ターゲットであるか否かの判定は、例えば以下の手順で行う。まず、前回のデータの取得時に記憶したターゲットTGpastの座標値(Xk、Yk)と相対速度RVとを次式(2)に代入することにより、ターゲットTGpastが相対速度RVで移動した場合に、今回データの取得時点で存在すると推定される推定位置(Xk+1、Yk+1)を演算する。演算した推定位置(Xk+1、Yk+1)から所定範囲内に今回検出したターゲットTGnew(Xnew、Ynew)が存在する場合には、ターゲットTGpastと今回検出したターゲットTGnewは同一ターゲットであると判定し、存在しない場合には、今回検出したターゲットTGnewは新規のターゲットであると判定する。   Whether or not the target TGnew detected this time and the already stored target TGpast are the same target is determined by the following procedure, for example. First, when the target TGpast moves at the relative speed RV by substituting the coordinate value (Xk, Yk) and the relative speed RV of the target TGpast stored at the time of the previous data acquisition into the following equation (2), this time An estimated position (Xk + 1, Yk + 1) estimated to exist at the time of data acquisition is calculated. When the target TGnew (Xnew, Ynew) detected this time is within a predetermined range from the calculated estimated position (Xk + 1, Yk + 1), it is determined that the target TGpast and the target TGnew detected this time are the same target and do not exist. In this case, it is determined that the target TGnew detected this time is a new target.

Xk+1=Xk+RVk×Δt×sinθ、Yk+1=Yk+RVk×Δt×cosθ・・・(2) Xk + 1 = Xk + RVk × Δt × sin θ, Yk + 1 = Yk + RVk × Δt × cos θ (2)

上記(2)式において、Δtは、前回のデータ取得時から今回のデータ取得時までの時間(ターゲットTGの検出時間間隔)であり、θは、ターゲットTGpastの進行方向と車両1の進行方向(Y軸方向)とがなす角度である。ターゲットTGpastの進行方向は、ターゲットTGpastの前回の座標値(Xk、Yk)と前回の前(前々回)の座標値(Xk−1、Yk−1)とが記憶されている場合には、図4に示すように、前々回の座標値(Xk−1、Yk−1)から前回の座標値(Xk、Yk)へ向かうベクトルの方向として求める。また、前々回の座標値(Xk−1、Yk−1)が記憶されていない場合、すなわち前回新規に判別したターゲットである場合には、ターゲットTGpastの進行方向は、前回の座標値(Xk、Yk)から車両1に向かうベクトルの方向として求める。   In the above equation (2), Δt is a time from the previous data acquisition time to the current data acquisition time (detection time interval of the target TG), and θ is the traveling direction of the target TGpast and the traveling direction of the vehicle 1 ( (Y axis direction). As the traveling direction of the target TGpast, when the previous coordinate values (Xk, Yk) and the previous (previous) coordinate values (Xk-1, Yk-1) of the target TGpast are stored, FIG. As shown, the vector direction from the previous coordinate value (Xk-1, Yk-1) to the previous coordinate value (Xk, Yk) is obtained. When the previous coordinate values (Xk-1, Yk-1) are not stored, that is, when the target is a newly determined target last time, the traveling direction of the target TGpast is the previous coordinate value (Xk, Yk). ) To the vehicle 1 as a vector direction.

次に、ECU5は前方車両判別処理を実行する(ステップS4)。前方車両判別処理とは、トラッキング処理を実施した全ての今回検出したターゲットTGnewの中から、車両1の前方を同方向へ走行する車両を選別する処理である。まず、ECU5はステップS1で取得した車両1と今回検出したターゲットTGnewとの相対速度RVと車両1の車速Vとを比較する。今回検出したターゲットTGnewの相対速度RVと車両1の車速Vとの関係が、RV<−Vにあるターゲットは車両1と反対方向に走行する対向車、RV=−Vにあるターゲットは停止車又は構造物、−V<RV<0にあるターゲットは、車両1と同方向に走行しつつ車両1に接近する車両、RV=0にあるターゲットは、車両1と同方向に走行しつつ車両1との車間距離を維持する車両、RV>0にあるターゲットは、車両1と同方向に走行しつつ車両1から離間する車両と分類できる。そこで、今回検出したターゲットTGnewの相対速度RVと車両1の車速Vとの関係がRV>−Vにあるターゲットを、車両1の前方を同方向へ走行する車両(以降、処理対象ターゲットTGnewと称す)と判別する。   Next, the ECU 5 executes a forward vehicle discrimination process (step S4). The forward vehicle discrimination process is a process of selecting a vehicle traveling in the same direction in front of the vehicle 1 from all the target TGnew detected this time that has been subjected to the tracking process. First, the ECU 5 compares the relative speed RV between the vehicle 1 acquired in step S1 and the target TGnew detected this time with the vehicle speed V of the vehicle 1. A target in which the relationship between the relative speed RV of the target TGnew detected this time and the vehicle speed V of the vehicle 1 is RV <−V is an oncoming vehicle that runs in the opposite direction to the vehicle 1, and a target in RV = −V is a stop vehicle or A structure, a target in −V <RV <0 is a vehicle approaching the vehicle 1 while traveling in the same direction as the vehicle 1, and a target in RV = 0 is a vehicle 1 traveling in the same direction as the vehicle 1 A vehicle that maintains the following distance, and a target with RV> 0 can be classified as a vehicle that is traveling away from the vehicle 1 while traveling in the same direction as the vehicle 1. Therefore, a target in which the relationship between the relative speed RV of the target TGnew detected this time and the vehicle speed V of the vehicle 1 is RV> −V is a vehicle traveling in the same direction in front of the vehicle 1 (hereinafter referred to as a processing target TGnew). ).

次にECU5はターゲットデータ作成処理を実行する(ステップS5)。ターゲットデータ作成処理とは、前方車両判別処理で判別された処理対象ターゲットTGnewの現在位置TGDnew(Xnew、Ynew)と車両1の予想進路Trとの間の距離(オフセット量Dnew)を求める処理である。オフセット量Dnewは図5に示すように、処理対象ターゲットTGnewの座標値(Xnew、Ynew)とステップS2で求めた車両1の予想進路Trの曲率半径Rとを用いて、次式(3)によって演算する。   Next, the ECU 5 executes target data creation processing (step S5). The target data creation process is a process for obtaining a distance (offset amount Dnew) between the current position TGDnew (Xnew, Ynew) of the processing target TGnew determined in the forward vehicle determination process and the expected course Tr of the vehicle 1. . As shown in FIG. 5, the offset amount Dnew is expressed by the following equation (3) using the coordinate values (Xnew, Ynew) of the processing target TGnew and the curvature radius R of the expected course Tr of the vehicle 1 obtained in step S2. Calculate.

Dnew=R/|R|×((Xnew−R)+Ynew1/2−|R|)・・・(3) Dnew = R / | R | × ((Xnew−R) 2 + Ynew 2 ) 1/2 − | R |) (3)

ECU5は全ての処理対象ターゲットTGnewについて上記オフセット量Dnewを算出し、処理対象ターゲットTGnewと同一の識別番号IDを付与する。   The ECU 5 calculates the offset amount Dnew for all the processing target targets TGnew and assigns the same identification number ID as the processing target TGnew.

次にECU5は全ての処理対象ターゲットTGnewについて後述するステップS7からステップS9の処理を完了したか否かを判定し(ステップS6)、まだ処理が完了していない処理対象ターゲットTGnewが存在する場合ステップS7へ進み、全ての処理対象ターゲットTGnewについて処理が完了している場合のみ、ステップS10に進む。   Next, the ECU 5 determines whether or not the processing from step S7 to step S9, which will be described later, has been completed for all the processing target targets TGnew (step S6), and if there are processing target targets TGnew that have not been processed yet, step The process proceeds to S7 and proceeds to Step S10 only when the processing has been completed for all the processing target targets TGnew.

ステップS7へ進んだ場合は、ECU5は処理対象ターゲットTGnewと同一の識別番号IDが付与された先行車フラグがオンであるか否かを判定する。先行車フラグがオフである場合は、ステップS8へ進んで先行車判定処理を実行し、先行車フラグがオンである場合は、ステップS9に進んで先行車継続判定処理を実行する。なお、処理対象ターゲットTGnewが新規に判別したターゲットTGである場合は、新規の識別番号IDを付与する際に関連付けられた先行車フラグはオフとされているので、ステップS8へ進んで先行車判定処理を実行する。   When the process proceeds to step S7, the ECU 5 determines whether or not the preceding vehicle flag assigned with the same identification number ID as the processing target TGnew is ON. If the preceding vehicle flag is off, the process proceeds to step S8 to execute the preceding vehicle determination process. If the preceding vehicle flag is on, the process proceeds to step S9 to execute the preceding vehicle continuation determination process. When the target TGnew to be processed is a newly determined target TG, the preceding vehicle flag associated with the assignment of the new identification number ID is turned off, so the process proceeds to step S8 to determine the preceding vehicle. Execute the process.

先行車判定処理(ステップS8)の具体的内容を図6に示す。先ず、先行車判定のための第一の判定距離kの設定処理を行う。判定距離kは固定の値ではなく、処理対象ターゲットTGnewの識別番号IDに属する車両1と処理対象ターゲットTGnewとの距離L及び相対速度RVから、ターゲットTGnew毎に設定され、相対速度が大きいほど小さく、距離が大きいほど大きくなる値とする。具体的には例えば、判定距離kは次式(4)により算出し、設定する(ステップS81)。   Specific contents of the preceding vehicle determination process (step S8) are shown in FIG. First, the first determination distance k is set for determining the preceding vehicle. The determination distance k is not a fixed value, but is set for each target TGnew from the distance L and the relative speed RV between the vehicle 1 belonging to the identification number ID of the processing target TGnew and the processing target TGnew, and decreases as the relative speed increases. The value increases as the distance increases. Specifically, for example, the determination distance k is calculated and set by the following equation (4) (step S81).

k=α×L×(1−RV/β) ・・・(4)
ここで、α及びβは所定の係数である。
k = α × L × (1-RV / β) (4)
Here, α and β are predetermined coefficients.

処理対象ターゲットTGnewに対してステップS5で求めた現在位置のオフセット量Dnewの絶対値が判定距離k以下であるか否かを判定し(ステップS82)、現在位置のオフセット量Dnewの絶対値が判定距離k以下のときは、ステップS83へ進んで処理対象ターゲットTGnewと同一の認識番号IDが付与された継続カウンタInCntのカウント値を1増加し、ステップS85へ進む。現在位置のオフセット量Dnewの絶対値が判定距離kを超えているときは、ステップS84へ進んで処理対象ターゲットTGnewと同一の認識番号IDが付与された継続カウンタInCntのカウント値をクリアし、ステップS85へ進む。   It is determined whether or not the absolute value of the offset amount Dnew at the current position obtained in step S5 with respect to the processing target TGnew is equal to or less than the determination distance k (step S82), and the absolute value of the offset amount Dnew at the current position is determined. When the distance is equal to or shorter than k, the process proceeds to step S83, and the count value of the continuation counter InCnt to which the same identification number ID as the processing target TGnew is assigned is incremented by 1, and the process proceeds to step S85. When the absolute value of the offset amount Dnew at the current position exceeds the determination distance k, the process proceeds to step S84 to clear the count value of the continuation counter InCnt to which the same identification number ID as the processing target TGnew is assigned. Proceed to S85.

ステップS85では、処理対象ターゲットTGnewと同一の認識番号IDが付与された継続カウンタInCntのカウント値が所定の閾値mを超えているか否かの判定をする。判定の結果、カウント値が所定の閾値mを超えている場合には、処理対象ターゲットTGnewが車両1の先行車であると判断し、ステップS86へ進んで、処理対象ターゲットTGnewと同一の認識番号IDが付与された先行車フラグをオンに設定する。カウント値が所定の閾値m以下の場合には、処理対象ターゲットTGnewが上記先行車ではないと判定し、ステップS87へ進んで処理対象ターゲットTGnewと同一の認識番号IDが付与された先行車フラグをオフに設定する。これらステップS86又はステップS87の処理を実行することにより、先行車判定処理を終了し、図3のステップS6へ戻る。   In step S85, it is determined whether or not the count value of the continuation counter InCnt to which the same identification number ID as that of the processing target TGnew is given exceeds a predetermined threshold value m. As a result of the determination, if the count value exceeds the predetermined threshold value m, it is determined that the processing target TGnew is a preceding vehicle of the vehicle 1, and the process proceeds to step S86, where the same identification number as the processing target TGnew is obtained. The preceding vehicle flag assigned with the ID is set to ON. If the count value is less than or equal to the predetermined threshold value m, it is determined that the processing target TGnew is not the preceding vehicle, and the process proceeds to step S87 where the preceding vehicle flag assigned the same identification number ID as the processing target TGnew is displayed. Set it to off. By executing the process of step S86 or step S87, the preceding vehicle determination process is terminated, and the process returns to step S6 of FIG.

先行車継続判定処理(ステップS9)では図7に示すように、まず、処理対象ターゲットTGnewに対して先行車判定の第二の判定距離であるhを設定する。hは車両1とターゲットTGnewの距離が大きくなればなるほど大きくなる数値である(ステップS91)。処理対象ターゲットTGnewに対してステップS5で求めた現在位置のオフセット量Dnewの絶対値が判定距離h以上であるか否かを判定し(ステップS92)、現在位置のオフセット量Dnewの絶対値が判定距離h以上のときは、ステップS93へ進んで処理対象ターゲットTGnewと同一の認識番号IDが付与された継続カウンタOutCntのカウント値を1増加し、ステップS95へ進む。現在位置のオフセット量Dnewの絶対値が判定距離h未満のときは、ステップS94へ進んで処理対象ターゲットTGnewと同一の識別番号IDが付与された継続カウンタOutCntのカウント値をクリアし、ステップS95へ進む。   In the preceding vehicle continuation determination process (step S9), as shown in FIG. 7, first, h, which is the second determination distance of the preceding vehicle determination, is set for the processing target TGnew. h is a numerical value that increases as the distance between the vehicle 1 and the target TGnew increases (step S91). It is determined whether or not the absolute value of the offset amount Dnew at the current position obtained in step S5 with respect to the processing target TGnew is greater than or equal to the determination distance h (step S92), and the absolute value of the offset amount Dnew at the current position is determined. When the distance is equal to or longer than h, the process proceeds to step S93, and the count value of the continuation counter OutCnt to which the same identification number ID as the processing target TGnew is assigned is incremented by 1, and the process proceeds to step S95. When the absolute value of the offset amount Dnew of the current position is less than the determination distance h, the process proceeds to step S94, and the count value of the continuation counter OutCnt to which the same identification number ID as that of the processing target TGnew is assigned is cleared, and the process proceeds to step S95. move on.

ステップS95では、処理対象ターゲットTGnewと同一の識別番号IDが付与された継続カウンタOutCntのカウント値が所定の閾値nを超えているか否かの判定をする。判定の結果、カウント値が所定の閾値nを超えている場合には、処理対象ターゲットTGnewが車両1の先行車ではないと判定し、ステップS96へ進んで処理対象ターゲットTGnewと同一の識別番号IDが付与された先行車フラグをオフに設定する。カウント値が所定の閾値n以下の場合は、ステップS97へ進んで処理対象ターゲットTGnewと同一の識別番号IDが付与された先行車フラグをオンに設定する。これらステップS96又はステップS97の処理を実行することにより、先行車判定処理を終了し、図3のステップS6へ戻る。   In step S95, it is determined whether or not the count value of the continuation counter OutCnt to which the same identification number ID as that of the processing target TGnew is given exceeds a predetermined threshold value n. As a result of the determination, if the count value exceeds the predetermined threshold value n, it is determined that the processing target TGnew is not a preceding vehicle of the vehicle 1, and the process proceeds to step S96 where the same identification number ID as the processing target TGnew is obtained. The preceding vehicle flag assigned with is set to OFF. When the count value is equal to or smaller than the predetermined threshold value n, the process proceeds to step S97, and the preceding vehicle flag assigned with the same identification number ID as the processing target TGnew is set on. By executing the process of step S96 or step S97, the preceding vehicle determination process is terminated, and the process returns to step S6 of FIG.

先行車優先判定処理(ステップS10)では、まず先行車フラグがオンに設定された全ての処理対象ターゲットTGnewのうち、車両1と処理対象ターゲットTGnewとの距離Lが最小のターゲットを追従対象の先行車と判定し、表示器8に信号を送り、追従対象の先行車が認識されたことを表示する。次に車両1と追従対象の先行車と判定された処理対象ターゲットTGnewとの距離Lと、目標の車間距離Ls(m)とを比較する。目標の車間距離Lsは、車両1が追従対象の先行車に対して維持すべき車間距離として予め設定される。前記距離Lが前記目標の車間距離Ls以下の場合は、ブレーキアクチュエータ6を制御して車両1を減速させ、前記距離Lが前記目標の車間距離Lsを超えている場合には、スロットルアクチュエータ7を制御して車両1を加速させることにより、車両1と前記先行車との距離Lが維持すべき目標の車間距離Lsになるように制御する。   In the preceding vehicle priority determination process (step S10), first, of all the processing target targets TGnew for which the preceding vehicle flag is set to ON, a target with the smallest distance L between the vehicle 1 and the processing target TGnew is set as the preceding target to be followed. The vehicle is determined, and a signal is sent to the display 8 to display that the preceding vehicle to be followed is recognized. Next, the distance L between the vehicle 1 and the processing target TGnew determined as the preceding vehicle to be tracked is compared with the target inter-vehicle distance Ls (m). The target inter-vehicle distance Ls is set in advance as the inter-vehicle distance that the vehicle 1 should maintain with respect to the preceding vehicle to be tracked. When the distance L is less than or equal to the target inter-vehicle distance Ls, the brake actuator 6 is controlled to decelerate the vehicle 1, and when the distance L exceeds the target inter-vehicle distance Ls, the throttle actuator 7 is By controlling and accelerating the vehicle 1, the distance L between the vehicle 1 and the preceding vehicle is controlled to be the target inter-vehicle distance Ls to be maintained.

以上のような実施形態によれば、車両1からの離間速度が速い(相対速度が大きい)前方車両ほど、当該車両のオフセット量Dnewに対する判定距離kの値が小さくなるので、先行車として検知され難くなる。従って、例えば図8に示すように、前方に右方向へのカーブが存在する片側二車線の右側車線を車両1が直進走行している場合において、車両1の予想進路Trが、前方のカーブにおいて車両1の走行車線と隣接する左側車線上を通過する場合、前方のカーブの左側車線を走行している前方車両が、加速して車両1から離れていく場合は、先行車として検知され難くなる。よって、隣接車線を走行中の前方車両を先行車として誤認識する可能性を低減させることができる。   According to the embodiment as described above, the value of the determination distance k with respect to the offset amount Dnew of the vehicle becomes smaller as the vehicle ahead is faster (relative speed is larger) from the vehicle 1 and is thus detected as a preceding vehicle. It becomes difficult. Therefore, for example, as shown in FIG. 8, when the vehicle 1 is traveling straight in the right lane of one side two lanes with a curve in the right direction ahead, the expected course Tr of the vehicle 1 is When passing on the left lane adjacent to the travel lane of the vehicle 1, if the front vehicle traveling in the left lane of the front curve accelerates away from the vehicle 1, it becomes difficult to be detected as a preceding vehicle. . Therefore, it is possible to reduce the possibility of erroneously recognizing the preceding vehicle traveling in the adjacent lane as the preceding vehicle.

また、本実施形態では先行車判定の基準となる車両1の自車線は、カメラ等の特別の装置を用いて実際に検出することなく、自車両情報から推定した予想進路Trに基づいている。従って、自車両の走行車線の実際の進行方向を検出することなく、極めて簡単な構成及び処理で隣接車線を走行中の前方車両を先行車として誤認識する可能性を低減させることができる。   Further, in the present embodiment, the own lane of the vehicle 1 serving as a reference for the preceding vehicle determination is based on the predicted course Tr estimated from the own vehicle information without actually detecting it using a special device such as a camera. Therefore, it is possible to reduce the possibility of erroneously recognizing the preceding vehicle traveling in the adjacent lane as the preceding vehicle with an extremely simple configuration and processing without detecting the actual traveling direction of the traveling lane of the host vehicle.

また、本実施形態では、判定距離kの値を前方車両と車両1との距離の増加に応じて長くするため、車両1から離れている前方車両ほど先行車として検知され易く、車両1に近い前方車両ほど先行車として検知され難くなる。そして、前方車両を先行車として検知した場合には、先行車優先判定処理により車両1との距離Lが最小の前方車両を追従すべき先行車と判定する。従って、追従対象として特定される可能性の低い前方車両ほど先行車としての判定条件を緩和し、幅広く検出された先行車の中から自車両に最も近い前方車両を追従対象として的確に特定することができる。   In the present embodiment, since the value of the determination distance k is increased as the distance between the preceding vehicle and the vehicle 1 increases, the preceding vehicle that is farther from the vehicle 1 is more easily detected as a preceding vehicle and is closer to the vehicle 1. The vehicle ahead is less likely to be detected as a preceding vehicle. When the preceding vehicle is detected as a preceding vehicle, the preceding vehicle with the smallest distance L from the vehicle 1 is determined as the preceding vehicle to be followed by the preceding vehicle priority determination process. Therefore, the determination condition as a preceding vehicle is relaxed for a forward vehicle that is less likely to be identified as a tracking target, and the preceding vehicle closest to the host vehicle is accurately identified as a tracking target among widely detected preceding vehicles. Can do.

以上、本発明者によってなされた発明を適用した実施形態について説明したが、この実施形態による本発明の開示の一部をなす論述及び図面により本発明は限定されることはない。すなわち、この実施形態に基づいて当業者等によりなされる他の実施形態、実施例および運用技術等は全て本発明の範疇に含まれることは勿論である。   As mentioned above, although the embodiment to which the invention made by the present inventor is applied has been described, the present invention is not limited by the discussion and the drawings that form part of the disclosure of the present invention according to this embodiment. That is, it is needless to say that other embodiments, examples, operation techniques, and the like made by those skilled in the art based on this embodiment are all included in the scope of the present invention.

例えば、上記実施形態では物体検知センサ2は車両1と物体との距離及び相対速度を検出するものとしたが、物体検知センサ2は物体の距離Lのみを検出し、ECU5が当該距離から物体の座標による位置(Xa,Ya)及び距離の時間変化から相対速度RVを演算する構成でもよい。   For example, in the above embodiment, the object detection sensor 2 detects the distance and relative speed between the vehicle 1 and the object. However, the object detection sensor 2 detects only the distance L of the object, and the ECU 5 detects the object from the distance. The relative speed RV may be calculated from the position (Xa, Ya) and the time change of the distance based on the coordinates.

また、上記実施形態では、車速センサが検出する車速Vと回転角速度センサが検出するヨーレートYawを用いて車両1の予想進路Trを推定しているが、操舵角センサが検出するステアリングの操舵角や加速度センサが検出する車両1の加速度などの他の走行状態情報を用いて予想進路を推定してもよい。   In the above embodiment, the estimated course Tr of the vehicle 1 is estimated using the vehicle speed V detected by the vehicle speed sensor and the yaw rate Yaw detected by the rotational angular velocity sensor. However, the steering angle of the steering detected by the steering angle sensor The predicted course may be estimated using other traveling state information such as the acceleration of the vehicle 1 detected by the acceleration sensor.

更に、上記実施形態では、1つのECU5がACC装置として、先行車を判定し、判定した先行車と車両1の距離Lを目標の車間距離Lsに維持すべくブレーキアクチュエータ6、エンジンアクチュエータ7を制御しているが、先行車の判定と、車両1の車間距離制御とを異なる別のユニットで構成してもよい。当該構成ではACC装置を備えた既存の車両に対しては、ACC装置の先行車判定処理を実行する部分を本発明による先行車の判定処理装置(ユニット)に置き換えて設置すればよく、このような既存の車両に対して、本発明を容易に適用して隣接車線の誤検知を減少させることができる。   Further, in the above embodiment, one ECU 5 as an ACC device determines a preceding vehicle, and controls the brake actuator 6 and the engine actuator 7 to maintain the determined distance L between the preceding vehicle and the vehicle 1 at the target inter-vehicle distance Ls. However, the determination of the preceding vehicle and the inter-vehicle distance control of the vehicle 1 may be configured by different units. In this configuration, for an existing vehicle equipped with an ACC device, the part for executing the preceding vehicle determination process of the ACC device may be replaced with the preceding vehicle determination processing device (unit) according to the present invention. Therefore, the present invention can be easily applied to existing vehicles to reduce false detection of adjacent lanes.

本発明の先行車検知装置は、様々な車両に搭載して使用可能である。   The preceding vehicle detection device of the present invention can be used by being mounted on various vehicles.

1:車両
2:車速センサ(車両情報検出手段)
3:回転角速度センサ(車両情報検出手段)
4:物体検出センサ(物体検出手段)
5:ECU(進路推定手段、前方車判別手段、判定距離設定手段、先行車検知手段)
6:ブレーキアクチュエータ
7:スロットルアクチュエータ
8:表示器
1: Vehicle 2: Vehicle speed sensor (vehicle information detection means)
3: Rotational angular velocity sensor (vehicle information detection means)
4: Object detection sensor (object detection means)
5: ECU (route estimation means, forward vehicle discrimination means, determination distance setting means, preceding vehicle detection means)
6: Brake actuator 7: Throttle actuator 8: Indicator

Claims (1)

追従対象として設定可能な先行車を検知するために車両に搭載される先行車検知装置であって、
前記車両の進行方向の前方に存在する物体を検知し、前記物体と前記車両との相対速度及び前記車両に対する前記物体の位置を検出する物体検出手段と、
前記車両の走行状態情報を検出する車両状態検出手段と、
前記車両情報検出手段が検出した走行状態情報に基づいて、前記車両の予想進路を推定する進路推定手段と、
前記物体検出手段が検出した相対速度と前記車両情報検出手段が検出した走行状態情報とに基づいて、前記物体が前記車両と同方向へ走行する前方車両であるか否かを判別する前方車両判別手段と、
前記予想進路からの判定距離を設定する判定距離設定手段と、
前記物体が前記前方車両であると前記前方車両判別手段が判別したとき、前記物体検出手段が検出した前記物体の位置と前記予想進路との距離が前記判定距離以下であるか否かを判定し、前記判定距離以下であると判定した物体を前記先行車として検知する先行車検知手段と、を備え
前記判定距離設定手段は、前記物体が前記前方車両であると前記車両判別手段が判別したとき、前記車両に対して前記物体が遠ざかるか否かを前記物体検出手段の検出結果を用いて判定し、前記車両に対して前記物体が遠ざかると判定した場合、前記車両からの前記物体の離間速度が速いほど前記判定距離が短くなるように、前記物体検出手段が検出した相対速度の増加に応じて前記判定距離を短く設定する
ことを特徴とする先行車検知装置。
A preceding vehicle detection device mounted on a vehicle to detect a preceding vehicle that can be set as a tracking target,
An object detection means for detecting an object present ahead of the traveling direction of the vehicle, and detecting a relative speed between the object and the vehicle and a position of the object with respect to the vehicle;
Vehicle state detection means for detecting travel state information of the vehicle;
A route estimation unit that estimates an expected route of the vehicle based on the traveling state information detected by the vehicle information detection unit;
Forward vehicle discrimination for discriminating whether the object is a forward vehicle traveling in the same direction as the vehicle based on the relative speed detected by the object detection means and the running state information detected by the vehicle information detection means. Means,
Determination distance setting means for setting a determination distance from the expected course;
When the object is discriminated said preceding vehicle judgment means that the front vehicle, the distance between the predicted course and position of the object in which the object detecting unit detects is equal to or less than the determination distance A preceding vehicle detection means for detecting an object determined to be equal to or less than the determination distance as the preceding vehicle ,
The determination distance setting means determines, using the detection result of the object detection means, whether the object moves away from the vehicle when the vehicle determination means determines that the object is the preceding vehicle. When it is determined that the object moves away from the vehicle, according to the increase in the relative speed detected by the object detection unit, the determination distance is shortened as the separation speed of the object from the vehicle increases. A preceding vehicle detection device characterized in that the determination distance is set short .
JP2010113704A 2010-05-17 2010-05-17 Leading vehicle detector Expired - Fee Related JP5645103B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2010113704A JP5645103B2 (en) 2010-05-17 2010-05-17 Leading vehicle detector
PCT/JP2011/061242 WO2011145581A1 (en) 2010-05-17 2011-05-16 Proceeding vehicle detection device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010113704A JP5645103B2 (en) 2010-05-17 2010-05-17 Leading vehicle detector

Publications (2)

Publication Number Publication Date
JP2011240790A JP2011240790A (en) 2011-12-01
JP5645103B2 true JP5645103B2 (en) 2014-12-24

Family

ID=44991684

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010113704A Expired - Fee Related JP5645103B2 (en) 2010-05-17 2010-05-17 Leading vehicle detector

Country Status (2)

Country Link
JP (1) JP5645103B2 (en)
WO (1) WO2011145581A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107031629A (en) * 2017-03-10 2017-08-11 上海大学 A kind of 3D machine vision fork truck traveling supplementary security system and method

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110940981B (en) * 2019-11-29 2024-02-20 径卫视觉科技(上海)有限公司 Method for judging whether position of object in front of vehicle is in own lane

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3843512B2 (en) * 1996-12-13 2006-11-08 株式会社デンソー Vehicle speed control method and vehicle speed control device
WO2005020182A1 (en) * 2003-08-20 2005-03-03 Hitachi, Ltd. Device and method for selecting preceding vehicle
JP4191667B2 (en) * 2004-10-26 2008-12-03 本田技研工業株式会社 Vehicle control object determination device
JP4555699B2 (en) * 2005-02-01 2010-10-06 本田技研工業株式会社 Leading vehicle recognition device
JP4916723B2 (en) * 2006-01-16 2012-04-18 富士重工業株式会社 Outside-of-vehicle monitoring device and travel control device equipped with this out-of-vehicle monitoring device
JP4980007B2 (en) * 2006-08-09 2012-07-18 本田技研工業株式会社 Travel control device
JP5283967B2 (en) * 2008-05-14 2013-09-04 日立オートモティブシステムズ株式会社 In-vehicle object detection device

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107031629A (en) * 2017-03-10 2017-08-11 上海大学 A kind of 3D machine vision fork truck traveling supplementary security system and method
CN107031629B (en) * 2017-03-10 2019-11-19 上海大学 A kind of 3D machine vision fork truck traveling supplementary security system and method

Also Published As

Publication number Publication date
JP2011240790A (en) 2011-12-01
WO2011145581A1 (en) 2011-11-24

Similar Documents

Publication Publication Date Title
US10077050B2 (en) Automated driving system for evaluating lane cut-out and method of using the same
CN109572672B (en) Vehicle driving assistance device
US8447484B2 (en) Branch-lane entry judging system
JP6381592B2 (en) Method and control unit for monitoring traffic
US9297892B2 (en) Method of operating a radar system to reduce nuisance alerts caused by false stationary targets
JP3658519B2 (en) Vehicle control system and vehicle control device
JP4906398B2 (en) In-vehicle road shape identification device, in-vehicle system, road shape identification method and periphery monitoring method
JP6363516B2 (en) Vehicle travel control device
US20080306666A1 (en) Method and apparatus for rear cross traffic collision avoidance
US11052910B2 (en) Vehicle control apparatus
CN107004367B (en) Vehicle travel control device and travel control method
US10557935B2 (en) Determining a state of a vehicle and assisting a driver in driving the vehicle
US9540002B2 (en) Target recognition apparatus
JP2004523772A (en) How to detect vehicle lane change
JP2009536132A (en) Vehicle speed control method in complex traffic situations
CN109017776B (en) Driving assistance system mounted in vehicle
JP2019002769A (en) Target determination device and operation supporting system
JP7340097B2 (en) A method for tracking a remote target vehicle within a peripheral area of a motor vehicle using collision recognition means
JP2007253714A (en) On-vehicle radar device
JP6095197B2 (en) Vehicle object detection device
JP2017128286A (en) Vehicular travelling control device
JPH11321379A (en) Vehicle running control device
JP5645103B2 (en) Leading vehicle detector
CN110678778B (en) Vehicle system for detecting an oncoming vehicle
JP6720954B2 (en) Vehicle target detection device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130405

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140307

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140430

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140523

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140710

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

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20141010

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20141023

R150 Certificate of patent or registration of utility model

Ref document number: 5645103

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees