JP2013203340A - Drive assisting system of vehicle - Google Patents
Drive assisting system of vehicle Download PDFInfo
- Publication number
- JP2013203340A JP2013203340A JP2012077041A JP2012077041A JP2013203340A JP 2013203340 A JP2013203340 A JP 2013203340A JP 2012077041 A JP2012077041 A JP 2012077041A JP 2012077041 A JP2012077041 A JP 2012077041A JP 2013203340 A JP2013203340 A JP 2013203340A
- Authority
- JP
- Japan
- Prior art keywords
- white line
- vehicle
- preceding vehicle
- control
- recognized
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 claims description 61
- 238000011156 evaluation Methods 0.000 description 9
- 230000001133 acceleration Effects 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 101100084409 Caenorhabditis elegans pfn-1 gene Proteins 0.000 description 1
- 101100353414 Caenorhabditis elegans pfn-2 gene Proteins 0.000 description 1
- 101100191514 Caenorhabditis elegans pfn-3 gene Proteins 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Power Steering Mechanism (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
本発明は、認識した白線や先行車に基づいて適切に走行するように操舵角を設定する車両の運転支援装置に関する。 The present invention relates to a driving support apparatus for a vehicle that sets a steering angle so as to travel appropriately based on a recognized white line or a preceding vehicle.
近年、車両においては、エレクトロニクス技術の発展に伴い、様々な運転支援装置が開発され、実用化されている。このような運転支援装置として、車両に搭載したカメラにより、白線や先行車を認識して自車進行路を設定し、これに基づいて操舵力を所定に付加したり、或いは、自動操舵してドライバの運転負荷の軽減を行うものがある。例えば、特開2005−332192号公報(以下、特許文献1)では、走行目標点を設定し、この走行目標点上を通るように目標走行軌跡を決定し、この目標走行軌跡上を車両が走行した場合における目標ヨーレートに、実ヨーレートが一致するように操舵制御を行う操舵支援装置において、先行車が遠くにいる場合には、走行路がよく見えるため走行路情報から得られる走行路注視点とし、近くにいる場合には、走行路は見えない領域が多いため、先行車位置を先行車注視点とし、選択された注視点に基づいて目標走行軌跡を設定する技術が開示されている。 In recent years, various driving support devices have been developed and put to practical use in vehicles with the development of electronics technology. As such a driving support device, a camera mounted on a vehicle recognizes a white line or a preceding vehicle and sets a traveling path of the own vehicle, and based on this, a steering force is added to the predetermined or automatic steering is performed. Some reduce the driving load on the driver. For example, in JP-A-2005-332192 (hereinafter referred to as Patent Document 1), a travel target point is set, a target travel locus is determined so as to pass over the travel target point, and the vehicle travels on the target travel locus. In a steering assist device that performs steering control so that the actual yaw rate matches the target yaw rate in this case, the driving road can be seen well when the preceding vehicle is far away, so the driving road gaze point obtained from the driving road information is used. Since there are many areas in which the travel path is not visible when the vehicle is nearby, a technique for setting the target travel locus based on the selected vehicle gazing point with the preceding vehicle position as the preceding vehicle gazing point is disclosed.
しかしながら、上述の特許文献1に開示される運転支援装置の技術では、たとえ先行車との車間距離が長くても、白線が欠損した場合などにおいては制御が行えなくなる虞がある。すなわち、実際の交通環境では、常に白線が適切に描かれている道路だけでは無く、タイヤに踏まれ白線が欠損、見え難くなった路面や、交差点等で白線が途切れた場合、さらには、悪天候により路面状態が悪く、安定した白線認識を行えない場合等、様々な環境が存在する。このため、上述の特許文献1に開示されるような従来から存在する白線情報と先行車情報で行う運転支援制御では、装置の動作範囲が限られて非常に使い難いものとなってしまうという課題がある。
However, with the technology of the driving assistance device disclosed in
本発明は上記事情に鑑みてなされたもので、得られる情報を最大限に活用して実際の多種多様な道路環境において稼働範囲が広く使い勝手の良い車両の運転支援装置を提供することを目的としている。 SUMMARY OF THE INVENTION The present invention has been made in view of the above circumstances, and an object thereof is to provide a vehicle driving support device that has a wide operating range and is easy to use in a wide variety of actual road environments by making maximum use of the obtained information. Yes.
本発明の車両の運転支援装置の一態様は、前方の左右白線と先行車を認識する前方環境認識手段と、操舵角をドライバ入力と独立して設定自在な操舵制御手段とを備えた車両の運転支援装置において、上記操舵制御手段は、上記前方環境認識手段で認識した左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードフォワード出力値として演算するフィードフォワード制御手段と、自車両の予測される走行位置を基準とした上記前方環境認識手段で認識した左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードバック出力値として演算するフィードバック制御手段の少なくとも一方を有し、上記フィードフォワード出力値の演算における各演算項の重み付けと上記フィードバック出力値の演算における各演算項の重み付けの少なくとも一方を決定する制御ゲインを左右白線の認識状態と先行車の認識状態に応じて可変設定する制御ゲイン設定手段を備えた。 One aspect of the vehicle driving support device of the present invention is a vehicle equipped with a front environment recognition means for recognizing a front left / right white line and a preceding vehicle, and a steering control means for setting a steering angle independently of a driver input. In the driving support device, the steering control means includes a feedforward control means for calculating, as a feedforward output value, an output value corresponding to the recognized shape of the left and right white lines recognized by the forward environment recognition means and the traveling locus of the preceding vehicle, At least one of feedback control means for calculating, as a feedback output value, an output value corresponding to the recognized shape of the left and right white lines recognized by the front environment recognition means based on the predicted traveling position of the vehicle and the traveling locus of the preceding vehicle. The weighting of each calculation term in the calculation of the feedforward output value and the weighting of each calculation term in the calculation of the feedback output value With the control gain setting means for variably set in accordance with the control gain for determining at least one of the recognition state of the detection mode and the preceding vehicle in the left and right white lines.
本発明による車両の運転支援装置によれば、得られる情報を最大限に活用して実際の多種多様な道路環境において稼働範囲が広く使い勝手が良いという優れた効果を奏する。 According to the vehicle driving support device of the present invention, the obtained information is utilized to the maximum, and an excellent effect is achieved that the operating range is wide and easy to use in a wide variety of actual road environments.
以下、図面に基づいて本発明の実施の形態を説明する。
図1において、符号1は操舵角をドライバ入力と独立して設定自在な電動パワーステアリング装置を示し、この電動パワーステアリング装置1は、ステアリング軸2が、図示しない車体フレームにステアリングコラム3を介して回動自在に支持されており、その一端が運転席側へ延出され、他端がエンジンルーム側へ延出されている。ステアリング軸2の運転席側端部には、ステアリングホイール4が固設され、また、エンジンルーム側へ延出する端部には、ピニオン軸5が連設されている。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
In FIG. 1,
エンジンルームには、車幅方向へ延出するステアリングギヤボックス6が配設されており、このステアリングギヤボックス6にラック軸7が往復移動自在に挿通支持されている。このラック軸7に形成されたラック(図示せず)に、ピニオン軸5に形成されたピニオンが噛合されて、ラックアンドピニオン式のステアリングギヤ機構が形成されている。
A
また、ラック軸7の左右両端はステアリングギヤボックス6の端部から各々突出されており、その端部に、タイロッド8を介してフロントナックル9が連設されている。このフロントナックル9は、操舵輪としての左右輪10L,10Rを回動自在に支持すると共に、キングピン(図示せず)を介して車体フレームに転舵自在に支持されている。従って、ステアリングホイール4を操作し、ステアリング軸2、ピニオン軸5を回転させると、このピニオン軸5の回転によりラック軸7が左右方向へ移動し、その移動によりフロントナックル9がキングピン(図示せず)を中心に回動して、左右輪10L,10Rが左右方向へ転舵される。
The left and right ends of the rack shaft 7 protrude from the end of the
また、ピニオン軸5にアシスト伝達機構11を介して、電動モータ12が連設されており、この電動モータ12にてステアリングホイール4に加える操舵トルクのアシスト、及び、設定された操舵角となるような操舵トルクの付加が行われる。電動モータ12は、後述する操舵制御部20で設定する操舵トルク(制御量)Tiとなるようにモータ駆動部21を介して駆動される。尚、操舵制御部20は、このように操舵トルクのアシスト機能も備えているが、本実施の形態では、操舵トルクのアシスト機能については説明を省略する。
Further, an
操舵制御部20には、前方の左右白線と先行車を認識する前方環境認識手段としての前方認識装置31、車速Vを検出する車速センサ32、ヨーレート(dθ/dt)を検出するヨーレートセンサ33、横加速度Gyを検出する横加速度センサ34が接続されている。
The
前方認識装置31は、例えば、車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像する1組のCCDカメラと、このCCDカメラからの画像データを処理するステレオ画像処理装置とから構成されている。
The
前方認識装置31のステレオ画像処理装置における、CCDカメラからの画像データの処理は、例えば以下のように行われる。まず、CCDカメラで撮像した自車両の進行方向の1組のステレオ画像対に対し、対応する位置のずれ量から距離情報を求め、距離画像を生成する。
The processing of image data from the CCD camera in the stereo image processing device of the
白線データの認識では、白線は道路面と比較して高輝度であるという知得に基づき、道路の幅方向の輝度変化を評価して、画像平面における左右の白線の位置を画像平面上で特定する。この白線の実空間上の位置(x,y,z)は、画像平面上の位置(i,j)とこの位置に関して算出された視差とに基づいて、すなわち、距離情報に基づいて、周知の座標変換式より算出される。自車両の位置を基準に設定された実空間の座標系は、本実施の形態では、例えば、図15に示すように、ステレオカメラの中央真下の道路面を原点として、車幅方向をx軸、車高方向をy軸、車長方向(距離方向)をz軸とする。このとき、x−z平面(y=0)は、道路が平坦な場合、道路面と一致する。道路モデルは、道路上の自車両の走行レーンを距離方向に複数区間に分割し、各区間における左右の白線を所定に近似して連結することによって表現される。 In recognition of white line data, based on the knowledge that the white line is brighter than the road surface, the brightness change in the width direction of the road is evaluated, and the positions of the left and right white lines on the image plane are specified on the image plane. To do. The position (x, y, z) of the white line in the real space is known based on the position (i, j) on the image plane and the parallax calculated with respect to this position, that is, based on the distance information. Calculated from the coordinate conversion formula. In the present embodiment, the coordinate system of the real space set based on the position of the host vehicle is, for example, as shown in FIG. 15, with the road surface directly below the center of the stereo camera as the origin and the vehicle width direction as the x axis. The vehicle height direction is the y-axis, and the vehicle length direction (distance direction) is the z-axis. At this time, the xz plane (y = 0) coincides with the road surface when the road is flat. The road model is expressed by dividing the traveling lane of the host vehicle on the road into a plurality of sections in the distance direction, and connecting the left and right white lines in each section with a predetermined approximation.
また、側壁や立体物データの認識では、予め記憶しておいた3次元的な側壁データ、立体物データ等の枠(ウインドウ)と比較し、道路に沿って存在するガードレール、縁石等の側壁データを抽出すると共に、立体物を、車両、歩行者、電柱等その他の立体物に分類して抽出する。立体物データにおいては、それぞれの自車両との距離(相対距離)の時間的変化の割合から自車両との相対速度が演算され、また、この相対速度と自車速Vとを加算することにより、各々の立体物の速度も算出される。この際、特に、車両として分類された立体物は、その速度から、自車両の前方方向を正として、速度が略0の車両は停止車両、速度が正(自車両と同じ方向に進む車両)で自車両に最も近い車両は先行車、速度が負の車両(自車両に向かってくる車両)は対向車として分類して認識される。また、先行車として認識された車両に関しては、特に、ターンシグナルスイッチのON−OFF、車幅寸法のデータも取得される。こうして得られた各情報、すなわち、白線データ、道路に沿って存在するガードレール、縁石等の側壁データ、及び、立体物データ(種別、距離、速度、自車両との相対速度、先行車情報等)の各データは操舵制御部20に入力される。
In recognition of side wall and three-dimensional object data, side wall data such as guardrails and curbs that exist along the road are compared with prestored frames (windows) such as three-dimensional side wall data and three-dimensional object data. And the three-dimensional object is classified and extracted into other three-dimensional objects such as vehicles, pedestrians, and utility poles. In the three-dimensional object data, the relative speed with the own vehicle is calculated from the ratio of the temporal change in the distance (relative distance) to each own vehicle, and by adding the relative speed and the own vehicle speed V, The speed of each three-dimensional object is also calculated. At this time, in particular, the three-dimensional object classified as a vehicle has a forward direction of the own vehicle as positive from the speed, a vehicle having a speed of approximately 0 is a stopped vehicle, and a speed is positive (a vehicle traveling in the same direction as the own vehicle). Thus, the vehicle closest to the host vehicle is recognized as a preceding vehicle, and the vehicle having a negative speed (vehicle coming toward the host vehicle) is recognized as an oncoming vehicle. In addition, regarding the vehicle recognized as the preceding vehicle, in particular, turn signal switch ON / OFF and vehicle width dimension data are also acquired. Each information obtained in this way, ie, white line data, guardrails along the road, side walls such as curbs, and three-dimensional object data (type, distance, speed, relative speed with the host vehicle, preceding vehicle information, etc.) These data are input to the
そして、操舵制御部20は、上述の各入力信号を基に、左右白線の認識状態と先行車の認識状態に応じて制御ゲインを可変設定し、この可変設定された制御ゲインを用いて、前方認識装置31で認識した左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードフォワード出力値Iffとして演算し、自車両の予測される走行位置を基準とした前方認識装置31で認識した左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードバック出力値Ifbとして演算し、これらを加算した値をトルク値に換算して操舵トルク(制御量)Tiとしてモータ駆動部21に出力する。
The
このため、操舵制御部20は、操舵制御手段として、図2に示すように、制御ゲイン設定制御部20a、フィードフォワード制御部20b、フィードバック制御部20c、操舵トルク算出部20dから主要に構成されている。
Therefore, as shown in FIG. 2, the
制御ゲイン設定制御部20aは、前方認識装置31から認識された画像情報が入力され、車速センサ32から車速Vが入力され、ヨーレートセンサ33からヨーレート(dθ/dt)が入力される。そして、後述の図4〜図12に示すフローチャートに従って、各制御ゲインGff1、Gff2、Gff3、Gff4、Gfb1、Gfb2、Gfb3、Gfb4を設定して、制御ゲインGff1、Gff2、Gff3、Gff4をフィードフォワード制御部20bに出力し、制御ゲインGfb1、Gfb2、Gfb3、Gfb4をフィードバック制御部20cに出力するように構成されている。
The control gain
以下、各制御ゲインGff1、Gff2、Gff3、Gff4、Gfb1、Gfb2、Gfb3、Gfb4の設定について、図4〜図12に示すフローチャートに従って説明する。 Hereinafter, the setting of each control gain Gff1, Gff2, Gff3, Gff4, Gfb1, Gfb2, Gfb3, Gfb4 will be described with reference to the flowcharts shown in FIGS.
まず、ステップ(以下、「S」と略称)201で、左白線と該左白線を構成する左候補点との差分の平均の絶対値(左白線と左候補点との差分の平均値)err_line_l、右白線と該右白線を構成する右候補点との差分の平均値の絶対値(右白線と右候補点との差分の平均値)err_line_rを算出する。すなわち、上述したように、前方認識装置31から、画像上での白線の(i,j)座標を検出し、これを実空間上のx−z座標に変換し、変換されたx−z座標において、該白線を構成する各候補点に対して、二次の最小自乗近似を左右それぞれの白線について行う。通常、白線は、傾き、曲率を持った線分であり、近似式によって近似できない場合は、白線ではなく路面等の模様を白線の候補点として検出してしまっている可能性があり、このような、値が小さいほど、白線の認識状態が安定していると評価できる誤差err_line_l、err_line_rを、それぞれ左右の白線の認識状態の安定性を評価する数値として採用するのである。
First, in step (hereinafter abbreviated as “S”) 201, the absolute value of the average of the difference between the left white line and the left candidate point constituting the left white line (average value of the difference between the left white line and the left candidate point) err_line_l Then, the absolute value of the average value of the difference between the right white line and the right candidate point constituting the right white line (the average value of the difference between the right white line and the right candidate point) err_line_r is calculated. That is, as described above, the (i, j) coordinates of the white line on the image are detected from the
次に、S202に進み、左白線長さlength_lと右白線長さlength_rを算出する。具体的には、図17に示すように、過去検出したz軸方向のデータをΔF(例えば、1m、或いは、任意に必要な分解能長さ)の前後方向の領域を定め、このΔFの範囲に入る白線を構成している候補点群のx方向の平均位置を左右の白線それぞれについて算出する。図17の例では、点Pnは、今回ΔFnの範囲において検出された候補点群を示し、点Pfnは、これら点Pnのx方向の平均位置の点を示す。また、点Pn-1は、前回ΔFn-1の範囲において検出された候補点群を示し、点Pfn-1は、これら点Pn-1のx方向の平均位置の点を示す。同様に、点Pn-2は、前回ΔFn-1の前回ΔFn-2の範囲において検出された候補点群を示し、点Pfn-2は、これら点Pn-2のx方向の平均位置の点を示す。点Pfn-3も同様である。このとき、ΔFに入る白線の候補点が閾値以上存在しない場合は、平均位置の算出は行わない。 In step S202, the left white line length length_l and the right white line length length_r are calculated. Specifically, as shown in FIG. 17, an area in the front-rear direction of ΔF (for example, 1 m or arbitrarily required resolution length) is determined for the z-axis direction data detected in the past, and the range of ΔF is set. The average position in the x direction of the candidate point group constituting the entering white line is calculated for each of the left and right white lines. In the example of FIG. 17, a point Pn indicates a candidate point group detected in the range of ΔFn this time, and a point Pfn indicates a point at the average position of these points Pn in the x direction. A point Pn-1 indicates a group of candidate points detected in the previous range of ΔFn-1, and a point Pfn-1 indicates a point at the average position in the x direction of these points Pn-1. Similarly, the point Pn-2 indicates a candidate point group detected in the range of the previous ΔFn-2 of the previous ΔFn-1, and the point Pfn-2 indicates the point of the average position in the x direction of these points Pn-2. Show. The same applies to the point Pfn-3. At this time, if there are no white line candidate points that fall into ΔF, the average position is not calculated.
その後、過去の代表点のx座標位置が車両の移動により移動が予測されるx方向の位置を推定し、その推定されたx座標位置と、今回フレームの平均位置のx座標位置との差分の絶対値を計算する。 Thereafter, the x-coordinate position of the past representative point is estimated in the x-direction where the movement is predicted by the movement of the vehicle, and the difference between the estimated x-coordinate position and the x-coordinate position of the average position of the current frame is calculated. Calculate the absolute value.
例えば、図18に示すように、過去の代表点がPn-1(xold,zold)として、車両の移動により移動が予測される位置がPpre(xpre,zpre)とすると、Ppre(xpre,zpre)と今回の代表点Pn(xn,zn)との差分の絶対値(=|xpre−xn|)を計算する。 For example, as shown in FIG. 18, if the past representative point is Pn-1 (xold, zold) and the position where the movement is predicted by the movement of the vehicle is Ppre (xpre, zpre), Ppre (xpre, zpre) And the absolute value (= | xpre−xn |) of the difference between the current point Pn (xn, zn) and this time.
そして、今回のx方向の平均位置が計算されており、且つ、車両の移動により移動が予測される位置Ppre(xpre,zpre)との差分の絶対値が閾値以下であることを複数フレーム満足した場合には、最遠の白線平均位置のz座標を、左白線長さlength_l、右白線長さlength_rとしてメモリする。尚、初期状態等で、推定位置が存在しない場合には、白線の平均位置が閾値未満として扱う。 The average position in the x direction this time was calculated, and a plurality of frames satisfied that the absolute value of the difference from the position Ppre (xpre, zpre) predicted to move due to the movement of the vehicle is equal to or less than a threshold value. In this case, the z coordinate of the farthest white line average position is stored as the left white line length length_l and the right white line length length_r. In the initial state or the like, when the estimated position does not exist, the average position of the white line is handled as less than the threshold value.
この際、車両の移動により移動が予測される位置Ppre(xpre,zpre)の座標の算出について説明する。例えば、図19に示すように、車両が横方向にΔx、前方向にΔz移動する場合、これら移動量Δx、Δzは、以下の式(1)、式(2)により算出される。
Δx=V・Δt・sin(θ) …(1)
Δz=V・Δt・cos(θ) …(2)
ここで、Δtはフレームレート、θはヨー角(ヨーレートセンサ33からの値を積分した値)である。
At this time, calculation of the coordinates of the position Ppre (xpre, zpre) where the movement is predicted by the movement of the vehicle will be described. For example, as shown in FIG. 19, when the vehicle moves Δx in the lateral direction and Δz in the forward direction, these movement amounts Δx and Δz are calculated by the following equations (1) and (2).
Δx = V · Δt · sin (θ) (1)
Δz = V · Δt · cos (θ) (2)
Here, Δt is a frame rate, and θ is a yaw angle (a value obtained by integrating values from the yaw rate sensor 33).
そして、Ppre(xpre,zpre)は、以下の式(3)、式(4)により算出される。
xpre=(xold−Δx)・cos(θ)−(zold−Δz)・sin(θ) …(3)
zpre=(xold−Δx)・sin(θ)+(zold−Δz)・cos(θ) …(4)
Ppre (xpre, zpre) is calculated by the following equations (3) and (4).
xpre = (xold−Δx) · cos (θ) − (zold−Δz) · sin (θ) (3)
zpre = (xold−Δx) · sin (θ) + (zold−Δz) · cos (θ) (4)
このように本実施の形態では、左白線長さlength_l、及び、右白線長さlength_rを求め、これら左白線長さlength_l、及び、右白線長さlength_rが長いほど白線の認識状態の安定性が高いと評価できるようになっている。 Thus, in the present embodiment, the left white line length length_l and the right white line length length_r are obtained, and the longer the left white line length length_l and the right white line length length_r, the more stable the white line recognition state is. It can be evaluated as high.
次に、S203に進み、先行車のターンシグナルスイッチ情報の判定がなされ、先行車のターンシグナルスイッチがONの場合には、先行車ターンシグナルスイッチ安定性評価値Sigtuが1に設定され、ターンシグナルスイッチがOFFの場合には、先行車ターンシグナルスイッチ安定性評価値Sigtuが0に設定される。すなわち、先行車がターンシグナルスイッチをONしている場合には、右左折の可能性があり、自車両との進行路と異なる虞があるため、先行車のターンシグナルスイッチがONの場合には、Sigtu=1として先行車の認識状態の安定性を低く判断できるようにするのである。 Next, in S203, the turn signal switch information of the preceding vehicle is determined. If the turn signal switch of the preceding vehicle is ON, the preceding vehicle turn signal switch stability evaluation value Sigtu is set to 1, and the turn signal is turned on. When the switch is OFF, the preceding vehicle turn signal switch stability evaluation value Sigtu is set to zero. In other words, if the preceding vehicle has the turn signal switch turned on, there is a possibility of turning left and right, which may be different from the traveling path with the own vehicle. Therefore, the stability of the recognition state of the preceding vehicle can be determined low by setting Sigtu = 1.
次いで、S204に進み、先行車の幅情報を安定して検出しているか判断し、先行車の車幅の前回値と今回値の差分の絶対値が閾値(例えば、20cm)以下であることが所定フレーム回数を超えている場合には、先行車の認識状態は安定しているとして、先行車車幅長さ安定評価値Tgt_veh_wを1に設定する。逆に、所定フレーム回数を超えていない場合には、先行車車幅長さ安定評価値Tgt_veh_wを0に設定する。 Next, the process proceeds to S204, where it is determined whether the width information of the preceding vehicle is stably detected, and the absolute value of the difference between the previous value and the current value of the preceding vehicle width is equal to or less than a threshold value (for example, 20 cm). If the predetermined number of frames is exceeded, the preceding vehicle width length stability evaluation value Tgt_veh_w is set to 1 assuming that the recognition state of the preceding vehicle is stable. Conversely, if the predetermined number of frames has not been exceeded, the preceding vehicle width length stability evaluation value Tgt_veh_w is set to zero.
次に、S205に進み、先行車と自車両との車間距離が安定しているか判定する。具体的には、過去数フレーム分において、先行車と自車両との車間距離を、1次の最小自乗法で近似した際の近似誤差を計算し、この近似誤差が閾値以下の場合であれば、車間距離が安定しているとして、先行車車間距離安定評価値Tgt_veh_dを1に設定する。逆に、近似誤差が閾値を超えている場合には、先行車車間距離安定評価値Tgt_veh_dを0に設定する。 Next, it progresses to S205 and it is determined whether the distance between the preceding vehicle and the own vehicle is stable. Specifically, in the past several frames, an approximation error is calculated when the inter-vehicle distance between the preceding vehicle and the host vehicle is approximated by the first-order least squares method. Assuming that the inter-vehicle distance is stable, the preceding vehicle inter-vehicle distance stability evaluation value Tgt_veh_d is set to 1. Conversely, if the approximation error exceeds the threshold, the preceding vehicle inter-vehicle distance stability evaluation value Tgt_veh_d is set to zero.
次いで、S206に進み、後述の図5〜図12のフローチャートに従って、各制御ゲインGff1、Gff2、Gff3、Gff4、Gfb1、Gfb2、Gfb3、Gfb4を、上述の左白線と左候補点との差分の平均値err_line_l、右白線と右候補点との差分の平均値err_line_r、左白線長さlength_l、右白線長さlength_r、先行車ターンシグナルスイッチ安定性評価値Sigtu、先行車車幅長さ安定評価値Tgt_veh_w、先行車車間距離安定評価値Tgt_veh_dを設定する。 Next, the process proceeds to S206, and the control gains Gff1, Gff2, Gff3, Gff4, Gfb1, Gfb2, Gfb3, Gfb4 are averaged by the difference between the left white line and the left candidate point according to the flowcharts of FIGS. Value err_line_l, average value err_line_r of difference between right white line and right candidate point, left white line length length_l, right white line length length_r, preceding vehicle turn signal switch stability evaluation value Sigtu, preceding vehicle vehicle width length stability evaluation value Tgt_veh_w The preceding vehicle inter-vehicle distance stability evaluation value Tgt_veh_d is set.
ここで、上述の制御ゲインGff1は、後述するフィードフォワード制御部20bにおけるフィードフォワード制御において右白線の曲率と左白線の曲率とに基づく演算項の重み付けを決定するゲインであり、制御ゲインGff2は、フィードフォワード制御において右白線の曲率に基づく演算項の重み付けを決定するゲインであり、制御ゲインGff3は、フィードフォワード制御において左白線の曲率に基づく演算項の重み付けを決定するゲインであり、制御ゲインGff4は、フィードフォワード制御において先行車の走行軌跡の曲率に基づく演算項の重み付けを決定するゲインとなっている。
Here, the control gain Gff1 described above is a gain that determines the weighting of the calculation term based on the curvature of the right white line and the curvature of the left white line in the feedforward control in the
また、上述の制御ゲインGfb1は、後述するフィードバック制御部20cにおけるフィードバック制御において自車両の予測される走行位置での左右両白線の中心からのずれに基づく演算項の重み付けを決定するゲインであり、制御ゲインGfb2は、フィードバック制御において自車両の予測される走行位置での右白線を基準に推定する走行路からのずれに基づく演算項の重み付けを決定するゲインであり、制御ゲインGfb3は、フィードバック制御において自車両の予測される走行位置での左白線を基準に推定する走行路からのずれに基づく演算項の重み付けを決定するゲインであり、制御ゲインGfb4は、フィードバック制御において自車両の予測される走行位置での先行車の走行軌跡からのずれに基づく演算項の重み付けを決定するゲインとなっている。
Further, the control gain Gfb1 described above is a gain that determines the weighting of the calculation term based on the deviation from the center of the left and right white lines at the predicted travel position of the host vehicle in the feedback control in the
これら各制御ゲインGff1、Gff2、Gff3、Gff4、Gfb1、Gfb2、Gfb3、Gfb4は、それぞれ、数値が高くなるほど、それぞれの演算項の影響が高くなるようになっている。 Each of these control gains Gff1, Gff2, Gff3, Gff4, Gfb1, Gfb2, Gfb3, and Gfb4 has a higher influence of the respective calculation term as the numerical value becomes higher.
次に、図5〜図12のフローチャートを基に、各制御ゲインGff1、Gff2、Gff3、Gff4、Gfb1、Gfb2、Gfb3、Gfb4の設定を説明する。 Next, the setting of each control gain Gff1, Gff2, Gff3, Gff4, Gfb1, Gfb2, Gfb3, Gfb4 will be described based on the flowcharts of FIGS.
まず、S301で、右白線と右候補点との差分の平均値err_line_rが予め設定した閾値Cσ未満(err_line_r<Cσ)か否か判定し、この判定の結果、err_line_r<Cσで右白線が安定して認識されていると判定される場合は、S302に進む。 First, in S301, it is determined whether or not the average value err_line_r of the difference between the right white line and the right candidate point is less than a preset threshold Cσ (err_line_r <Cσ). As a result of this determination, the right white line is stabilized with err_line_r <Cσ. If it is determined that it is recognized, the process proceeds to S302.
S302では、右白線長さlength_rが予め設定した閾値Cdを超えているか(Cd<length_r)か否か判定し、この判定の結果、Cd<length_rで右白線が安定した操舵支援制御を行うのに十分な長さを有すると判定される場合は、S303に進む。 In S302, it is determined whether or not the right white line length length_r exceeds a preset threshold Cd (Cd <length_r). As a result of the determination, steering right control is performed with the right white line being stable with Cd <length_r. If it is determined that the length is sufficient, the process proceeds to S303.
S303では、左白線と左候補点との差分の平均値err_line_lが予め設定した閾値Cσ未満(err_line_l<Cσ)か否か判定し、この判定の結果、err_line_l<Cσで左白線が安定して認識されていると判定される場合は、S304に進む。 In S303, it is determined whether the average value err_line_l of the difference between the left white line and the left candidate point is less than a preset threshold Cσ (err_line_l <Cσ). As a result of this determination, the left white line is stably recognized with err_line_l <Cσ. If it is determined that it has been performed, the process proceeds to S304.
S304では、
左白線長さlength_lが予め設定した閾値Cdを超えているか(Cd<length_l)か否か判定し、この判定の結果、Cd<length_lで左白線が安定した操舵支援制御を行うのに十分な長さを有すると判定される場合は、S305に進む。
In S304,
It is determined whether the left white line length length_l exceeds a preset threshold Cd (Cd <length_l). As a result of this determination, the left white line is long enough to perform stable steering support control with Cd <length_l. If it is determined that there is a problem, the process proceeds to S305.
そして、S305に進むと、左右の白線は安定して認識され、操舵支援制御を行うのに十分な長さを有していると判定されるため、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=1.0、Gff2=Gff3=Gff4=0に設定する。
Then, when proceeding to S305, the left and right white lines are stably recognized and are determined to have a sufficient length for performing the steering assist control, so that each control gain Gff1, for the
その後、S306に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=1.0、Gfb2=Gfb3=Gfb4=0に設定してプログラムを抜ける。すなわち、左右の白線は安定して認識され、操舵支援制御を行うのに十分な長さを有していると判定されるため、両側白線の情報に基づき操舵支援制御が実行されるようになっている。
Thereafter, the process proceeds to S306, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
また、上述のS303で、err_line_l≧Cσで左白線の認識が不安定と判定される場合は、S307に進む。 If it is determined in S303 described above that err_line_l ≧ Cσ and left white line recognition is unstable, the process proceeds to S307.
S307では、ターンシグナルスイッチがOFF(Sigtu=0)で、且つ、先行車の幅情報を安定して検出しており(Tgt_veh_w=1)、且つ、先行車と自車両との車間距離が安定しており(Tgt_veh_d=1)、先行車情報は操舵支援制御するのに十分であると判定できる場合は、S308に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=0.5、Gff3=0、Gff4=0.5に設定する。
In S307, the turn signal switch is OFF (Sigtu = 0), the width information of the preceding vehicle is detected stably (Tgt_veh_w = 1), and the distance between the preceding vehicle and the host vehicle is stable. (Tgt_veh_d = 1), and if it can be determined that the preceding vehicle information is sufficient for steering assist control, the process proceeds to S308, and the control gains Gff1, Gff2, Gff3, Gff4 for the
その後、S309に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=0.5、Gfb3=0、Gfb4=0.5に設定する。
Thereafter, the process proceeds to S309, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、左白線の認識が不安定であっても、右白線は安定して認識され、操舵支援制御を行うのに十分な長さを有しており、先行車情報も操舵支援制御するのに十分であるため、右白線情報と先行車情報とを同じ重み付けで操舵支援制御が行われるようになっている。 That is, even if the recognition of the left white line is unstable, the right white line is recognized stably and has a sufficient length to perform steering support control, and the preceding vehicle information is also used for steering support control. Since it is sufficient, the steering assist control is performed with the same weight on the right white line information and the preceding vehicle information.
一方、S307で、Sigtu=0、且つ、Tgt_veh_w=1、且つ、Tgt_veh_d=1の条件が判定されず、先行車情報は操舵支援制御するのに不十分であると判定できる場合は、S310に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=1.0、Gff3=Gff4=0に設定する。
On the other hand, if the conditions of Sigtu = 0, Tgt_veh_w = 1, and Tgt_veh_d = 1 are not determined in S307 and it can be determined that the preceding vehicle information is insufficient for steering support control, the process proceeds to S310. The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S311に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=1.0、Gfb3=Gfb4=0に設定する。
Thereafter, the process proceeds to S311, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、左白線の認識が不安定で、先行車情報も操舵支援制御するのに不十分であるが、右白線は安定して認識され、操舵支援制御を行うのに十分な長さを有していると判定されるため、右白線情報に基づいた操舵支援制御が行われるようになっている。 That is, the recognition of the left white line is unstable and the preceding vehicle information is insufficient for steering support control, but the right white line is recognized stably and has sufficient length to perform the steering support control. Therefore, the steering assist control based on the right white line information is performed.
また、上述のS304で、Cd≧length_lで、右白線は安定して認識され、操舵支援制御を行うのに十分な長さを有しており、左白線は安定して認識されてはいるものの、操舵支援制御を行うのに十分な長さを有していないと判定された場合は、S312に進む。 In S304 described above, although Cd ≧ length_l, the right white line is stably recognized and has a sufficient length for performing the steering assist control, and the left white line is stably recognized. If it is determined that the length is not sufficient to perform the steering assist control, the process proceeds to S312.
S312では、ターンシグナルスイッチがOFF(Sigtu=0)で、且つ、先行車の幅情報を安定して検出しており(Tgt_veh_w=1)、且つ、先行車と自車両との車間距離が安定しており(Tgt_veh_d=1)、先行車情報は操舵支援制御するのに十分であると判定できる場合は、S313に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=0.5、Gff3=0.2、Gff4=0.3に設定する。
In S312, the turn signal switch is OFF (Sigtu = 0), the width information of the preceding vehicle is detected stably (Tgt_veh_w = 1), and the distance between the preceding vehicle and the host vehicle is stable. (Tgt_veh_d = 1), and if it can be determined that the preceding vehicle information is sufficient for steering assist control, the process proceeds to S313, and the control gains Gff1, Gff2, Gff3, Gff4 for the
その後、S314に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=0.5、Gfb3=0.2、Gfb4=0.3に設定する。
Thereafter, the process proceeds to S314, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、左白線は安定して認識されてはいるものの、操舵支援制御を行うのに十分な長さを有していないが、右白線は安定して認識され、操舵支援制御を行うのに十分な長さを有しており、また、先行車情報は操舵支援制御するのに十分であるため、右白線情報に関する制御ゲインGff2、Gfb2を最も高く設定し、次に、先行車情報に関する制御ゲインGff4、Gfb4を高く設定し、次いで、左白線情報に関する制御ゲインGff3、Gfb3を僅かに設定して、この重み付けで右白線情報、左白線情報、先行車情報に基づいた操舵支援制御を行うのである。 That is, although the left white line is recognized stably, it is not long enough to perform steering support control, but the right white line is recognized stably and is sufficient to perform steering support control. Since the preceding vehicle information is sufficient for steering assist control, the control gains Gff2 and Gfb2 for the right white line information are set to the highest, and then the control gain for the preceding vehicle information is set. Gff4 and Gfb4 are set high, then control gains Gff3 and Gfb3 relating to the left white line information are set slightly, and steering assist control based on the right white line information, left white line information, and preceding vehicle information is performed with this weighting. .
一方、S312で、Sigtu=0、且つ、Tgt_veh_w=1、且つ、Tgt_veh_d=1の条件が判定されず、先行車情報は操舵支援制御するのに不十分であると判定できる場合は、S315に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=0.8、Gff3=0.2、Gff4=0に設定する。
On the other hand, if the conditions of Sigtu = 0, Tgt_veh_w = 1, and Tgt_veh_d = 1 are not determined in S312, and it can be determined that the preceding vehicle information is insufficient for steering support control, the process proceeds to S315. The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S316に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=0.8、Gfb3=0.2、Gfb4=0に設定する。
Thereafter, the process proceeds to S316, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、左白線は安定して認識されてはいるものの、操舵支援制御を行うのに十分な長さを有しておらず、先行車情報は操舵支援制御するのに不十分であり、右白線は安定して認識され、操舵支援制御を行うのに十分な長さを有しているため、右白線情報に関する制御ゲインGff2、Gfb2を最も高く設定し、左白線情報に関する制御ゲインGff3、Gfb3は僅かに設定することにより、この重み付けで右白線情報、左白線情報に基づいた操舵支援制御を行うのである。 That is, although the left white line is recognized stably, it is not long enough to perform steering support control, and the preceding vehicle information is insufficient for steering support control. Is recognized stably and has a sufficient length for performing steering assist control, the control gains Gff2 and Gfb2 relating to the right white line information are set to the highest, and the control gains Gff3 and Gfb3 relating to the left white line information are set to By slightly setting, the steering assist control based on the right white line information and the left white line information is performed with this weighting.
また、前述のS302で、Cd≧length_rで、右白線は安定して認識されているものの、操舵支援制御を行うのに十分な長さを有していないと判定された場合は、S317に進む。 If it is determined in S302 described above that Cd ≧ length_r and the right white line is stably recognized but does not have a sufficient length for performing the steering assist control, the process proceeds to S317. .
S317では、err_line_l<Cσか否か判定され、この判定の結果、err_line_l≧Cσで左白線が安定して認識されていないと判定される場合は、S318に進む。 In S317, it is determined whether or not err_line_l <Cσ, and if it is determined that err_line_l ≧ Cσ and the left white line is not stably recognized, the process proceeds to S318.
S318では、ターンシグナルスイッチがOFF(Sigtu=0)で、且つ、先行車の幅情報を安定して検出しており(Tgt_veh_w=1)、且つ、先行車と自車両との車間距離が安定しており(Tgt_veh_d=1)、先行車情報は操舵支援制御するのに十分であると判定できる場合は、S319に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=0.2、Gff3=0、Gff4=0.8に設定する。
In S318, the turn signal switch is OFF (Sigtu = 0), the width information of the preceding vehicle is stably detected (Tgt_veh_w = 1), and the distance between the preceding vehicle and the host vehicle is stable. (Tgt_veh_d = 1), and if it can be determined that the preceding vehicle information is sufficient for the steering assist control, the process proceeds to S319, and each control gain Gff1, Gff2, Gff3, Gff4 for the
その後、S320に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=0.2、Gfb3=0、Gfb4=0.8に設定する。
Thereafter, the process proceeds to S320, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、左白線の認識が不安定で、右白線は安定して認識されているものの、操舵支援制御を行うのに十分な長さを有しておらず、先行車情報は操舵支援制御するのに十分であるため、先行車情報に関する制御ゲインGff4、Gfb4を最も高く設定し、右白線情報に関する制御ゲインGff2、Gfb2を僅かに設定して、この重み付けで右白線情報、先行車情報に基づいた操舵支援制御を行うのである。 That is, although the left white line is unstable and the right white line is recognized stably, it is not long enough to perform steering assist control, and the preceding vehicle information is subject to steering assist control. Therefore, the control gains Gff4 and Gfb4 related to the preceding vehicle information are set to be the highest, the control gains Gff2 and Gfb2 related to the right white line information are set slightly, and this weighting is used based on the right white line information and the preceding vehicle information. Steering support control is performed.
一方、S318で、Sigtu=0、且つ、Tgt_veh_w=1、且つ、Tgt_veh_d=1の条件が判定されず、先行車情報は操舵支援制御するのに不十分であると判定できる場合は、S321に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=1.0、Gff3=Gff4=0に設定する。
On the other hand, if the conditions of Sigtu = 0, Tgt_veh_w = 1, and Tgt_veh_d = 1 are not determined in S318 and the preceding vehicle information can be determined to be insufficient for steering support control, the process proceeds to S321. The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S322に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=1.0、Gfb3=Gfb4=0に設定する。
Thereafter, the process proceeds to S322, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、左白線の認識が不安定で、右白線は安定して認識されているものの、操舵支援制御を行うのに十分な長さを有しておらず、先行車情報は操舵支援制御するのに不十分であるため、右白線情報に基づいてのみ操舵支援制御を行うのである。 That is, although the left white line is unstable and the right white line is recognized stably, it is not long enough to perform steering assist control, and the preceding vehicle information is subject to steering assist control. Therefore, the steering assist control is performed only based on the right white line information.
また、前述のS317で、err_line_l<Cσで左白線が安定して認識されていると判定される場合は、S323に進み、Cd<length_lか否か判定する。この判定の結果、Cd≧length_lで、右白線も左白線も安定して認識されてはいるものの、共に、操舵支援制御を行うのに十分な長さを有していない場合は、S324に進み、ターンシグナルスイッチがOFF(Sigtu=0)で、且つ、先行車の幅情報を安定して検出しており(Tgt_veh_w=1)、且つ、先行車と自車両との車間距離が安定しており(Tgt_veh_d=1)、先行車情報は操舵支援制御するのに十分であると判定できる場合は、S325に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=Gff3=0.2、Gff4=0.6に設定する。
If it is determined in S317 that the left white line is stably recognized with err_line_l <Cσ, the process proceeds to S323 to determine whether Cd <length_l. As a result of this determination, if Cd ≧ length_l and both the right white line and the left white line are stably recognized, but both are not long enough to perform the steering assist control, the process proceeds to S324. The turn signal switch is OFF (Sigtu = 0), the width information of the preceding vehicle is detected stably (Tgt_veh_w = 1), and the distance between the preceding vehicle and the host vehicle is stable (Tgt_veh_d = 1) If it can be determined that the preceding vehicle information is sufficient for the steering assist control, the process proceeds to S325, and the control gains Gff1, Gff2, Gff3, Gff4 for the
その後、S326に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=Gfb3=0.2、Gfb4=0.6に設定する。
Thereafter, the process proceeds to S326, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、右白線も左白線も安定して認識されてはいるものの、共に、操舵支援制御を行うのに十分な長さを有していない場合は、先行車情報に関する制御ゲインGff4、Gfb4を最も高く設定し、右白線情報に関する制御ゲインGff2、Gfb2と左白線情報に関する制御ゲインGff3、Gfb3を共に僅かに設定して、この重み付けで右白線情報、左白線情報、先行車情報に基づいた操舵支援制御を行うのである。 That is, when both the right white line and the left white line are stably recognized, but both do not have a sufficient length for performing the steering assist control, the control gains Gff4 and Gfb4 related to the preceding vehicle information are set to the highest. Set high, control gain Gff2, Gfb2 related to right white line information and control gain Gff3, Gfb3 related to left white line information are both set slightly, and steering assistance based on right white line information, left white line information, and preceding vehicle information with this weighting Control is performed.
一方、S324で、Sigtu=0、且つ、Tgt_veh_w=1、且つ、Tgt_veh_d=1の条件が判定されず、先行車情報は操舵支援制御するのに不十分であると判定できる場合は、S327に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=Gff3=0.5、Gff4=0に設定する。
On the other hand, if the conditions of Sigtu = 0, Tgt_veh_w = 1, and Tgt_veh_d = 1 are not determined in S324 and it can be determined that the preceding vehicle information is insufficient for steering support control, the process proceeds to S327. The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S328に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=Gfb3=0.5、Gfb4=0に設定する。
Thereafter, the process proceeds to S328, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、右白線も左白線も安定して認識されてはいるものの、共に、操舵支援制御を行うのに十分な長さを有しておらず、先行車情報も操舵支援制御するにには不十分であるため、右白線情報と左白線情報とを同じ重み付けで用いて操舵支援制御を実行するようになっている。 That is, although the right and left white lines are recognized stably, both are not long enough to perform steering support control, and the preceding vehicle information is also not suitable for steering support control. Since it is sufficient, the steering assist control is executed using the right white line information and the left white line information with the same weighting.
また、S323で、Cd<length_lで、右白線は安定して認識されているものの、操舵支援制御を行うのに十分な長さを有しておらず、左白線は安定して認識されて、操舵支援制御を行うのに十分な長さを有している場合は、S329に進み、ターンシグナルスイッチがOFF(Sigtu=0)で、且つ、先行車の幅情報を安定して検出しており(Tgt_veh_w=1)、且つ、先行車と自車両との車間距離が安定しており(Tgt_veh_d=1)、先行車情報は操舵支援制御するのに十分であると判定できる場合は、S330に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=0.2、Gff3=0.5、Gff4=0.3に設定する。
In S323, Cd <length_l and the right white line is recognized stably, but it does not have a sufficient length to perform steering assist control, and the left white line is recognized stably. If it is long enough to perform the steering assist control, the process proceeds to S329, the turn signal switch is OFF (Sigtu = 0), and the width information of the preceding vehicle is stably detected. If (Tgt_veh_w = 1) and the inter-vehicle distance between the preceding vehicle and the host vehicle is stable (Tgt_veh_d = 1) and it can be determined that the preceding vehicle information is sufficient for steering support control, the process proceeds to S330 The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S331に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=0.2、Gfb3=0.5、Gfb4=0.3に設定する。
Thereafter, the process proceeds to S331, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、左白線は安定して認識され、操舵支援制御を行うのに十分な長さを有しているが、右白線は安定して認識されているものの、操舵支援制御を行うのに十分な長さを有しておらず、先行車情報は操舵支援制御するのに十分であるため、左白線情報に関する制御ゲインGff3、Gfb3を最も高く設定し、次に、先行車情報に関する制御ゲインGff4、Gfb4を高く設定し、右白線情報に関する制御ゲインGff2、Gfb2を僅かに設定して、この重み付けで右白線情報、左白線情報、先行車情報に基づいた操舵支援制御を行うのである。 That is, the left white line is recognized stably and has a sufficient length to perform steering support control, but the right white line is recognized stably but is sufficient to perform steering support control. Since it does not have a length and the preceding vehicle information is sufficient for steering assist control, the control gains Gff3 and Gfb3 related to the left white line information are set to the highest, and then the control gain Gff4 related to the preceding vehicle information is set. Gfb4 is set high, control gains Gff2 and Gfb2 relating to right white line information are set slightly, and steering assist control based on right white line information, left white line information, and preceding vehicle information is performed with this weighting.
一方、S329で、Sigtu=0、且つ、Tgt_veh_w=1、且つ、Tgt_veh_d=1の条件が判定されず、先行車情報は操舵支援制御するのに不十分であると判定できる場合は、S332に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=0、Gff2=0.2、Gff3=0.8、Gff4=0に設定する。
On the other hand, if the conditions of Sigtu = 0, Tgt_veh_w = 1, and Tgt_veh_d = 1 are not determined in S329 and it can be determined that the preceding vehicle information is insufficient for steering assist control, the process proceeds to S332. The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S333に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=0、Gfb2=0.2、Gfb3=0.8、Gfb4=0に設定する。
Thereafter, the process proceeds to S333, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、左白線は安定して認識され、操舵支援制御を行うのに十分な長さを有しているが、右白線は安定して認識されているものの、操舵支援制御を行うのに十分な長さを有しておらず、先行車情報も操舵支援制御するのに不十分であるため、左白線情報に関する制御ゲインGff3、Gfb3を最も高く設定し、右白線情報に関する制御ゲインGff2、Gfb2を僅かに設定して、この重み付けで右白線情報、左白線情報に基づいた操舵支援制御を行うのである。 That is, the left white line is recognized stably and has a sufficient length to perform steering support control, but the right white line is recognized stably but is sufficient to perform steering support control. Since it does not have a length and the preceding vehicle information is insufficient for steering assist control, the control gains Gff3 and Gfb3 related to the left white line information are set to the highest, and the control gains Gff2 and Gfb2 related to the right white line information are set. The steering assist control based on the right white line information and the left white line information is performed with this weighting.
一方、図5の初めに戻り、S301で、err_line_r≧Cσで右白線が安定して認識されていないと判定される場合は、S334に進む。 On the other hand, returning to the beginning of FIG. 5, if it is determined in S301 that the right white line is not stably recognized because err_line_r ≧ Cσ, the process proceeds to S334.
S334では、err_line_l<Cσか否か判定し、err_line_l≧Cσで左白線が安定して認識されていないと判定される場合は、S335に進む。 In S334, it is determined whether or not err_line_l <Cσ. If err_line_l ≧ Cσ and it is determined that the left white line is not stably recognized, the process proceeds to S335.
S335では、ターンシグナルスイッチがOFF(Sigtu=0)で、且つ、先行車の幅情報を安定して検出しており(Tgt_veh_w=1)、且つ、先行車と自車両との車間距離が安定しており(Tgt_veh_d=1)、先行車情報は操舵支援制御するのに十分であると判定できる場合は、S336に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=Gff2=Gff3=0、Gff4=1.0に設定する。
In S335, the turn signal switch is OFF (Sigtu = 0), the width information of the preceding vehicle is stably detected (Tgt_veh_w = 1), and the distance between the preceding vehicle and the host vehicle is stable. (Tgt_veh_d = 1), and if it can be determined that the preceding vehicle information is sufficient for steering assist control, the process proceeds to S336, and the control gains Gff1, Gff2, Gff3, Gff4 for the
その後、S337に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=Gfb2=Gfb3=0、Gfb4=1.0に設定する。
Thereafter, the process proceeds to S337, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、右白線も左白線も共に認識が不安定なため、得られる先行車情報に基づいた操舵支援制御を行うのである。 That is, since the recognition of both the right white line and the left white line is unstable, the steering assist control is performed based on the preceding vehicle information obtained.
一方、S335で、Sigtu=0、且つ、Tgt_veh_w=1、且つ、Tgt_veh_d=1の条件が判定されず、先行車情報は操舵支援制御するのに不十分であると判定できる場合は、S338に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=Gff2=Gff3=Gff4=0に設定する。
On the other hand, if it is determined in S335 that the conditions of Sigtu = 0, Tgt_veh_w = 1, and Tgt_veh_d = 1 are not determined and it is determined that the preceding vehicle information is insufficient for steering support control, the process proceeds to S338. The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S339に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=Gfb2=Gfb3=Gfb4=0に設定する。
Thereafter, the process proceeds to S339, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、右白線情報も、左白線情報も、先行車情報も得られないため、操舵支援制御を行わない。 That is, since the right white line information, the left white line information, and the preceding vehicle information are not obtained, steering assist control is not performed.
また、上述のS334で、err_line_l<Cσで、右白線が安定して認識されていないが、左白線は安定して認識されていると判定された場合は、S340に進む。 If it is determined in S334 that err_line_l <Cσ and the right white line is not stably recognized, but the left white line is stably recognized, the process proceeds to S340.
S340では、Cd<length_lか否か判定され、この判定の結果、Cd<length_lで左白線が安定した操舵支援制御を行うのに十分な長さを有すると判定される場合は、S341に進む。 In S340, it is determined whether or not Cd <length_l. As a result of the determination, if it is determined that Cd <length_l and the left white line has a sufficient length for stable steering support control, the process proceeds to S341.
S341では、ターンシグナルスイッチがOFF(Sigtu=0)で、且つ、先行車の幅情報を安定して検出しており(Tgt_veh_w=1)、且つ、先行車と自車両との車間距離が安定しており(Tgt_veh_d=1)、先行車情報は操舵支援制御するのに十分であると判定できる場合は、S342に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=Gff2=0、Gff3=Gff4=0.5に設定する。
In S341, the turn signal switch is OFF (Sigtu = 0), the width information of the preceding vehicle is stably detected (Tgt_veh_w = 1), and the distance between the preceding vehicle and the host vehicle is stable. (Tgt_veh_d = 1), and if it can be determined that the preceding vehicle information is sufficient for steering assist control, the process proceeds to S342, and the control gains Gff1, Gff2, Gff3, Gff4 for the
その後、S343に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=Gfb2=0、Gfb3=Gfb4=0.5に設定する。
Thereafter, the process proceeds to S343, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、右白線の認識が不安定であっても、左白線は安定して認識され、操舵支援制御を行うのに十分な長さを有しており、先行車情報も操舵支援制御するのに十分であるため、左白線情報と先行車情報とを同じ重み付けで操舵支援制御が行われるようになっている。 That is, even if the recognition of the right white line is unstable, the left white line is recognized stably and has a sufficient length to perform the steering support control, and the preceding vehicle information is also used for the steering support control. Since this is sufficient, the steering assist control is performed with the same weighting on the left white line information and the preceding vehicle information.
一方、S341で、Sigtu=0、且つ、Tgt_veh_w=1、且つ、Tgt_veh_d=1の条件が判定されず、先行車情報は操舵支援制御するのに不十分であると判定できる場合は、S344に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=Gff2=0、Gff3=1.0、Gff4=0に設定する。
On the other hand, if the conditions of Sigtu = 0, Tgt_veh_w = 1, and Tgt_veh_d = 1 are not determined in S341 and it can be determined that the preceding vehicle information is insufficient for steering support control, the process proceeds to S344. The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S345に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=Gfb2=0、Gfb3=1.0、Gfb4=0に設定する。
Thereafter, the process proceeds to S345, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、右白線の認識が不安定で、先行車情報も操舵支援制御するのに不十分であるが、左白線は安定して認識され、操舵支援制御を行うのに十分な長さを有していると判定されるため、左白線情報に基づいた操舵支援制御が行われるようになっている。 That is, the recognition of the right white line is unstable and the preceding vehicle information is also insufficient for steering support control, but the left white line is recognized stably and has sufficient length to perform the steering support control. Therefore, steering assist control based on the left white line information is performed.
また、上述のS340で、Cd≧length_lで左白線が安定した操舵支援制御を行うのに十分な長さを有しないと判定される場合は、S346に進む。 In S340 described above, if it is determined that the left white line does not have a sufficient length for stable steering support control with Cd ≧ length_l, the process proceeds to S346.
S346では、ターンシグナルスイッチがOFF(Sigtu=0)で、且つ、先行車の幅情報を安定して検出しており(Tgt_veh_w=1)、且つ、先行車と自車両との車間距離が安定しており(Tgt_veh_d=1)、先行車情報は操舵支援制御するのに十分であると判定できる場合は、S347に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=Gff2=0、Gff3=0.2、Gff4=0.8に設定する。
In S346, the turn signal switch is OFF (Sigtu = 0), the width information of the preceding vehicle is detected stably (Tgt_veh_w = 1), and the distance between the preceding vehicle and the host vehicle is stable. (Tgt_veh_d = 1), and if it can be determined that the preceding vehicle information is sufficient for steering assist control, the process proceeds to S347, and the control gains Gff1, Gff2, Gff3, Gff4 for the
その後、S348に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=Gfb2=0、Gfb3=0.2、Gfb4=0.8に設定する。
Thereafter, the process proceeds to S348, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、右白線の認識が不安定で、左白線は安定して認識されているものの、操舵支援制御を行うのに十分な長さを有しておらず、先行車情報は操舵支援制御するのに十分であるため、先行車情報に関する制御ゲインGff4、Gfb4を最も高く設定し、左白線情報に関する制御ゲインGff2、Gfb2を僅かに設定して、この重み付けで左白線情報、先行車情報に基づいた操舵支援制御を行うのである。 That is, although the recognition of the right white line is unstable and the left white line is recognized stably, it is not long enough to perform steering support control, and the preceding vehicle information is subject to steering support control. Therefore, the control gains Gff4 and Gfb4 related to the preceding vehicle information are set to the highest, the control gains Gff2 and Gfb2 related to the left white line information are set slightly, and this weighting is used based on the left white line information and the preceding vehicle information. Steering support control is performed.
一方、S346で、Sigtu=0、且つ、Tgt_veh_w=1、且つ、Tgt_veh_d=1の条件が判定されず、先行車情報は操舵支援制御するのに不十分であると判定できる場合は、S349に進み、フィードフォワード制御部20bに対する各制御ゲインGff1、Gff2、Gff3、Gff4を、Gff1=Gff2=0、Gff3=1.0、Gff4=0に設定する。
On the other hand, if the conditions of Sigtu = 0, Tgt_veh_w = 1, and Tgt_veh_d = 1 are not determined in S346 and it can be determined that the preceding vehicle information is insufficient for steering support control, the process proceeds to S349. The control gains Gff1, Gff2, Gff3, and Gff4 for the
その後、S350に進んで、フィードバック制御部20cに対する各制御ゲインGfb1、Gfb2、Gfb3、Gfb4も同様に、Gfb1=Gfb2=0、Gfb3=1.0、Gfb4=0に設定する。
Thereafter, the process proceeds to S350, and the control gains Gfb1, Gfb2, Gfb3, and Gfb4 for the
すなわち、右白線の認識が不安定で、左白線は安定して認識されているものの、操舵支援制御を行うのに十分な長さを有しておらず、先行車情報は操舵支援制御するのに不十分であるため、左白線情報に基づいてのみ操舵支援制御を行うのである。 That is, although the recognition of the right white line is unstable and the left white line is recognized stably, it is not long enough to perform steering support control, and the preceding vehicle information is subject to steering support control. Therefore, the steering assist control is performed only based on the left white line information.
上述の如く、各制御ゲインGff1、Gff2、Gff3、Gff4、Gfb1、Gfb2、Gfb3、Gfb4の設定を行った後は、S207に進み、これら制御ゲインGff1、Gff2、Gff3、Gff4をフィードフォワード制御部20bに出力し、制御ゲインGfb1、Gfb2、Gfb3、Gfb4をフィードバック制御部20cに出力してルーチンを抜ける。このように、制御ゲイン設定制御部20aは、制御ゲイン設定手段として設けられている。
As described above, after setting the control gains Gff1, Gff2, Gff3, Gff4, Gfb1, Gfb2, Gfb3, and Gfb4, the process proceeds to S207, and these control gains Gff1, Gff2, Gff3, and Gff4 are set to the
フィードフォワード制御部20bは、前方認識装置31から画像情報が入力され、制御ゲイン設定制御部20aから制御ゲインGff1、Gff2、Gff3、Gff4が入力される。そして、例えば、以下の(5)式により、左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードフォワード出力値Iffとして演算し、操舵トルク算出部20dに出力する。
Iff=Gff1・(Rr+Rl)/2+Gff2・Rr+Gff3・Rl+Gff4・Rv
…(5)
ここで、Rrは右白線による曲率成分であり、Rlは左白線による曲率成分である。これら、左右白線の曲率成分Rr,Rlは、具体的には、図15に示すような、左右白線のそれぞれを構成する候補点に関して、二次の最小自乗法によって計算された二次項の係数を用いることによって定められる。例えば、x=A・z2+B・z+Cの二次式で白線を近似した場合、Aの値が曲率成分として用いられる。また、Rvは先行車軌跡による曲率成分であり、先行車の(後面)中心と自車中心とを結ぶ2点間における最小自乗法による近似で求めた値(x=A・z2の式で近似したAの値)を曲率成分とする。尚、これら白線の曲率成分Rr、Rlは、それぞれの白線の曲率そのものでも良く、また、先行車軌跡による曲率成分Rvは、先行車の通過した軌跡を利用して算出しても良く、軌跡のなす角度の微分値等から求めるようにしても良い。
The
Iff = Gff1 * (Rr + Rl) / 2 + Gff2 * Rr + Gff3 * Rl + Gff4 * Rv
... (5)
Here, Rr is a curvature component due to the right white line, and Rl is a curvature component due to the left white line. Specifically, the curvature components Rr and Rl of the left and right white lines are the coefficients of the quadratic terms calculated by the second least square method for the candidate points constituting each of the left and right white lines as shown in FIG. It is determined by using. For example, when the white line is approximated by a quadratic expression of x = A · z 2 + B · z + C, the value of A is used as the curvature component. Rv is a curvature component of the preceding vehicle trajectory, and is a value obtained by approximation by the least square method between two points connecting the (rear) center of the preceding vehicle and the center of the own vehicle (in the equation x = A · z 2 ). The approximate value of A) is the curvature component. The curvature components Rr and Rl of the white lines may be the curvatures of the respective white lines, and the curvature component Rv based on the preceding vehicle trajectory may be calculated using the trajectory passed by the preceding vehicle. You may make it obtain | require from the differential value etc. of the angle to make.
次に、このフィードフォワード制御部20bで実行されるフィードフォワード制御を、図13のフローチャートで説明する。
Next, the feedforward control executed by the
先ず、S401で、制御ゲイン設定制御部20aから制御ゲインGff1、Gff2、Gff3、Gff4を読み込む。
First, in S401, control gains Gff1, Gff2, Gff3, and Gff4 are read from the control gain
次に、S402に進み、左白線による曲率成分Rl、右白線による曲率成分Rr、先行車軌跡による曲率成分Rvを算出する。 Next, proceeding to S402, the curvature component Rl due to the left white line, the curvature component Rr due to the right white line, and the curvature component Rv due to the preceding vehicle locus are calculated.
そして、S403に進み、上述の(5)式により、フィードフォワード出力値Iffを算出し、操舵トルク算出部20dに出力する。このように、フィードフォワード制御部20bは、フィードフォワード制御手段として設けられている。
Then, the process proceeds to S403, where the feedforward output value Iff is calculated by the above equation (5) and output to the
フィードバック制御部20cは、前方認識装置31から画像情報が入力され、車速センサ32から車速Vが入力され、ヨーレートセンサ33からヨーレート(dθ/dt)が入力され、横加速度センサ34から横加速度Gyが入力され、制御ゲイン設定制御部20aから制御ゲインGfb1、Gfb2、Gfb3、Gfb4が入力される。そして、例えば、以下の(6)式により、自車両の予測される走行位置を基準とした左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードバック出力値Ifbとして演算として演算し、操舵トルク算出部20dに出力する。
Ifb=Gfb1・(xr−xl−xv)
+Gfb2・((xr+xr−wrd)/2−xv)
+Gfb3・((xl+xl+wrd)/2−xv)
+Gfb4・(xtgt−xv) …(6)
ここで、xvは車両の前方注視点のz座標におけるx座標である。この前方注視点とは、本実施の形態においては、例えば、図16(a)〜(d)に示すように、予め設定しておいた予見時間T(例えば、1.2秒)経過後に自車両が存在すると予測される点である。この前方注視点におけるz座標zvは、例えば、zv=T・Vで算出される。尚、単純に、前方の予め設定する距離の点としても良い。
The
Ifb = Gfb1. (Xr-xl-xv)
+ Gfb2 · ((xr + xr−wrd) / 2−xv)
+ Gfb3. ((Xl + xl + wrd) / 2-xv)
+ Gfb4 · (xtgt−xv) (6)
Here, xv is the x coordinate in the z coordinate of the front gazing point of the vehicle. In the present embodiment, the forward gazing point is, for example, as shown in FIGS. 16 (a) to 16 (d), after the preset preview time T (for example, 1.2 seconds) has elapsed. This is the point where a vehicle is expected to exist. The z coordinate zv at the forward gazing point is calculated by, for example, zv = T · V. In addition, it is good also as a point of the distance set ahead simply.
従って、前方注視点のx座標xvは、例えば、以下の(7)式で算出することができる。
xv=xi+V・(β+θ)・T
+(1/2)・((dθ/dt)+(dβ/dt))・V・T2…(7)
ここで、xiは車両の現在のx座標、(dβ/dt)は車体すべり角速度であり、例えば、以下の(8)式により算出できる。
(dβ/dt)=(Gy/V)−(dθ/dt) …(8)
そして、この車体すべり角速度(dβ/dt)を積分処理することにより、車体すべり角βが算出できる。
Accordingly, the x coordinate xv of the forward gazing point can be calculated by the following equation (7), for example.
xv = xi + V · (β + θ) · T
+ (1/2) · ((dθ / dt) + (dβ / dt)) · V · T 2 (7)
Here, xi is the current x coordinate of the vehicle, and (dβ / dt) is the vehicle slip angular velocity, which can be calculated by the following equation (8), for example.
(Dβ / dt) = (Gy / V) − (dθ / dt) (8)
The vehicle slip angle β can be calculated by integrating the vehicle slip angular velocity (dβ / dt).
また、(6)式における、xrは前方注視点のz座標における右白線のx座標であり、xlは前方注視点のz座標における左白線のx座標である。更に、wrdは過去に検出しておいた道幅、xtgtは前方注視点のz座標における先行車軌跡のx座標である。 In the equation (6), xr is the x coordinate of the right white line in the z coordinate of the forward gazing point, and xl is the x coordinate of the left white line in the z coordinate of the forward gazing point. Further, wrd is the road width detected in the past, and xtgt is the x coordinate of the preceding vehicle locus in the z coordinate of the forward gazing point.
従って、上述の(6)式における、第一項であるGfb1・(xr−xl−xv)は、図16(a)に示すように、前方注視点と左右白線の中心点とのx座標偏差の演算項となっている。また、第二項であるGfb2・((xr+xr−wrd)/2−xv)は、図16(b)に示すように、前方注視点と右白線−車線幅を基準とする走行点とのx座標偏差の演算項となっている。更に、第三項であるGfb3・((xl+xl+wrd)/2−xv)は、図16(c)に示すように、前方注視点と左白線−車線幅を基準とする走行点とのx座標偏差の演算項となっている。また、第四項であるGfb4・(xtgt−xv)は、図16(d)に示すように、前方注視点と先行車を基準とする走行点とのx座標偏差の演算項となっている。 Accordingly, Gfb1 · (xr−xl−xv), which is the first term in the above equation (6), is an x coordinate deviation between the forward gazing point and the center point of the left and right white lines, as shown in FIG. This is the operation term. The second term Gfb2 · ((xr + xr−wrd) / 2−xv) is, as shown in FIG. 16 (b), x between the front gazing point and the right white line−the running point based on the lane width. It is a calculation term for coordinate deviation. Further, the third term Gfb3 · ((xl + xl + wrd) / 2−xv) is an x-coordinate deviation between the forward gazing point and the left white line—the running point based on the lane width, as shown in FIG. This is the operation term. The fourth term Gfb4 · (xtgt−xv) is a calculation term for the x-coordinate deviation between the forward gazing point and the travel point based on the preceding vehicle, as shown in FIG. .
次に、このフィードバック制御部20cで実行されるフィードバック制御を、図14のフローチャートで説明する。
Next, feedback control executed by the
先ず、S501で、制御ゲイン設定制御部20aから制御ゲインGfb1、Gfb2、Gfb3、Gfb4を読み込む。
First, in S501, control gains Gfb1, Gfb2, Gfb3, and Gfb4 are read from the control gain
次いで、S502に進み、前方注視点のz座標zvを算出する。 Next, in S502, the z coordinate zv of the forward gazing point is calculated.
次に、S503に進み、前方注視点のx座標xvを、例えば、上述の(7)式により、算出する。 Next, proceeding to S503, the x coordinate xv of the forward gazing point is calculated by, for example, the above equation (7).
次いで、S504に進み、前方注視点における、左白線のx座標xl、右白線のx座標xr、先行車軌跡のx座標xtgtを算出する。 In step S504, the left white line x-coordinate xl, the right white line x-coordinate xr, and the x coordinate xtgt of the preceding vehicle locus at the forward gazing point are calculated.
そして、S505に進み、上述の(6)式により、フィードバック出力値Ifbを算出し、操舵トルク算出部20dに出力する。このように、フィードバック制御部20cは、フィードバック制御手段として設けられている。
Then, the process proceeds to S505, where the feedback output value Ifb is calculated by the above equation (6) and output to the steering
操舵トルク算出部20dは、フィードフォワード制御部20bからフィードフォワード出力値Iffが入力され、フィードバック制御部20cからフィードバック出力値Ifbが入力される。そして、例えば、以下の(9)式により、操舵トルクTiを算出し、モータ駆動部21に出力する。
Ti=Gt・(Iff+Ifb) …(9)
ここで、Gtは、予め設定しておいた換算係数である。
The
Ti = Gt · (Iff + Ifb) (9)
Here, Gt is a preset conversion coefficient.
以上のように構成される操舵制御部20では、図3に示すように操舵制御が実行される。
まず、S101で、制御ゲイン設定制御部20aで、前述の図4〜図12に示すフローチャートに従って、各制御ゲインGff1、Gff2、Gff3、Gff4、Gfb1、Gfb2、Gfb3、Gfb4の設定制御が行われる。
In the
First, in S101, the control gain
次いで、S102に進み、フィードフォワード制御部20bで、前述の図13に示すフローチャートに従って、フィードフォワード出力値Iffの算出が行われる。
Next, in S102, the
次に、S103に進んで、フィードバック制御部20cで、前述の図14に示すフローチャートに従って、フィードバック出力値Ifbの算出が行われる。
Next, proceeding to S103, the
そして、S104に進んで、操舵トルク算出部20dで、前述の(9)式により、操舵トルクTiが算出され、モータ駆動部21に出力される。
Then, the process proceeds to S104, where the steering
このように本発明の実施の形態によれば、左右白線の認識状態と先行車の認識状態に応じて制御ゲインを可変設定し、この可変設定された制御ゲインを用いて、前方認識装置31で認識した左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードフォワード出力値Iffとして演算し、自車両の予測される走行位置を基準とした前方認識装置31で認識した左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードバック出力値Ifbとして演算し、これらを加算した値を制御量Tiとする。このため、得られる情報を最大限に活用し、白線情報と先行車情報の双方の安定性の度合によって制御ゲインをリアルタイムに変更することで、白線が欠損、見え難くなった路面や、交差点等で白線が途切れた場合、さらには、悪天候により路面状態が悪く、安定した白線認識を行えない場合等、実際の多種多様な道路環境においても操舵支援制御を継続することができ、稼働範囲の広い使い勝手の良い運転支援装置を実現することができる。
Thus, according to the embodiment of the present invention, the control gain is variably set according to the recognition state of the left and right white lines and the recognition state of the preceding vehicle, and the
尚、本発明の実施の形態は、操舵系は通常の電動パワーステアリング装置1で構成した例で説明しているが、ステアバイワイヤ機構の操舵系でも本発明が適用できることは云うまでもない。
Although the embodiment of the present invention has been described with an example in which the steering system is configured by the normal electric
また、本発明の実施の形態は、ステレオカメラからの画像情報を用いた例で説明したが単眼カメラからの画像情報を用いるようにしても良い。 Further, although the embodiment of the present invention has been described with an example using image information from a stereo camera, image information from a monocular camera may be used.
更に、本発明の実施の形態においては、操舵制御部20の制御ゲイン設定制御部20aでの制御ゲインの変更は、ドライバに違和感のないように、ある程度、所定の時定数のフィルタを通じて遅らせる等して変更することが望ましい。
Furthermore, in the embodiment of the present invention, the control gain change in the control gain
また、本発明の実施の形態における操舵制御部20の制御ゲイン設定制御部20aの制御ゲインの設定は、あくまでも一例であり、特に、図7、図8、図9、図10、図12のフローチャートで設定される制御ゲインは、白線は検出しているが、安定した制御を行うには十分でないという状態であり、この場合の制御ゲインの大きさは、検出した白線長さlength_l、length_rや、白線と左候補点との差分の平均値err_line_l、err_line_rによって可変に設定できるようにしても良い。この場合、例えば、白線長さlength_l、length_rが長いほど対応する制御ゲインの値を大きくする、又は、白線と左候補点との差分の平均値err_line_l、err_line_rが小さいほど制御ゲインの値を大きくする。
Moreover, the setting of the control gain of the control gain
更に、特に、図7、図8、図9、図10、図12のフローチャートでは、先行車を検出していない場合においては、十分な長さのない白線のみで操舵支援制御を行うことになるため、その検出した白線長さlength_l、length_rに応じて、制御ゲインの大きさを小さくしたり、或いは、操舵支援制御の制御量が小さく(場合によっては停止させる)ようにしても良い。 Further, in particular, in the flowcharts of FIGS. 7, 8, 9, 10, and 12, when the preceding vehicle is not detected, the steering assist control is performed only with a white line that is not sufficiently long. Therefore, the magnitude of the control gain may be reduced according to the detected white line lengths length_l and length_r, or the control amount of the steering assist control may be reduced (in some cases, stopped).
また、本発明の実施の形態では、フィードフォワード制御部20bにおける制御ゲインとフィードバック制御部20cにおける制御ゲインを同じ値に設定するようにしているが、同じ値としなくても良い。例えば、フィードフォワード制御部20bにおける制御ゲインのみ可変設定し、フィードバック制御部20cの制御ゲインは一定とするようにしても良い。或いは、フィードフォワード制御部20bにおける制御ゲインの重み付けの差よりもフィードバック制御部20cにおける制御ゲインの重み付けの差を小さく(或いは、大きく)するようにする。或いは、この逆に、フィードバック制御部20cにおける制御ゲインのみ可変設定し、フィードフォワード制御部20bの制御ゲインは一定とするようにしても良い。或いは、フィードフォバック制御部20cにおける制御ゲインの重み付けの差よりもフィードフォワード制御部20bにおける制御ゲインの重み付けの差を小さく(或いは、大きく)するようにする。
Further, in the embodiment of the present invention, the control gain in the
更に、本発明の実施の形態では、フィードフォワード制御もフィードバック制御においても、制御ゲインの合計は、1.0になるように例示したが、合計は1.0でなくとも良い。 Furthermore, in the embodiment of the present invention, the sum of the control gains is exemplified to be 1.0 in both the feedforward control and the feedback control, but the sum may not be 1.0.
また、本発明の実施の形態のフィードバック制御部20cにおけるフィードバック制御を構成する(6)式は、前方注視点における二次予測制御を例に説明したが、これに限ることなく、単純な自車横位置と白線位置との差分に対する比例、微分、積分のそれぞれのフィードバック制御や、左右白線のヨー角によるフィードバック制御であっても良い。
Further, although the equation (6) constituting the feedback control in the
更に、本発明の実施の形態では、先行車と白線の認識特徴量によって、制御ゲインを変えているが、これに限ることなく、例えば、信号機、横断歩道、停止線等を検出した場合に自車両が交差点に入ったと判断し、先行車に対する制御ゲインを高め、白線に対する制御ゲインを下げるようにしても良い。 Furthermore, in the embodiment of the present invention, the control gain is changed according to the recognition feature amount of the preceding vehicle and the white line. However, the present invention is not limited to this. For example, when a traffic light, a pedestrian crossing, a stop line, etc. are detected It may be determined that the vehicle has entered an intersection, the control gain for the preceding vehicle is increased, and the control gain for the white line may be decreased.
1 電動パワーステアリング装置
4 ステアリングホイール
10L、10R 車輪
12 電動モータ
20 操舵制御部(操舵制御手段)
20a 制御ゲイン設定制御部(制御ゲイン設定手段)
20b フィードフォワード制御部(フィードフォワード制御手段)
20c フィードバック制御部(フィードバック制御手段)
20d 操舵トルク算出部
21 モータ駆動部
31 前方認識装置(前方環境認識手段)
32 車速センサ
33 ヨーレートセンサ
34 横加速度センサ
DESCRIPTION OF
20a Control gain setting control unit (control gain setting means)
20b Feed forward control unit (feed forward control means)
20c Feedback control unit (feedback control means)
20d Steering
32
Claims (8)
上記操舵制御手段は、
上記前方環境認識手段で認識した左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードフォワード出力値として演算するフィードフォワード制御手段と、
自車両の予測される走行位置を基準とした上記前方環境認識手段で認識した左右白線の認識形状と先行車の走行軌跡に応じた出力値をフィードバック出力値として演算するフィードバック制御手段の少なくとも一方を有し、
上記フィードフォワード出力値の演算における各演算項の重み付けと上記フィードバック出力値の演算における各演算項の重み付けの少なくとも一方を決定する制御ゲインを左右白線の認識状態と先行車の認識状態に応じて可変設定する制御ゲイン設定手段を備えたことを特徴とする車両の運転支援装置。 In a vehicle driving support device comprising a front environment recognition means for recognizing a front left and right white line and a preceding vehicle, and a steering control means for setting a steering angle independently of a driver input,
The steering control means includes
Feedforward control means for calculating an output value corresponding to the recognized shape of the left and right white lines recognized by the front environment recognition means and the traveling locus of the preceding vehicle as a feedforward output value;
At least one of feedback control means for calculating, as a feedback output value, a recognized shape of the left and right white lines recognized by the front environment recognition means based on the predicted traveling position of the host vehicle and an output value corresponding to the traveling locus of the preceding vehicle. Have
The control gain for determining at least one of the weight of each calculation term in the calculation of the feedforward output value and the weight of each calculation term in the calculation of the feedback output value is variable according to the recognition state of the left and right white lines and the recognition state of the preceding vehicle A vehicle driving support apparatus comprising control gain setting means for setting.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012077041A JP5969791B2 (en) | 2012-03-29 | 2012-03-29 | Vehicle driving support device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012077041A JP5969791B2 (en) | 2012-03-29 | 2012-03-29 | Vehicle driving support device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2013203340A true JP2013203340A (en) | 2013-10-07 |
JP5969791B2 JP5969791B2 (en) | 2016-08-17 |
Family
ID=49522888
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2012077041A Active JP5969791B2 (en) | 2012-03-29 | 2012-03-29 | Vehicle driving support device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5969791B2 (en) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015123929A (en) * | 2013-12-27 | 2015-07-06 | 富士重工業株式会社 | Vehicle lane keep control device |
JP2016101783A (en) * | 2014-11-27 | 2016-06-02 | トヨタ自動車株式会社 | Deviation determination apparatus |
JP6012824B1 (en) * | 2015-08-10 | 2016-10-25 | 三菱電機株式会社 | Vehicle steering apparatus and vehicle steering control method |
JP2017105250A (en) * | 2015-12-07 | 2017-06-15 | 株式会社Subaru | Vehicle traveling control device |
JP2018024344A (en) * | 2016-08-10 | 2018-02-15 | 株式会社Subaru | Travelling control device of vehicle |
JP2020132044A (en) * | 2019-02-22 | 2020-08-31 | 株式会社ショーワ | Steering control device, steering device and vehicle |
CN113167584A (en) * | 2018-11-23 | 2021-07-23 | 采埃孚股份公司 | Method and system for providing transformation parameters |
JP2021177135A (en) * | 2020-05-07 | 2021-11-11 | 株式会社トヨタマップマスター | Information processing device, information processing method and information processing program |
JP2021177136A (en) * | 2020-05-07 | 2021-11-11 | 株式会社トヨタマップマスター | Information processing device, information processing method and information processing program |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005140749A (en) * | 2003-11-10 | 2005-06-02 | Toyota Motor Corp | Curve-estimating apparatus and travel control apparatus using the same |
JP2008049918A (en) * | 2006-08-25 | 2008-03-06 | Toyota Motor Corp | Vehicle controller, and display device for vehicle |
JP2009252198A (en) * | 2008-04-11 | 2009-10-29 | Suzuki Motor Corp | Travel environment presuming device, method and program, and traffic lane deviation alarm device and steering assisting apparatus |
JP2010036755A (en) * | 2008-08-06 | 2010-02-18 | Fuji Heavy Ind Ltd | Steering support device |
JP2011258131A (en) * | 2010-06-11 | 2011-12-22 | Fuji Heavy Ind Ltd | White line recognition apparatus for vehicle |
-
2012
- 2012-03-29 JP JP2012077041A patent/JP5969791B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005140749A (en) * | 2003-11-10 | 2005-06-02 | Toyota Motor Corp | Curve-estimating apparatus and travel control apparatus using the same |
JP2008049918A (en) * | 2006-08-25 | 2008-03-06 | Toyota Motor Corp | Vehicle controller, and display device for vehicle |
JP2009252198A (en) * | 2008-04-11 | 2009-10-29 | Suzuki Motor Corp | Travel environment presuming device, method and program, and traffic lane deviation alarm device and steering assisting apparatus |
JP2010036755A (en) * | 2008-08-06 | 2010-02-18 | Fuji Heavy Ind Ltd | Steering support device |
JP2011258131A (en) * | 2010-06-11 | 2011-12-22 | Fuji Heavy Ind Ltd | White line recognition apparatus for vehicle |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015123929A (en) * | 2013-12-27 | 2015-07-06 | 富士重工業株式会社 | Vehicle lane keep control device |
JP2016101783A (en) * | 2014-11-27 | 2016-06-02 | トヨタ自動車株式会社 | Deviation determination apparatus |
JP6012824B1 (en) * | 2015-08-10 | 2016-10-25 | 三菱電機株式会社 | Vehicle steering apparatus and vehicle steering control method |
JP2017105250A (en) * | 2015-12-07 | 2017-06-15 | 株式会社Subaru | Vehicle traveling control device |
JP2018024344A (en) * | 2016-08-10 | 2018-02-15 | 株式会社Subaru | Travelling control device of vehicle |
CN113167584A (en) * | 2018-11-23 | 2021-07-23 | 采埃孚股份公司 | Method and system for providing transformation parameters |
JP2020132044A (en) * | 2019-02-22 | 2020-08-31 | 株式会社ショーワ | Steering control device, steering device and vehicle |
JP7265372B2 (en) | 2019-02-22 | 2023-04-26 | 日立Astemo株式会社 | Steering control device, steering device, and vehicle |
JP2021177135A (en) * | 2020-05-07 | 2021-11-11 | 株式会社トヨタマップマスター | Information processing device, information processing method and information processing program |
JP2021177136A (en) * | 2020-05-07 | 2021-11-11 | 株式会社トヨタマップマスター | Information processing device, information processing method and information processing program |
Also Published As
Publication number | Publication date |
---|---|
JP5969791B2 (en) | 2016-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5969791B2 (en) | Vehicle driving support device | |
JP5798658B1 (en) | Vehicle lane departure prevention control device | |
JP6025273B2 (en) | Vehicle travel control device | |
JP5936281B2 (en) | Vehicle lane departure prevention control device | |
US9174674B2 (en) | Parking assisting apparatus | |
JP4647201B2 (en) | Vehicle travel control device | |
US9233711B2 (en) | Lane keeping control device of vehicle | |
JP5167051B2 (en) | Vehicle driving support device | |
JP5743286B2 (en) | Vehicle driving support device | |
JP5947849B2 (en) | Vehicle lane departure prevention control device | |
JP6763327B2 (en) | Collision avoidance device | |
CN104276206A (en) | Driving assist controller for vehicle | |
JP6327701B2 (en) | Vehicle lane departure prevention control device | |
JP2007290558A (en) | Parking support device and parking support method | |
JP6831734B2 (en) | Vehicle travel control device | |
JP2008168784A (en) | Travel control device for vehicle | |
JP6595852B2 (en) | Vehicle driving support device | |
JP7315039B2 (en) | How to find an avoidance route for a car | |
JP2012046143A (en) | Target trajectory calculation device | |
JP6626293B2 (en) | Vehicle driving support device | |
JP6317972B2 (en) | Vehicle lane departure prevention control device | |
JP5859741B2 (en) | Driving assistance device | |
JP6338417B2 (en) | Vehicle lane departure prevention control device | |
JP6068185B2 (en) | Vehicle driving support device | |
JP2020184135A (en) | Pedestrian position prediction method and pedestrian position prediction device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20150220 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20151217 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20151222 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160120 |
|
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: 20160614 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20160708 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5969791 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
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 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |