JP5054389B2 - Vehicle driving support device - Google Patents

Vehicle driving support device Download PDF

Info

Publication number
JP5054389B2
JP5054389B2 JP2007027258A JP2007027258A JP5054389B2 JP 5054389 B2 JP5054389 B2 JP 5054389B2 JP 2007027258 A JP2007027258 A JP 2007027258A JP 2007027258 A JP2007027258 A JP 2007027258A JP 5054389 B2 JP5054389 B2 JP 5054389B2
Authority
JP
Japan
Prior art keywords
vehicle
deceleration
target
preceding vehicle
acceleration
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
JP2007027258A
Other languages
Japanese (ja)
Other versions
JP2008189199A (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.)
Subaru Corp
Original Assignee
Fuji Jukogyo KK
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 Fuji Jukogyo KK filed Critical Fuji Jukogyo KK
Priority to JP2007027258A priority Critical patent/JP5054389B2/en
Publication of JP2008189199A publication Critical patent/JP2008189199A/en
Application granted granted Critical
Publication of JP5054389B2 publication Critical patent/JP5054389B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、先行車に追従して加減速制御を行う車両の運転支援装置に関する。   The present invention relates to a driving support apparatus for a vehicle that performs acceleration / deceleration control following a preceding vehicle.

近年、車両においては、カメラやレーザレーダ等を用いた前方認識装置により先行車を認識し、この認識した先行車に追従走行する様々な車両運転支援装置が開発され、実用化されている。   2. Description of the Related Art In recent years, in vehicles, various vehicle driving support devices that recognize a preceding vehicle using a front recognition device using a camera, a laser radar, and the like and follow the recognized preceding vehicle have been developed and put into practical use.

例えば、特開2000−355231号広報には、自車速を、車間距離と自車速に基づいて算出した目標車速に一致させる先行車追従制御装置において、自車速が低車速領域であるときに大きな値となり、高車速領域であるときに小さな値となるオフセット量を、横加速度センサで検出した横加速度から減算して横加速度補正値を算出する。そして、この横加速度補正値を基にこれが小さいときに小さい値となり、大きいときに大きい値となる車速減算値を算出し、この車速減算値に基づいて目標車速を抑制することで、コーナー走行時の減速制御を最適に行って運転者に与える違和感を解消する技術が開示されている。
特開2000−355231号広報
For example, in Japanese Laid-Open Patent Publication No. 2000-355231, in a preceding vehicle follow-up control device that matches the own vehicle speed with the target vehicle speed calculated based on the inter-vehicle distance and the own vehicle speed, a large value is obtained when the own vehicle speed is in the low vehicle speed region. Thus, the lateral acceleration correction value is calculated by subtracting the offset amount, which is a small value in the high vehicle speed region, from the lateral acceleration detected by the lateral acceleration sensor. Based on this lateral acceleration correction value, a vehicle speed subtraction value that is small when it is small and large when it is large is calculated, and the target vehicle speed is suppressed based on this vehicle speed subtraction value. A technique for eliminating the uncomfortable feeling given to the driver by optimally performing the deceleration control is disclosed.
JP 2000-355231 A

しかしながら、上述の特許文献1に開示される目標車速を抑制する技術では、現在の車両挙動を基に目標車速の抑制が行われるため、実際に車両挙動が発生してからの加減速の抑制となり、実際の感覚に対して遅れが生じ、追従する先行車の動きに対してずれた車両挙動となって、ドライバが不自然な感覚を抱くという問題がある。   However, in the technology for suppressing the target vehicle speed disclosed in Patent Document 1 described above, since the target vehicle speed is suppressed based on the current vehicle behavior, acceleration / deceleration after the actual vehicle behavior occurs is suppressed. However, there is a problem that a delay occurs with respect to the actual feeling and the vehicle behavior deviates from the movement of the preceding vehicle to follow, and the driver has an unnatural feeling.

本発明は上記事情に鑑みてなされたもので、現在の車両挙動のみならず、今後予想される車両挙動をも考慮して、直進状態からカーブ走行に至るまで、たとえ、これら走行路の過渡状態における走行状況においても、車両の加減速度を適切に抑制し、先行車追従に際して円滑で違和感の無い快適な制御が行える車両の運転支援装置を提供することを目的とする。   The present invention has been made in view of the above circumstances, considering not only the current vehicle behavior but also the vehicle behavior expected in the future, from the straight running state to the curve running, for example, the transient state of these running paths. It is an object of the present invention to provide a vehicle driving support apparatus that can appropriately suppress the acceleration / deceleration of a vehicle and can perform smooth and comfortable control when following a preceding vehicle.

本発明は、自車両の走行情報を検出する自車走行情報検出手段と、先行車を認識し、この先行車情報を検出する先行車情報検出手段と、上記自車両の走行情報と上記先行車情報とに基づき上記自車両が上記先行車に追従走行を実行するのに必要な目標加減速度を演算する目標加減速度演算手段と、上記自車両の走行情報と上記先行車情報とに基づき上記自車両が上記先行車に追従するのに必要な目標パラメータを推定し、該目標パラメータに応じて演算した上記目標加減速度を制限する第1の制限値と、上記目標パラメータの単位時間あたりの変化量に応じて演算した上記目標加減速度を制限する第2の制限値と、上記目標パラメータと現在の実際のパラメータの値との差分に応じて演算した上記目標加減速度を制限する第3の制限値の少なくとも一つの制限値により、上記目標加減速度を制限する目標加減速度制限手段とを備え、上記目標加減速度制限手段は、上記第1の制限値と上記第2の制限値と上記第3の制限値の何れか2つの制限値、或いは、これら3つの制限値により上記目標加減速度を制限する場合、上記複数の制限値の中で絶対値の最も小さな制限値を用いて上記目標加減速度を制限することを特徴としている。 The present invention includes a host vehicle travel information detection unit that detects travel information of the host vehicle, a preceding vehicle information detection unit that recognizes a preceding vehicle and detects the preceding vehicle information, the traveling information of the host vehicle, and the preceding vehicle. Based on the information, the target acceleration / deceleration calculating means for calculating the target acceleration / deceleration necessary for the host vehicle to follow the preceding vehicle, and the host vehicle based on the host vehicle travel information and the preceding vehicle information. A target parameter necessary for the vehicle to follow the preceding vehicle is estimated, a first limit value for limiting the target acceleration / deceleration calculated according to the target parameter, and a change amount of the target parameter per unit time And a third limit value for limiting the target acceleration / deceleration calculated according to the difference between the target parameter and the current actual parameter value. Less By one of the limit values with, and a target acceleration limiting means for limiting the target acceleration, the target acceleration limiting means, said first limit value and the second limit value and the third restriction When the target acceleration / deceleration is limited by any two limit values or by these three limit values, the target acceleration / deceleration is limited by using the limit value having the smallest absolute value among the plurality of limit values. It is characterized in that.

本発明による車両の運転支援装置によれば、現在の車両挙動のみならず、今後予想される車両挙動をも考慮して、直進状態からカーブ走行に至るまで、たとえ、これら走行路の過渡状態における走行状況においても、車両の加減速度を適切に抑制し、先行車追従に際して円滑で違和感の無い快適な制御が可能となる。   According to the vehicle driving support device of the present invention, considering not only the current vehicle behavior but also the vehicle behavior expected in the future, from the straight traveling state to the curve traveling, even in the transient state of these traveling paths. Even in the driving situation, the acceleration / deceleration of the vehicle is appropriately suppressed, and smooth and comfortable control can be performed when following the preceding vehicle.

以下、図面に基づいて本発明の実施の形態を説明する。
図1〜図10は本発明の実施の形態を示し、図1は車両に搭載した運転支援装置の概略構成図、図2は追従加減速制御プログラムのフローチャート、図3は目標加減速度a演算処理ルーチンのフローチャート、図4は目標加減速度a制限処理ルーチンのフローチャート、図5は先行車加減速度−先行車速の目標加減速度演算式の領域マップの説明図、図6は目標加減速度演算式において用いるパラメータの説明図、図7は自車両と先行車の座標位置と関係を示す説明図、図8は制限値の一例を示す説明図、図9は直進路からカーブ走行に移行する一例の説明図、図10は図9に示す走行路を走行する際に設定される制限値の一例を示すタイムチャートである。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
1 to 10 show an embodiment of the present invention, FIG. 1 is a schematic configuration diagram of a driving support device mounted on a vehicle, FIG. 2 is a flowchart of a follow-up acceleration / deceleration control program, and FIG. 3 is a target acceleration / deceleration a calculation process. 4 is a flowchart of a target acceleration / deceleration a restriction processing routine, FIG. 5 is an explanatory diagram of an area map of a target vehicle acceleration / deceleration-preceding vehicle speed target acceleration / deceleration equation, and FIG. 6 is used in a target acceleration / deceleration equation. FIG. 7 is an explanatory diagram showing the relationship between the coordinate positions of the host vehicle and the preceding vehicle, FIG. 8 is an explanatory diagram showing an example of the limit value, and FIG. 9 is an explanatory diagram of an example of shifting from a straight path to a curve run FIG. 10 is a time chart showing an example of limit values set when traveling on the travel path shown in FIG.

図1において、符号1は自動車等の車両(自車両)で、この車両1には、運転支援装置の一例としてのクルーズコントロールシステム(ACC(Adaptive Cruise Control)システム)2が搭載されている。   In FIG. 1, reference numeral 1 denotes a vehicle such as an automobile (own vehicle), and a cruise control system (ACC (Adaptive Cruise Control) system) 2 as an example of a driving support device is mounted on the vehicle 1.

このACCシステム2は、ステレオカメラ3、ステレオ画像認識装置4、制御ユニット5等を有して主要に構成されている。そして、このACCシステム2では、基本的に、先行車が存在しない定速走行制御状態のときにはドライバが設定した車速を保持した状態で走行し、先行車が存在する場合には、追従加減速制御と追従操舵制御の自動追従制御を実行するものである。   The ACC system 2 mainly includes a stereo camera 3, a stereo image recognition device 4, a control unit 5, and the like. In the ACC system 2, basically, the vehicle travels while maintaining the vehicle speed set by the driver in the constant speed traveling control state in which no preceding vehicle exists, and the following acceleration / deceleration control in the case where the preceding vehicle exists. The automatic tracking control of the tracking steering control is executed.

また、自車両1には、自車走行情報検出手段としての自車速V0を検出する車速センサ6、ステアリング角Srを検出するハンドル角センサ7、及び、ヨーレートγrを検出するヨーレートセンサ8が設けられており、自車速V0はステレオ画像認識装置4と制御ユニット5に入力され、ステアリング角Srとヨーレートγrは制御ユニット5に入力される。更に、制御ユニット5には図示しないブレーキスイッチからのブレーキペダルのON−OFF信号等が入力される。   Further, the host vehicle 1 is provided with a vehicle speed sensor 6 that detects the host vehicle speed V0, a steering wheel angle sensor 7 that detects the steering angle Sr, and a yaw rate sensor 8 that detects the yaw rate γr. The vehicle speed V0 is input to the stereo image recognition device 4 and the control unit 5, and the steering angle Sr and the yaw rate γr are input to the control unit 5. Further, an ON-OFF signal of a brake pedal from a brake switch (not shown) is input to the control unit 5.

また、ステアリングコラムの側部等に設けられた定速走行操作レバーに連結される複数のスイッチ類で構成された定速走行スイッチ9からの各種スイッチによる信号が制御ユニット5に入力される。この定速走行スイッチ9は、定速走行時の目標車速を設定する車速セットスイッチ、主に目標車速を下降側へ変更設定するコーストスイッチ、主に目標車速を上昇側へ変更設定するリジュームスイッチ等で構成されている。更に、この定速走行操作レバーの近傍には、定速走行制御及び自動追従制御のON/OFFを行うメインスイッチ(図示せず)が配設されている。   In addition, signals from various switches from a constant speed travel switch 9 constituted by a plurality of switches connected to a constant speed travel operation lever provided on the side of the steering column or the like are input to the control unit 5. The constant speed travel switch 9 is a vehicle speed set switch that sets a target vehicle speed during constant speed travel, a coast switch that mainly changes and sets the target vehicle speed to the lower side, a resume switch that mainly changes and sets the target vehicle speed to the higher side, etc. It consists of Further, a main switch (not shown) for turning ON / OFF constant speed traveling control and automatic tracking control is disposed in the vicinity of the constant speed traveling operation lever.

ステレオカメラ3は、ステレオ光学系として例えば電荷結合素子(CCD)等の固体撮像素子を用いた1組の(左右の)CCDカメラで構成される。これら左右のCCDカメラは、それぞれ車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像し、画像データをステレオ画像認識装置4に出力する。   The stereo camera 3 is composed of a set of (left and right) CCD cameras using a solid-state imaging device such as a charge coupled device (CCD) as a stereo optical system. These left and right CCD cameras are each mounted at a certain interval in front of the ceiling in the vehicle interior, take a stereo image of an object outside the vehicle from different viewpoints, and output image data to the stereo image recognition device 4.

ステレオ画像認識装置4は、ステレオカメラ3からの画像データ、車速センサ6からの自車速V0が入力され、ステレオカメラ3からの画像データに基づき自車両1前方の立体物データと白線データの前方情報を検出し、自車両1の進行路(自車進行路)を推定する。そして、自車両1前方の先行車を抽出して、先行車位置(例えば、図7に示すように、自車両1を原点とするX−Z座標系上の座標位置)、先行車距離(車間距離)L、先行車速((車間距離Lの変化量)+(自車速V0))Vf、先行車加減速度(先行車速Vfの微分値)af、先行車以外の静止物位置、白線座標、白線認識距離、自車進行路座標等の各データを制御ユニット5に出力する。   The stereo image recognition device 4 receives the image data from the stereo camera 3 and the own vehicle speed V0 from the vehicle speed sensor 6, and based on the image data from the stereo camera 3, the front information of the three-dimensional object data and the white line data in front of the own vehicle 1. Is detected, and the traveling path of the own vehicle 1 (own vehicle traveling path) is estimated. Then, the preceding vehicle ahead of the host vehicle 1 is extracted, and the preceding vehicle position (for example, the coordinate position on the XZ coordinate system with the host vehicle 1 as the origin as shown in FIG. 7), the preceding vehicle distance (inter-vehicle distance). Distance) L, preceding vehicle speed ((change in inter-vehicle distance L) + (own vehicle speed V0)) Vf, preceding vehicle acceleration / deceleration (differential value of preceding vehicle speed Vf) af, position of stationary object other than preceding vehicle, white line coordinates, white line Each data such as the recognition distance and the own vehicle traveling path coordinates is output to the control unit 5.

ここで、ステレオ画像認識装置4における、ステレオカメラ3からの画像データの処理は、例えば以下のように行われる。まず、ステレオカメラ3のCCDカメラで撮像した自車両1の進行方向の環境の1組のステレオ画像対に対し、対応する位置のずれ量から三角測量の原理によって距離情報を求める処理を行って、三次元の距離分布を表す距離画像を生成する。そして、このデータを基に、周知のグルーピング処理や、予め記憶しておいた三次元的な道路形状データ、立体物データ等と比較し、白線データ、道路に沿って存在するガードレール、縁石等の側壁データ、車両等の立体物データを抽出する。   Here, the processing of the image data from the stereo camera 3 in the stereo image recognition device 4 is performed as follows, for example. First, for a pair of stereo images of the environment in the traveling direction of the host vehicle 1 imaged by the CCD camera of the stereo camera 3, a process for obtaining distance information by the principle of triangulation from the corresponding positional deviation amount is performed. A distance image representing a three-dimensional distance distribution is generated. And based on this data, compared with well-known grouping processing and pre-stored three-dimensional road shape data, solid object data, etc., white line data, guardrails, curbs, etc. existing along the road Side wall data and three-dimensional object data such as vehicles are extracted.

立体物データでは、立体物までの距離と、この距離の時間的変化(自車両1に対する相対速度)が求められ、特に自車進行路上にある最も近い車両で、自車両1と略同じ方向に所定の速度(例えば、0km/h以上)で走行するものが先行車として抽出される。尚、先行車の中で速度Vfが略0km/hである車両は、停止した先行車として認識される。また、立体物情報、及び、先行車情報は、後面の左端点と右端点の位置情報が記憶され、更に、この後面の左端点と右端点との略中央が立体物又は先行車の重心位置として記憶される。このように、ステレオカメラ3及びステレオ画像認識装置4は、先行車情報検出手段としての機能を有して設けられている。   In the three-dimensional object data, the distance to the three-dimensional object and the temporal change (relative speed with respect to the own vehicle 1) of this distance are obtained. In particular, in the closest vehicle on the own vehicle traveling path, in the same direction as the own vehicle 1 A vehicle traveling at a predetermined speed (for example, 0 km / h or more) is extracted as a preceding vehicle. Of the preceding vehicles, a vehicle having a speed Vf of approximately 0 km / h is recognized as a stopped preceding vehicle. Further, as the three-dimensional object information and the preceding vehicle information, the position information of the left end point and the right end point of the rear surface is stored, and the approximate center between the left end point and the right end point of the rear surface is the center of gravity position of the three-dimensional object or the preceding vehicle. Is remembered as Thus, the stereo camera 3 and the stereo image recognition device 4 have a function as a preceding vehicle information detection means.

制御ユニット5は、ドライバの操作入力によって設定される走行速度を維持するよう定速走行制御を行う定速走行制御の機能、及び、自動追従制御(追従加減速制御、及び、追従操舵制御)の機能を実現するもので、ドライバが図示しないメインスイッチをONし、定速走行操作レバーにより、希望する車速をセットすると、定速走行スイッチ9からの信号が制御ユニット5に入力される。そして、車速センサ6で検出した車速が、ドライバのセットした設定車速に収束するように、スロットル弁制御装置10に信号出力してスロットル弁11の開度をフィードバック制御し、自車両1を自動的に定速状態で走行させ、或いは、自動ブレーキ制御装置12に減速信号を出力して自動ブレーキを作動させる。   The control unit 5 includes a function of constant speed traveling control for performing constant speed traveling control so as to maintain a traveling speed set by a driver's operation input, and automatic tracking control (tracking acceleration / deceleration control and tracking steering control). When the driver turns on a main switch (not shown) and sets a desired vehicle speed with a constant speed operation lever, a signal from the constant speed travel switch 9 is input to the control unit 5. Then, a signal is output to the throttle valve control device 10 so that the vehicle speed detected by the vehicle speed sensor 6 converges to the set vehicle speed set by the driver, and the opening degree of the throttle valve 11 is feedback-controlled, so that the host vehicle 1 is automatically operated. The vehicle is run at a constant speed, or a deceleration signal is output to the automatic brake control device 12 to activate the automatic brake.

また、制御ユニット5は、定速走行制御を行っている際に、ステレオ画像認識装置4にて先行車を認識した場合には、後述する自動追従制御へ自動的に切り換えられる。尚、定速走行制御の機能、及び、自動追従制御の機能は、ドライバがブレーキを踏んだ場合やメインスイッチがOFFされた場合には、解除されるようになっている。   When the stereo image recognition device 4 recognizes the preceding vehicle during the constant speed traveling control, the control unit 5 is automatically switched to automatic follow-up control described later. Note that the constant speed traveling control function and the automatic tracking control function are canceled when the driver steps on the brake or when the main switch is turned off.

車両の走行制御が追従走行制御へ移行すると、本実施の形態の追従加減速制御の例では、詳細は後述するが、予め設定した2つの領域からなる先行車加減速度af−先行車速Vfの目標加減速度演算式の領域マップを参照し、現在の先行車の加減速度afと速度Vfが属する領域の目標加減速度演算式を選択し、この選択した目標加減速度演算式により目標加減速度aを演算する。   When the vehicle travel control shifts to the follow-up travel control, in the example of the follow-up acceleration / deceleration control of the present embodiment, the target vehicle acceleration / deceleration af−the preceding vehicle speed Vf composed of two preset areas will be described in detail later. Referring to the area map of the acceleration / deceleration calculation formula, select the target acceleration / deceleration calculation formula for the area to which the current acceleration / deceleration af and speed Vf belong, and calculate the target acceleration / deceleration a using the selected target acceleration / deceleration calculation formula To do.

更に、自車速V0と自車両1に対する先行車の相対位置とに基づき自車両1が先行車に追従するのに必要な目標パラメータとしての目標ヨーレートγtを演算する。   Further, a target yaw rate γt as a target parameter necessary for the host vehicle 1 to follow the preceding vehicle is calculated based on the host vehicle speed V0 and the relative position of the preceding vehicle with respect to the host vehicle 1.

また、目標ヨーレートγtに応じて制限値(第1の制限値Lmγ1)を演算し、目標ヨーレートγtの単位時間あたりの変化量(γt−γtold)/Δtに応じて制限値(第2の制限値Lmγ2)を演算し、目標ヨーレートγtと現在の実際のヨーレートγrとの偏差Δγ(=γt−γr)に応じて制限値(第3の制限値Lmγ3)を演算し、これら第1,第2,第3の制限値の絶対値の最小のものを制限値Lmに設定する。   Further, a limit value (first limit value Lmγ1) is calculated according to the target yaw rate γt, and a limit value (second limit value) according to the amount of change (γt−γtold) / Δt of the target yaw rate γt per unit time. Lmγ2) is calculated, a limit value (third limit value Lmγ3) is calculated according to a deviation Δγ (= γt−γr) between the target yaw rate γt and the current actual yaw rate γr, and the first, second, The smallest absolute value of the third limit value is set as the limit value Lm.

そして、目標加減速度aを制限値Lmで制限し、自動ブレーキ制御装置12に信号出力して自動ブレーキ制御(追従停止制御も含む)を行わせ、或いは、スロットル弁制御装置10に信号出力して自動加速制御(追従発進制御も含む)等を行う。このように、本実施の形態において、制御ユニット5は、目標加減速度演算手段、及び、目標加減速度制限手段としての機能を有して構成される。   Then, the target acceleration / deceleration a is limited by the limit value Lm, and a signal is output to the automatic brake control device 12 to perform automatic brake control (including follow-up stop control), or a signal is output to the throttle valve control device 10. Performs automatic acceleration control (including tracking start control). As described above, in the present embodiment, the control unit 5 is configured to have functions as a target acceleration / deceleration calculating means and a target acceleration / deceleration limiting means.

また、制御ユニット5は、車両の走行制御が追従走行制御へ移行すると、本実施の形態の追従操舵制御の例では、自車速V0が、例えば35km/h未満の領域で実行され、この車速領域内においての予め設定する高速側の車速領域の場合には、自車速V0と自車両1に対する先行車の相対位置とに基づき自車両1が先行車に追従するのに必要な目標ヨーレートγtを演算し、この目標ヨーレートγtに基づき先行車に追従するパワーステアリング指示電流値icを演算して電動パワーステアリング制御装置13に出力する。一方、この車速領域内においての予め設定する低速側の車速領域の場合には、自車両1に対する先行車の相対位置に基づき自車両1が先行車に追従するのに必要な目標ステアリング角Stを演算し、この目標ステアリング角Stに基づき先行車に追従するパワーステアリング指示電流値icを演算して電動パワーステアリング制御装置13に出力する。   In addition, when the vehicle traveling control shifts to the tracking traveling control, the control unit 5 executes the vehicle speed V0 in an area where the vehicle speed V0 is, for example, less than 35 km / h in the example of the tracking steering control of the present embodiment. In the case of the vehicle speed region set in advance in the vehicle, the target yaw rate γt required for the own vehicle 1 to follow the preceding vehicle is calculated based on the own vehicle speed V0 and the relative position of the preceding vehicle with respect to the own vehicle 1. Based on this target yaw rate γt, the power steering command current value ic that follows the preceding vehicle is calculated and output to the electric power steering control device 13. On the other hand, in the vehicle speed region set in advance in the vehicle speed region, the target steering angle St required for the host vehicle 1 to follow the preceding vehicle based on the relative position of the preceding vehicle with respect to the host vehicle 1 is set. Based on this target steering angle St, the power steering command current value ic that follows the preceding vehicle is calculated and output to the electric power steering control device 13.

尚、符号14は、ACCシステム2の各作動状態を表示する液晶モニタであり、例えば、車載のナビゲーションシステムと共用される。   Reference numeral 14 denotes a liquid crystal monitor that displays each operating state of the ACC system 2, and is shared with, for example, an in-vehicle navigation system.

次に、追従走行制御の追従加減速制御について、図2のフローチャートで説明する。この追従加減速制御プログラムは、ACCシステム2のメインスイッチがONされて、先行車が存在する追従走行制御に移行すると所定時間毎に実行されるものであり、まず、ステップ(以下、「S」と略称)101で必要なパラメータの読み込みが行われる。次いで、S102に進み、目標加減速度aの演算処理が実行され、S103に進んで、S102で演算した目標加減速度aの制限処理を実行し、S104に進んで、S103にて必要に応じて制限処理された目標加減速度aを、自動ブレーキ制御装置12、或いは、スロットル弁制御装置10に信号出力してプログラムを抜ける。   Next, follow-up acceleration / deceleration control of follow-up running control will be described with reference to the flowchart of FIG. This follow-up acceleration / deceleration control program is executed every predetermined time when the main switch of the ACC system 2 is turned on and shifts to follow-up running control in which a preceding vehicle is present. First, a step (hereinafter, “S”) is executed. (Abbreviated as) 101, necessary parameters are read. Next, the process proceeds to S102, where the target acceleration / deceleration a calculation process is executed, and the process proceeds to S103, where the target acceleration / deceleration a calculated in S102 is limited, and the process proceeds to S104, where it is limited as necessary in S103. The processed target acceleration / deceleration a is output to the automatic brake control device 12 or the throttle valve control device 10 to exit the program.

ここでは、まず、S102にて実行される目標加減速度aの演算処理について、図3のフローチャートで説明する。   Here, first, the calculation process of the target acceleration / deceleration a executed in S102 will be described with reference to the flowchart of FIG.

まず、S201では、演算式選択フラグFaを参照する。この演算式選択フラグFaは、前回、先行車の走行状態(加減速度af、車速Vf)によって後述する第1の演算式が選択されている場合には「1」がセットされ、後述する第2の演算式が選択されている場合には「2」がセットされるフラグである。   First, in S201, the arithmetic expression selection flag Fa is referred to. This calculation formula selection flag Fa is set to “1” when the first calculation formula described later is selected last time according to the traveling state (acceleration / deceleration af, vehicle speed Vf) of the preceding vehicle, and is set to “2” described later. This flag is set when “2” is selected.

ここで、本実施の形態において、予め設定した2つの領域からなる先行車加減速度af−先行車速Vfの目標加減速度演算式の領域マップと、それぞれの領域に設定される演算式(第1の演算式及び第2の演算式)について説明する。   Here, in the present embodiment, the area map of the target vehicle acceleration / deceleration formula of preceding vehicle acceleration / deceleration af−preceding vehicle speed Vf composed of two regions set in advance, and the calculation equation (first An arithmetic expression and a second arithmetic expression) will be described.

先行車加減速度af−先行車速Vfの目標加減速度演算式の領域とは、例えば、図5(a)に示すように、先行車の加減速度の絶対値|af|と速度の絶対値|Vf|との関係において、Vf=1.0・afを境界線Tthとし、上側の領域(先行車の車速の絶対値|Vf|が高いが加減速度の絶対値|af|が小さい領域)が第1の演算式を選択する第1の領域として設定され、下側の領域(先行車の車速の絶対値|Vf|が低いが加減速度の絶対値|af|が高い領域)が第2の演算式を選択する第2の領域として予め設定されている。尚、本実施の形態においては、加減速度の符号は、減速方向を正、加速方向を負とする。   The area of the target vehicle acceleration / deceleration af-preceding vehicle speed Vf target acceleration / deceleration equation is, for example, as shown in FIG. 5A, the absolute value | af | of the preceding vehicle and the absolute value | Vf of the preceding vehicle. |, Vf = 1.0 · af is the boundary line Tth, and the upper region (region where the absolute value | Vf | of the preceding vehicle is high but the absolute value | af | of the acceleration / deceleration is small) is the first region. The second region is set as the first region for selecting the arithmetic expression 1 and the lower region (region where the absolute value | Vf | of the preceding vehicle is low but the absolute value | af | of the acceleration / deceleration is high) is the second region. It is preset as a second area for selecting an expression. In this embodiment, the sign of acceleration / deceleration is positive in the deceleration direction and negative in the acceleration direction.

そして、第1の演算式とは、先行車が走行を継続することを前提に自車両1が予め設定した車間距離を先行車に対し維持して追従走行するための演算式であり、自車両1と先行車とが、図6に示すような関係、すなわち、現在、自車速V0、自車加減速度a0、先行車速Vf、先行車加減速度af、車間距離Lである状態が、t秒後に、自車両1が距離Ls前進し、先行車が先行車予測位置まで距離Lf前進し、自車両1との車間距離が目標車間距離Dtgt(マップ或いは演算により設定される距離)となるとすると、自車両1の目標加減速度aは、以下の(1)式より求められる。
a=af+((V0−Vf)/(L−Dtgt)) …(1)
従って、この(1)式が、第1の領域における第1の演算式として定められている。
The first arithmetic expression is an arithmetic expression for following the vehicle while maintaining the inter-vehicle distance set in advance by the host vehicle 1 with respect to the preceding vehicle on the assumption that the preceding vehicle continues to travel. 1 and the preceding vehicle are in a relationship as shown in FIG. 6, that is, the current vehicle speed V0, the own vehicle acceleration / deceleration a0, the preceding vehicle speed Vf, the preceding vehicle acceleration / deceleration af, and the inter-vehicle distance L after t seconds. If the host vehicle 1 moves forward by a distance Ls, the preceding vehicle moves forward by a distance Lf to the preceding vehicle predicted position, and the inter-vehicle distance from the host vehicle 1 becomes a target inter-vehicle distance Dtgt (a distance set by a map or calculation), The target acceleration / deceleration a of the vehicle 1 is obtained from the following equation (1).
a = af + ((V0−Vf) 2 / (L−Dtgt)) (1)
Therefore, the expression (1) is defined as the first arithmetic expression in the first region.

同様に、第2の演算式とは、先行車が停止することを前提に自車両1が予め設定する車間距離で先行車に対して追従停止するための演算式であり、図6に示すような関係、すなわち、現在、自車速V0、自車加減速度a0、先行車速Vf、先行車加減速度af、車間距離Lである状態が、t秒後に、自車両1が距離Ls前進し、先行車が先行車予測位置まで距離Lf前進し、自車両1との車間距離が目標停止車間距離Dstop(一定値:例えば5m)となって停車すると仮定すると、以下の(2)式が成立する。
L+Lf=Ls+Dstop …(2)
ここで、
Lf=Vf/(2・af) …(3)
Ls=V0/(2・a0) …(4)
であるから、これら(3)式、(4)式を、上述の(2)式に代入し、a0について解き、このa0を自車両1の目標加減速度aとすると、以下の(5)式を得る。
Similarly, the second arithmetic expression is an arithmetic expression for the vehicle 1 to follow and stop the preceding vehicle at a preset inter-vehicle distance on the assumption that the preceding vehicle stops. As shown in FIG. In other words, the current vehicle speed V0, the own vehicle acceleration / deceleration a0, the preceding vehicle speed Vf, the preceding vehicle acceleration / deceleration af, and the inter-vehicle distance L, the host vehicle 1 moves forward by the distance Ls after t seconds, and the preceding vehicle If the vehicle travels a distance Lf up to the predicted position of the preceding vehicle and the distance between the vehicle 1 and the host vehicle 1 becomes the target stop distance Dstop (constant value: 5 m, for example), the following equation (2) is established.
L + Lf = Ls + Dstop (2)
here,
Lf = Vf 2 / (2 · af) (3)
Ls = V0 2 / (2 · a0) (4)
Therefore, substituting these equations (3) and (4) into the above equation (2), solving for a0, and setting this a0 as the target acceleration / deceleration a of the host vehicle 1, the following equation (5) Get.

a=(af・V0)/(Vf+2・af・(L−Dstop)) …(5)
従って、この(5)式が、第2の領域における第2の演算式として定められている。尚、上述の全ての加減速度は、減速方向の符号を正とする。
a = (af · V0 2 ) / (Vf 2 + 2 · af · (L−Dstop)) (5)
Therefore, this equation (5) is defined as the second arithmetic expression in the second region. Note that the sign of the deceleration direction is positive for all the accelerations and decelerations described above.

尚、上述の2つの領域からなる先行車加減速度af−先行車速Vfの目標加減速度演算式の領域マップは、これに限るものではなく、複数の境界により区分されるようなものであっても良い。   It should be noted that the area map of the target acceleration / deceleration equation of the preceding vehicle acceleration / deceleration af−preceding vehicle speed Vf composed of the above-described two areas is not limited to this, and may be divided by a plurality of boundaries. good.

図3のフローチャートのS201の判定の結果、演算式選択フラグFaが「1」であって、前回、第1の演算式が選択されている場合には、S202に進み、第1の領域から第2の領域に遷移するのにヒステリシス特性を持たせるため第1の領域を広げるようにS1だけ境界Tthを下方に移動させて補正設定する。例えば、図5(a)のように補正する。   As a result of the determination in S201 of the flowchart of FIG. 3, if the arithmetic expression selection flag Fa is “1” and the first arithmetic expression has been selected last time, the process proceeds to S202, and the first area is changed to the first area. In order to provide a hysteresis characteristic when transitioning to the region 2, correction is set by moving the boundary Tth downward by S1 so as to widen the first region. For example, the correction is made as shown in FIG.

逆に、S201の判定の結果、演算式選択フラグFaが「2」であって、前回、第2の演算式が選択されている場合には、S203に進み、第2の領域から第1の領域に遷移するのにヒステリシス特性を持たせるため第2の領域を広げるようにS2だけ境界Tthを上方に移動させて補正設定する。例えば、図5(b)のように補正する。ここで、ヒステリシスを設ける幅は、S1>S2であり、第1の演算式から第2の演算式への遷移の方が、第2の演算式から第1の演算式への遷移より、し難い特性に設定されている。   On the other hand, as a result of the determination in S201, if the arithmetic expression selection flag Fa is “2” and the second arithmetic expression has been selected last time, the process proceeds to S203, and the first area is selected from the second area. In order to give a hysteresis characteristic when transitioning to a region, the boundary Tth is moved upward by S2 so as to widen the second region, and correction is set. For example, the correction is made as shown in FIG. Here, the width for providing the hysteresis is S1> S2, and the transition from the first arithmetic expression to the second arithmetic expression is more effective than the transition from the second arithmetic expression to the first arithmetic expression. It is set to difficult characteristics.

S202、或いは、S203でヒステリシスを考慮した領域補正を行った後は、S204に進み、現在の先行車の走行状態(先行車加減速度af−先行車速Vf)が第1の領域内か否か判定する。   After performing region correction in consideration of hysteresis in S202 or S203, the process proceeds to S204 to determine whether or not the current traveling state of the preceding vehicle (preceding vehicle acceleration / deceleration af−preceding vehicle speed Vf) is within the first region. To do.

このS204の判定の結果、現在の先行車の走行状態(先行車加減速度af−先行車速Vf)が第1の領域内の場合は、S205に進み、第1の演算式(上述の(1)式)により目標加減速度aを演算し、S206に進んで、演算式選択フラグFaを「1」とし、ルーチンを抜ける。   As a result of the determination in S204, if the current traveling state of the preceding vehicle (preceding vehicle acceleration / deceleration af−preceding vehicle speed Vf) is within the first region, the process proceeds to S205 and the first arithmetic expression (the above-described (1) The target acceleration / deceleration a is calculated from the equation (1), the process proceeds to S206, the calculation equation selection flag Fa is set to "1", and the routine is exited.

また、S204の判定の結果、現在の先行車の走行状態(先行車加減速度af−先行車速Vf)が第2の領域内の場合は、S207に進み、第2の演算式(上述の(5)式)により目標加減速度aを演算し、S208に進んで、演算式選択フラグFaを「2」とし、ルーチンを抜ける。   If the current traveling state of the preceding vehicle (preceding vehicle acceleration / deceleration af−preceding vehicle speed Vf) is within the second region as a result of the determination in S204, the process proceeds to S207, and the second arithmetic expression ((5 )), The target acceleration / deceleration a is calculated, the process proceeds to S208, the calculation expression selection flag Fa is set to "2", and the routine is exited.

このように、本発明の実施の形態によれば、先行車の走行状態に応じて追従走行するための式を切り替えて追従走行制御(追従加減速制御)させるようになっているので、制御が連続的に行われ、円滑な制御によりドライバが自然な感覚で利用することが可能となる。また、領域の設定も、境界線がヒステリシスを考慮して設定されるため、制御がハンチングすることもなく、安定した制御が行えるようになっている。   As described above, according to the embodiment of the present invention, the following traveling control (following acceleration / deceleration control) is performed by switching the expression for following traveling according to the traveling state of the preceding vehicle. It is performed continuously and the driver can use the driver with a natural feeling through smooth control. In addition, since the boundary line is set in consideration of hysteresis, the control can be performed stably without hunting.

次に、S103にて実行される目標加減速度aの制限処理について、図4のフローチャートで説明する。   Next, the target acceleration / deceleration speed limiting process executed in S103 will be described with reference to the flowchart of FIG.

まず、S301では、自車両1が先行車に到達するまでの予測時間(接触予測時間)TTCを、例えば、以下の(6)式により演算する。
TTC=L/(V0−Vf) …(6)
First, in S301, a predicted time (contact predicted time) TTC until the host vehicle 1 reaches the preceding vehicle is calculated by, for example, the following equation (6).
TTC = L / (V0−Vf) (6)

その後、S302に進み、S301で演算した接触予測時間TTCが、予め設定しておいた時間TT1(例えば5秒)より短いか否か判定し、TT1より短い場合(TTC<TT1の場合)は、安全性を優先して、目標加減速度aの制限は実行せず、そのままルーチンを抜ける。   Thereafter, the process proceeds to S302, in which it is determined whether or not the predicted contact time TTC calculated in S301 is shorter than a preset time TT1 (for example, 5 seconds), and when it is shorter than TT1 (when TTC <TT1), Prioritizing safety, the target acceleration / deceleration a is not limited, and the routine is exited as it is.

逆に、接触予測時間TTCが、予め設定しておいた時間TT1以上の場合(TTC≧TT1の場合)は、S303に進み、以下の(7)式により、現在の自車両1の位置と先行車の位置を基に目標走行半径Rtを演算する。すなわち、図7に示す、自車両1を原点Oとする座標系において、先行車の重心位置の座標を(xt,zt)とすると、
Rt=(xt+zt)/(2・xt) …(7)
Conversely, when the predicted contact time TTC is equal to or longer than the preset time TT1 (when TTC ≧ TT1), the process proceeds to S303, and the current position of the host vehicle 1 and the preceding position are calculated by the following equation (7). A target travel radius Rt is calculated based on the position of the car. That is, in the coordinate system shown in FIG. 7 where the host vehicle 1 is the origin O, the coordinates of the center of gravity position of the preceding vehicle are (xt, zt).
Rt = (xt 2 + zt 2 ) / (2 · xt) (7)

次いで、S304へと進み、以下の(8)式により目標ヨーレートγtを演算する。
γt=V0/Rt …(8)
Next, the process proceeds to S304, and the target yaw rate γt is calculated by the following equation (8).
γt = V0 / Rt (8)

S304で目標ヨーレートγtを演算した後は、S305へと進み、以下の(9)式により、目標ヨーレートγtに基づいて第1の制限値Lmγ1を演算する。
|Lmγ1|=Lmc1−K1・|γt| …(9)
ここで、Lmγ1を絶対値としたのは、加速方向、減速方向の両方において本(9)式を適用させるためである。また、K1は定数、Lmc1は定数(例えば、0.5・g)である。そして、(9)式で演算した第1の制限値|Lmγ1|が、|Lmγ1|>Lmc2(例えば、0.3・g)の場合は、|Lmγ1|はLmc2で制限(|Lmγ1|=Lmc2)する。この制限値Lmγ1の特性は図8に示す。尚、本実施の形態では、加速方向と減速方向の制限値Lmγ1を同じ特性としているが、それぞれ異なった特性としても良い。
After calculating the target yaw rate γt in S304, the process proceeds to S305, and the first limit value Lmγ1 is calculated based on the target yaw rate γt by the following equation (9).
| Lmγ1 | = Lmc1−K1 · | γt | (9)
Here, the reason why Lmγ1 is an absolute value is to apply the formula (9) in both the acceleration direction and the deceleration direction. K1 is a constant, and Lmc1 is a constant (for example, 0.5 · g). When the first limit value | Lmγ1 | calculated by the equation (9) is | Lmγ1 |> Lmc2 (for example, 0.3 · g), | Lmγ1 | is limited by Lmc2 (| Lmγ1 | = Lmc2 ) The characteristic of the limit value Lmγ1 is shown in FIG. In the present embodiment, the limit value Lmγ1 in the acceleration direction and the deceleration direction has the same characteristic, but may have different characteristics.

次に、S306に進み、目標ヨーレートγtの単位時間あたりの変化量(γt−γtold)/Δtを演算する。ここで、Δtは単位時間(例えば、前回から今回までの時間)であり、γtoldは単位時間Δt前(例えば、前回)の目標ヨーレートである。   Next, in S306, the amount of change (γt−γtold) / Δt per unit time of the target yaw rate γt is calculated. Here, Δt is a unit time (for example, the time from the previous time to the current time), and γtold is a target yaw rate before the unit time Δt (for example, the previous time).

S306で目標ヨーレートγtの単位時間あたりの変化量(γt−γtold)/Δtを演算した後は、S307へと進み、以下の(10)式により、目標ヨーレートγtの単位時間あたりの変化量(γt−γtold)/Δtに基づいて第2の制限値Lmγ2を演算する。
|Lmγ2|=Lmc3−K2・|(γt−γtold)/Δt| …(10)
ここで、Lmγ2を絶対値としたのは、加速方向、減速方向の両方において本(10)式を適用させるためである。また、K2は定数、Lmc3は定数(例えば、0.5・g)である。そして、(10)式で演算した第2の制限値|Lmγ2|が、|Lmγ2|>Lmc4(例えば、0.3・g)の場合は、|Lmγ2|はLmc4で制限(|Lmγ2|=Lmc4)する。この第2の制限値Lmγ2の特性は、図8のLmγ1の特性図において、γtを(γt−γtold)/Δtに、Lmγ1をLmγ2に、Lmc1をLmc3に、Lmc2をLmc4に読み替えることで示される。尚、本実施の形態では、加速方向と減速方向の第2の制限値Lmγ2を同じ特性としているが、それぞれ異なった特性としても良い。
After calculating the change amount (γt−γtold) / Δt of the target yaw rate γt in S306, the process proceeds to S307, and the change amount (γt per unit time of the target yaw rate γt is calculated by the following equation (10). The second limit value Lmγ2 is calculated based on −γtold) / Δt.
| Lmγ2 | = Lmc3−K2 · | (γt−γtold) / Δt | (10)
Here, the reason why Lmγ2 is an absolute value is to apply this equation (10) in both the acceleration direction and the deceleration direction. K2 is a constant, and Lmc3 is a constant (for example, 0.5 · g). If the second limit value | Lmγ2 | calculated by the equation (10) is | Lmγ2 |> Lmc4 (for example, 0.3 · g), | Lmγ2 | is limited by Lmc4 (| Lmγ2 | = Lmc4 ) The characteristic of the second limit value Lmγ2 is shown by replacing γt with (γt−γtold) / Δt, Lmγ1 with Lmγ2, Lmc1 with Lmc3, and Lmc2 with Lmc4 in the characteristic diagram of Lmγ1 in FIG. . In the present embodiment, the second limit value Lmγ2 in the acceleration direction and the deceleration direction has the same characteristic, but may have different characteristics.

次に、S308に進み、目標ヨーレートγtと現在の実際のヨーレートγrとの偏差(ヨーレート偏差)Δγ(=γt−γr)を演算する。   Next, in S308, a deviation (yaw rate deviation) Δγ (= γt−γr) between the target yaw rate γt and the current actual yaw rate γr is calculated.

次いで、S309に進み、以下の(11)式により、ヨーレート偏差Δγに基づいて第3の制限値Lmγ3を演算する。
|Lmγ3|=Lmc5−K3・|Δγ| …(11)
ここで、Lmγ3を絶対値としたのは、加速方向、減速方向の両方において本(11)式を適用させるためである。また、K3は定数、Lmc5は定数(例えば、0.5・g)である。そして、(11)式で演算した第3の制限値|Lmγ3|が、|Lmγ3|>Lmc6(例えば、0.3・g)の場合は、|Lmγ3|はLmc6で制限(|Lmγ3|=Lmc6)する。この第3の制限値Lmγ3の特性は、図8のLmγ1の特性図において、γtをΔγに、Lmγ1をLmγ3に、Lmc1をLmc5に、Lmc2をLmc6に読み替えることで示される。尚、本実施の形態では、加速方向と減速方向の第3の制限値Lmγ3を同じ特性としているが、それぞれ異なった特性としても良い。
Next, in S309, the third limit value Lmγ3 is calculated based on the yaw rate deviation Δγ according to the following equation (11).
| Lmγ3 | = Lmc5−K3 · | Δγ | (11)
Here, the reason why Lmγ3 is set to an absolute value is to apply this equation (11) in both the acceleration direction and the deceleration direction. K3 is a constant, and Lmc5 is a constant (for example, 0.5 · g). When the third limit value | Lmγ3 | calculated by the expression (11) is | Lmγ3 |> Lmc6 (for example, 0.3 · g), | Lmγ3 | is limited by Lmc6 (| Lmγ3 | = Lmc6). ) The characteristic of the third limit value Lmγ3 is shown by replacing γt with Δγ, Lmγ1 with Lmγ3, Lmc1 with Lmc5, and Lmc2 with Lmc6 in the characteristic diagram of Lmγ1 in FIG. In the present embodiment, the third limit value Lmγ3 in the acceleration direction and the deceleration direction has the same characteristics, but may have different characteristics.

次いで、S310に進み、第1,第2,第3の制限値の絶対値の最小のものを制限値Lmに設定し、S311に進んで、S102で演算した目標加減速度aを制限値Lmで制限、すなわち、目標加減速度の絶対値|a|が制限値の絶対値|Lm|以上となる場合には、目標加減速度の絶対値|a|を制限値の絶対値|Lm|として制限し、ルーチンを抜ける。   Next, the process proceeds to S310, the smallest absolute value of the first, second, and third limit values is set to the limit value Lm. The process proceeds to S311 and the target acceleration / deceleration a calculated in S102 is set to the limit value Lm. When the absolute value | a | of the target acceleration / deceleration is equal to or larger than the absolute value | Lm | of the limit value, the absolute value | a | of the target acceleration / deceleration is limited as the absolute value | Lm | , Exit the routine.

すなわち、例えば、図9に示すような、直進路からカーブ走行に移行する場合には、目標ヨーレートγtは、図10(a)に示すように、先行車がカーブに差し掛かった状況では略0であり、このときに演算される第1の制限値の絶対値|Lmγ1|は、大きな値をとる。また、図10(c)に示すように、ヨーレート偏差Δγも、先行車がカーブに差し掛かった状況では、小さいままであり、やはり、第3の制限値の絶対値|Lmγ3|は、大きな値をとる。このような状況では、図10(b)に示すように、目標ヨーレートγtの単位時間あたりの変化量の絶対値|(γt−γtold)/Δt|が先行車の挙動に応じて最も大きく変化して、第2の制限値の絶対値|Lmγ2|を小さくすることができる。そして、第1,第2,第3の制限値の絶対値の最小のものを制限値Lmに設定し、第2の制限値の絶対値|Lmγ2|を制限値Lmとすることにより(図10(c)参照)、直進路からカーブ走行に移行する際の追従制御をスムーズなものとし、違和感の無い快適な制御が行えるようになっている。更に、上述の直進路からカーブ走行に移行する場合以外の、例えば、複数のカーブが連続する場合においても、同様に、第1,第2,第3の制限値の絶対値の最小のものを制限値Lmに設定し、この制限値Lmで目標加減速度の絶対値aを制限することにより、直進状態からカーブ走行に至るまで、たとえ、これら走行路の過渡状態における走行状況においても、車両の加減速度を適切に抑制し、先行車追従に際して円滑で違和感の無い快適な制御が行えるようになっている。   That is, for example, as shown in FIG. 9, when the vehicle moves from a straight path to a curve, the target yaw rate γt is substantially 0 in the situation where the preceding vehicle has reached the curve as shown in FIG. Yes, the absolute value | Lmγ1 | of the first limit value calculated at this time takes a large value. Further, as shown in FIG. 10C, the yaw rate deviation Δγ also remains small in the situation where the preceding vehicle has reached the curve, and the absolute value | Lmγ3 | of the third limit value is still a large value. Take. In such a situation, as shown in FIG. 10 (b), the absolute value | (γt−γtold) / Δt | of the change amount per unit time of the target yaw rate γt changes most greatly according to the behavior of the preceding vehicle. Thus, the absolute value | Lmγ2 | of the second limit value can be reduced. Then, the smallest absolute value of the first, second and third limit values is set as the limit value Lm, and the absolute value | Lmγ2 | of the second limit value is set as the limit value Lm (FIG. 10). (See (c)), the follow-up control at the time of transition from the straight road to the curve travel is made smooth, and comfortable control without a sense of incongruity can be performed. Further, in the case where, for example, a plurality of curves are continuous other than the case where the vehicle travels from the straight road to the curve, the minimum absolute value of the first, second and third limit values is similarly set. By setting the limit value Lm and limiting the absolute value a of the target acceleration / deceleration with the limit value Lm, from the straight traveling state to the curve traveling, even in the traveling state in the transient state of these traveling paths, The acceleration / deceleration is appropriately suppressed, and smooth and comfortable control can be performed when following the preceding vehicle.

また、第1,第2,第3の制限値を演算する際に用いる目標ヨーレートγtは、自車速V0と自車両1に対する先行車の相対位置とに基づき自車両1が先行車に追従するのに必要な値として演算されるものであるため、現在の車両挙動のみならず、今後予想される車両挙動をも考慮して車両の加減速度を適切に抑制されるので、先行車追従に際して円滑で違和感の無い快適な制御が可能となる。   Further, the target yaw rate γt used when calculating the first, second, and third limit values is determined so that the own vehicle 1 follows the preceding vehicle based on the own vehicle speed V0 and the relative position of the preceding vehicle with respect to the own vehicle 1. Therefore, the acceleration / deceleration of the vehicle is appropriately suppressed in consideration of not only the current vehicle behavior but also the expected vehicle behavior in the future. Comfortable control without discomfort is possible.

更に、本実施の形態における制限値Lmの演算は、(9)式、(10)式、(11)式のように単純な一次関数により演算されるので、複雑なアルゴリズムを必要とせず、高速に設定でき、レスポンスに優れた制御が可能となる。   Further, the calculation of the limit value Lm in the present embodiment is performed by a simple linear function as in the formulas (9), (10), and (11), so that a complicated algorithm is not required and high speed is achieved. The control with excellent response is possible.

尚、本実施の形態では、第1,第2,第3の3つの制限値を用いて制限値Lmを設定するようにしているか、車両によっては、第1,第2,第3の何れか一つの制限値のみ用いて制限するようにしても良く、或いは、第1,第2,第3の何れか2つの制限値を用いて制限値Lmを設定するようにしても良い。   In the present embodiment, the limit value Lm is set using the first, second, and third limit values, or depending on the vehicle, either the first, second, or third is set. The limit value Lm may be set using only one limit value, or the limit value Lm may be set using any one of the first, second, and third limit values.

また、本実施の形態では、目標パラメータとして目標ヨーレートγtを用いる例を示したが、目標ヨーレートγt以外に、目標ステアリング角St(=(Lw・Ns)/Rt:Lwはホイールベース、Nsはステアリングギヤ比)や目標曲率ρt(=1/γt)を用いるものであっても良い。   In the present embodiment, the target yaw rate γt is used as the target parameter. However, in addition to the target yaw rate γt, the target steering angle St (= (Lw · Ns) / Rt: Lw is the wheel base, and Ns is the steering. Gear ratio) or target curvature ρt (= 1 / γt) may be used.

目標パラメータとして目標ステアリング角Stを用いる場合、上述の(9)式、(10)式、(11)式に対応した第1,第2,第3の制限値Lms1,Lms2,Lms3は、それぞれ以下の(12)式、(13)式、(14)式により演算される。   When the target steering angle St is used as the target parameter, the first, second, and third limit values Lms1, Lms2, and Lms3 corresponding to the above formulas (9), (10), and (11) are as follows. (12), (13), and (14).

|Lms1|=Lmc11−K11・|St| …(12)
|Lms2|=Lmc13−K12・|(St−Stold)/Δt| …(13)
|Lms3|=Lmc15−K13・|ΔS| …(14)
ここで、Stoldは単位時間Δt前(例えば、前回)の目標ステアリング角、ΔSは目標ステアリング角Stと現在の実際のステアリング角Srとの偏差(ステアリング角偏差)(=St−Sr)、K11、K12、K13は定数、Lmc11、Lmc13、Lmc15は、例えば、0.5・g等の定数である。そして、前述の(9)式、(10)式、(11)式と同様に、(12)式で演算した第1の制限値|Lms1|が、|Lms1|>Lmc12(例えば、0.3・g)の場合は、|Lms1|はLmc12で制限(|Lms1|=Lmc12)し、(13)式で演算した第2の制限値|Lms2|が、|Lms2|>Lmc14(例えば、0.3・g)の場合は、|Lms2|はLmc14で制限(|Lms2|=Lmc14)し、(14)式で演算した第3の制限値|Lms3|が、|Lms3|>Lmc16(例えば、0.3・g)の場合は、|Lms3|はLmc16で制限(|Lms3|=Lmc16)する。
| Lms1 | = Lmc11−K11 · | St | (12)
| Lms2 | = Lmc13−K12 · | (St−Stold) / Δt | (13)
| Lms3 | = Lmc15−K13 · | ΔS | (14)
Here, Stold is a target steering angle before unit time Δt (for example, last time), ΔS is a deviation (steering angle deviation) (= St−Sr) between target steering angle St and the current actual steering angle Sr, K11, K12 and K13 are constants, and Lmc11, Lmc13, and Lmc15 are constants such as 0.5 · g, for example. Similarly to the above-described equations (9), (10), and (11), the first limit value | Lms1 | calculated by the equation (12) is | Lms1 |> Lmc12 (for example, 0.3 In the case of g), | Lms1 | is limited by Lmc12 (| Lms1 | = Lmc12), and the second limit value | Lms2 | calculated by the equation (13) is | Lms2 |> Lmc14 (for example, 0. 3 · g), | Lms2 | is limited by Lmc14 (| Lms2 | = Lmc14), and the third limit value | Lms3 | calculated by the equation (14) is | Lms3 |> Lmc16 (for example, 0 .3 · g), | Lms3 | is limited by Lmc16 (| Lms3 | = Lmc16).

また、目標パラメータとして目標曲率ρtを用いる場合、上述の(9)式、(10)式、(11)式に対応した第1,第2,第3の制限値Lmρ1,Lmρ2,Lmρ3は、それぞれ以下の(15)式、(16)式、(17)式により演算される。   When the target curvature ρt is used as the target parameter, the first, second, and third limit values Lmρ1, Lmρ2, and Lmρ3 corresponding to the equations (9), (10), and (11) are respectively Calculation is performed by the following equations (15), (16), and (17).

|Lmρ1|=Lmc21−K21・|ρt| …(15)
|Lmρ2|=Lmc23−K22・|(ρt−ρtold)/Δt| …(16)
|Lmρ3|=Lmc25−K23・|Δρ| …(17)
ここで、ρtoldは単位時間Δt前(例えば、前回)の目標曲率、Δρは目標曲率ρtと現在の実際の曲率との偏差(曲率偏差)(=ρt−ρ)、K21、K22、K23は定数、Lmc21、Lmc23、Lmc25は、例えば、0.5・g等の定数である。そして、前述の(9)式、(10)式、(11)式と同様に、(15)式で演算した第1の制限値|Lmρ1|が、|Lmρ1|>Lmc22(例えば、0.3・g)の場合は、|Lmρ1|はLmc22で制限(|Lmρ1|=Lmc22)し、(16)式で演算した第2の制限値|Lmρ2|が、|Lmρ2|>Lmc24(例えば、0.3・g)の場合は、|Lmρ2|はLmc24で制限(|Lmρ2|=Lmc24)し、(17)式で演算した第3の制限値|Lmρ3|が、|Lmρ3|>Lmc26(例えば、0.3・g)の場合は、|Lmρ3|はLmc26で制限(|Lmρ3|=Lmc26)する。
| Lmρ1 | = Lmc21−K21 · | ρt | (15)
| Lmρ2 | = Lmc23−K22 · | (ρt−ρtold) / Δt | (16)
| Lmρ3 | = Lmc25−K23 · | Δρ | (17)
Here, ρtold is the target curvature before the unit time Δt (for example, the previous time), Δρ is the deviation (curvature deviation) between the target curvature ρt and the current actual curvature (= ρt−ρ), and K21, K22, and K23 are constants. , Lmc21, Lmc23, and Lmc25 are constants such as 0.5 · g, for example. Similarly to the above-described equations (9), (10), and (11), the first limit value | Lmρ1 | calculated by the equation (15) is | Lmρ1 |> Lmc22 (for example, 0.3 In the case of g), | Lmρ1 | is limited by Lmc22 (| Lmρ1 | = Lmc22), and the second limit value | Lmρ2 | calculated by the equation (16) is | Lmρ2 |> Lmc24 (for example, 0. 3 · g), | Lmρ2 | is limited by Lmc24 (| Lmρ2 | = Lmc24), and the third limit value | Lmρ3 | calculated by Equation (17) is | Lmρ3 |> Lmc26 (for example, 0 .3 · g), | Lmρ3 | is limited by Lmc26 (| Lmρ3 | = Lmc26).

また、本実施の形態では、目標加減速度aを、予め設定した2つの領域からなる先行車加減速度af−先行車速Vfの目標加減速度演算式の領域マップから演算式を選択して演算するようになっているが、他の方法で求めるものであっても本発明が適用できることは云うまでもない。例えば、目標車間時間を自車速V0に基づいて演算設定し、先行車との車間距離Lと先行車速Vfと自車速V0と目標車間時間とに基づき目標加減速度aを演算するもの等にも適用できる。   Further, in the present embodiment, the target acceleration / deceleration a is calculated by selecting an arithmetic expression from the area map of the target acceleration / deceleration calculation expression of preceding vehicle acceleration / deceleration af−preceding vehicle speed Vf, which consists of two preset areas. However, it goes without saying that the present invention can be applied even if it is obtained by other methods. For example, the target inter-vehicle time is calculated and set based on the own vehicle speed V0, and the target acceleration / deceleration a is calculated based on the inter-vehicle distance L, the preceding vehicle speed Vf, the own vehicle speed V0, and the target inter-vehicle time. it can.

また、本実施の形態では、先行車の認識をステレオカメラからの画像を基に行うようになっているが、他の技術、例えば、ミリ波レーダと単眼カメラからの情報を基に認識するものであっても良い。   In the present embodiment, the preceding vehicle is recognized based on the image from the stereo camera. However, other technologies, for example, those that recognize based on information from the millimeter wave radar and the monocular camera are used. It may be.

車両に搭載した運転支援装置の概略構成図Schematic configuration diagram of a driving support device mounted on a vehicle 追従加減速制御プログラムのフローチャートFlow chart of following acceleration / deceleration control program 目標加減速度a演算処理ルーチンのフローチャートFlow chart of target acceleration / deceleration a calculation processing routine 目標加減速度a制限処理ルーチンのフローチャートFlow chart of target acceleration / deceleration a limit processing routine 先行車加減速度−先行車速の目標加減速度演算式の領域マップの説明図Explanatory diagram of the area map of the target vehicle acceleration / deceleration formula for the preceding vehicle acceleration / deceleration-preceding vehicle speed 目標加減速度演算式において用いるパラメータの説明図Explanatory diagram of parameters used in the target acceleration / deceleration formula 自車両と先行車の座標位置と関係を示す説明図Explanatory diagram showing the relationship between the coordinate position of the host vehicle and the preceding vehicle 制限値の一例を示す説明図Explanatory drawing showing an example of the limit value 直進路からカーブ走行に移行する一例の説明図An explanatory diagram of an example of transition from a straight road to a curve run 図9に示す走行路を走行する際に設定される制限値の一例を示すタイムチャートFIG. 9 is a time chart showing an example of limit values set when traveling on the travel path shown in FIG.

符号の説明Explanation of symbols

1 自車両
2 ACCシステム(運転支援装置)
3 ステレオカメラ(先行車情報検出手段)
4 ステレオ画像認識装置(先行車情報検出手段)
5 制御ユニット(目標加減速度演算手段、目標加減速度制限手段)
6 車速センサ(自車走行情報検出手段)
10 スロットル弁制御装置
11 スロットル弁
12 自動ブレーキ制御装置
1 Vehicle 2 ACC system (driving support device)
3 Stereo camera (preceding vehicle information detection means)
4 Stereo image recognition device (preceding vehicle information detection means)
5 Control unit (target acceleration / deceleration calculation means, target acceleration / deceleration limit means)
6 Vehicle speed sensor (own vehicle travel information detection means)
10 Throttle valve control device 11 Throttle valve 12 Automatic brake control device

Claims (3)

自車両の走行情報を検出する自車走行情報検出手段と、
先行車を認識し、この先行車情報を検出する先行車情報検出手段と、
上記自車両の走行情報と上記先行車情報とに基づき上記自車両が上記先行車に追従走行を実行するのに必要な目標加減速度を演算する目標加減速度演算手段と、
上記自車両の走行情報と上記先行車情報とに基づき上記自車両が上記先行車に追従するのに必要な目標パラメータを推定し、該目標パラメータに応じて演算した上記目標加減速度を制限する第1の制限値と、上記目標パラメータの単位時間あたりの変化量に応じて演算した上記目標加減速度を制限する第2の制限値と、上記目標パラメータと現在の実際のパラメータの値との差分に応じて演算した上記目標加減速度を制限する第3の制限値の少なくとも一つの制限値により、上記目標加減速度を制限する目標加減速度制限手段とを備え
上記目標加減速度制限手段は、上記第1の制限値と上記第2の制限値と上記第3の制限値の何れか2つの制限値、或いは、これら3つの制限値により上記目標加減速度を制限する場合、上記複数の制限値の中で絶対値の最も小さな制限値を用いて上記目標加減速度を制限することを特徴とする車両の運転支援装置。
Own vehicle running information detecting means for detecting running information of the own vehicle;
A preceding vehicle information detecting means for recognizing the preceding vehicle and detecting the preceding vehicle information;
Target acceleration / deceleration calculating means for calculating a target acceleration / deceleration necessary for the host vehicle to follow the preceding vehicle based on the traveling information of the host vehicle and the preceding vehicle information;
Based on the travel information of the host vehicle and the preceding vehicle information, a target parameter necessary for the host vehicle to follow the preceding vehicle is estimated, and the target acceleration / deceleration calculated according to the target parameter is limited. The difference between the limit value of 1 and the second limit value for limiting the target acceleration / deceleration calculated according to the change amount per unit time of the target parameter, and the value of the target parameter and the current actual parameter by at least one limit value of the third limit value for limiting the target acceleration which is calculated in accordance with, and a target acceleration limiting means for limiting the target acceleration,
The target acceleration / deceleration limiting means limits the target acceleration / deceleration by any two of the first limit value, the second limit value, and the third limit value, or by these three limit values. In this case, the vehicle driving support apparatus limits the target acceleration / deceleration using a limit value having the smallest absolute value among the plurality of limit values .
上記目標パラメータは、上記自車両の走行情報と上記先行車情報とに基づき算出した自車両の目標ヨーレートと目標ステアリング角と目標曲率の少なくとも一つであることを特徴とする請求項1記載の車両の運転支援装置。 2. The vehicle according to claim 1 , wherein the target parameter is at least one of a target yaw rate, a target steering angle, and a target curvature of the host vehicle calculated based on the traveling information of the host vehicle and the preceding vehicle information. Driving assistance device. 上記目標加減速度制限手段は、上記自車両が上記先行車に到達するまでの予測時間が予め設定しておいた値より短い場合は、上記目標加減速度の制限を行わないことを特徴とする請求項1又は請求項2記載の車両の運転支援装置。 The target acceleration / deceleration limiting means does not limit the target acceleration / deceleration when the predicted time until the host vehicle reaches the preceding vehicle is shorter than a preset value. The driving support device for a vehicle according to claim 1 or 2.
JP2007027258A 2007-02-06 2007-02-06 Vehicle driving support device Expired - Fee Related JP5054389B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007027258A JP5054389B2 (en) 2007-02-06 2007-02-06 Vehicle driving support device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007027258A JP5054389B2 (en) 2007-02-06 2007-02-06 Vehicle driving support device

Publications (2)

Publication Number Publication Date
JP2008189199A JP2008189199A (en) 2008-08-21
JP5054389B2 true JP5054389B2 (en) 2012-10-24

Family

ID=39749711

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007027258A Expired - Fee Related JP5054389B2 (en) 2007-02-06 2007-02-06 Vehicle driving support device

Country Status (1)

Country Link
JP (1) JP5054389B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20160297438A1 (en) * 2015-04-13 2016-10-13 Mando Corporation Active cruise control system in vehicle and method thereof

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3842036B2 (en) * 2000-12-04 2006-11-08 三菱電機株式会社 Vehicle travel control device
JP2003048461A (en) * 2001-08-06 2003-02-18 Denso Corp Vehicle integrated control system and recording medium
JP3758586B2 (en) * 2002-02-27 2006-03-22 日産自動車株式会社 Vehicle travel control device
JP3781011B2 (en) * 2003-03-06 2006-05-31 日産自動車株式会社 Travel speed control device
JP2005263099A (en) * 2004-03-19 2005-09-29 Mitsubishi Fuso Truck & Bus Corp Automatic cruise control device
JP3925540B2 (en) * 2005-03-23 2007-06-06 トヨタ自動車株式会社 Vehicle travel control device

Also Published As

Publication number Publication date
JP2008189199A (en) 2008-08-21

Similar Documents

Publication Publication Date Title
JP4781707B2 (en) Vehicle driving support device
US7925415B2 (en) Vehicle drive assist system
US10093316B2 (en) Vehicle traveling control device
JP4970156B2 (en) Vehicle driving support device
JPWO2017141765A1 (en) Vehicle control device, vehicle control method, and vehicle control program
JP2006188155A (en) Vehicular driving support system
JP6680403B2 (en) Target vehicle speed generation method and target vehicle speed generation device for driving support vehicle
JP2013014202A (en) Vehicle motion control system
JP2007153080A (en) Following travel controller for vehicle
JP2007091025A (en) Forward monitoring device for vehicle
JP2009286279A (en) Drive support device for vehicle
JP2012224316A (en) Drive control device
JP4980030B2 (en) Vehicle travel control device
JP2004106697A (en) Vehicle external monitor and traveling control device with the same
JP5042496B2 (en) Driving assistance device
JP2019217846A (en) Vehicle control device, vehicle control method, and program
US20210061356A1 (en) Vehicle control device
JP2006298059A (en) Traveling control device of vehicle
JP2008030539A (en) Operation support device of vehicle
JP2017052412A (en) Driving support device, and driving support method
JP2006143009A (en) Driving assisting device for vehicle
JP2011207426A (en) Driving support apparatus for vehicle
JP5054389B2 (en) Vehicle driving support device
JP5054547B2 (en) Vehicle driving support device
JP2007076472A (en) Operation support device for vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20100127

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20111227

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20111227

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120209

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20120417

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20120621

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20120628

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: 20120724

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20120727

R150 Certificate of patent or registration of utility model

Ref document number: 5054389

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20150803

Year of fee payment: 3

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees