JP2005170327A - Automatic steering control device for vehicle - Google Patents
Automatic steering control device for vehicle Download PDFInfo
- Publication number
- JP2005170327A JP2005170327A JP2003416784A JP2003416784A JP2005170327A JP 2005170327 A JP2005170327 A JP 2005170327A JP 2003416784 A JP2003416784 A JP 2003416784A JP 2003416784 A JP2003416784 A JP 2003416784A JP 2005170327 A JP2005170327 A JP 2005170327A
- Authority
- JP
- Japan
- Prior art keywords
- gazing point
- vehicle
- point
- forward gazing
- road radius
- 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
- 238000012937 correction Methods 0.000 claims description 37
- 230000001133 acceleration Effects 0.000 claims description 25
- 238000001514 detection method Methods 0.000 claims description 7
- 238000000034 method Methods 0.000 description 32
- 238000010586 diagram Methods 0.000 description 9
- 238000012545 processing Methods 0.000 description 9
- 230000000694 effects Effects 0.000 description 5
- NCGICGYLBXGBGN-UHFFFAOYSA-N 3-morpholin-4-yl-1-oxa-3-azonia-2-azanidacyclopent-3-en-5-imine;hydrochloride Chemical compound Cl.[N-]1OC(=N)C=[N+]1N1CCOCC1 NCGICGYLBXGBGN-UHFFFAOYSA-N 0.000 description 2
- 235000002597 Solanum melongena Nutrition 0.000 description 2
- 244000061458 Solanum melongena Species 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
Images
Landscapes
- Power Steering Mechanism (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
Description
本発明は、車両の自動操舵を行う車両用自動操舵制御装置に関する。 The present invention relates to an automatic steering control device for a vehicle that performs automatic steering of the vehicle.
車両用自動操舵制御装置として、既知の経路と現在の車両の位置との照合を逐一行うことでトレースする装置が提案されている。例えば特許文献1で開示されている技術では、車両の位置と経路との誤差を検出するために2つの注視点を設けるようにして、車速が高くなればなるほどそれらの注視点を遠くに設定するようにしている。これにより、運転者の感覚に近づけた自動操舵を可能にしている。
このような従来の車両用自動操舵制御装置にあっては、減速してカーブに進入する場合でも、カーブ直前でまだ車速が高ければ前方注視点距離が長く保たれたままとなる。この場合、カーブ直前で設定される前方注視点がカーブ内において本来通過できないぐらい小さい曲率半径R地点まで延長されてしまうことがあり、この結果、必要以上に大きな操舵量が指令されることになる。このような処理が行われた場合に、減速して適切な車速でカーブに進入し、その車速に対応して前方注視点距離も当該カーブに合った長さになったとき、自動操舵制御のための操舵制御量が急変することになる。このように操舵制御量が急変してしまうと、その直前まで行った自動操舵制御が無駄となり、また自動操舵がスムーズでなくなってしまう。
本発明は、前述の問題に鑑みてなされたものであり、カーブ進入前後で円滑に操舵制御を行うことができる車両用自動操舵制御装置の提供を目的とする。
In such a conventional automatic steering control device for a vehicle, even when decelerating and entering a curve, if the vehicle speed is still high immediately before the curve, the front gazing point distance remains long. In this case, the forward gazing point set immediately before the curve may be extended to a radius of curvature R that is so small that it cannot pass through the curve. As a result, an unnecessarily large steering amount is commanded. . When such processing is performed, when the vehicle decelerates and enters the curve at an appropriate vehicle speed, and the front gaze distance becomes the length that matches the curve corresponding to the vehicle speed, the automatic steering control Therefore, the amount of steering control for this will change suddenly. If the steering control amount changes abruptly in this way, the automatic steering control performed immediately before is wasted, and the automatic steering is not smooth.
The present invention has been made in view of the above-described problems, and an object thereof is to provide an automatic steering control device for a vehicle that can smoothly perform steering control before and after entering a curve.
請求項1記載の車両用自動操舵制御装置は、自車両前方に設定する前方注視点を自車速が大きくなるほど自車両から遠方に設定し、その前方注視点と走行目標経路をなす基準経路との誤差に基づいて操舵量を算出する車両用自動操舵制御装置である。この車両用自動操舵制御装置は、カーブ手前で設定した前方注視点に基づく前記誤差を、当該カーブに進入した際に設定する前方注視点に基づく前記誤差に近くなるように補正する。 The automatic steering control device for a vehicle according to claim 1 sets a forward gazing point set ahead of the host vehicle to a position farther from the host vehicle as the host vehicle speed increases, and the forward gazing point and a reference route that forms a travel target route An automatic steering control device for a vehicle that calculates a steering amount based on an error. The automatic steering control device for a vehicle corrects the error based on the forward gazing point set in front of the curve so as to be close to the error based on the forward gazing point set when entering the curve.
また、請求項2記載の車両用自動操舵制御装置は、自車両前方に前方注視点を設定し、その前方注視点と走行目標経路をなす基準経路との誤差に基づいて操舵量を算出する車両用自動操舵制御装置である。この車両用自動操舵制御装置は、前記前方注視点を自車速が高くなるほど自車両から遠方に前方注視点設定手段により設定し、前記前方注視点設定手段が設定した前方注視点と前記基準経路との前記誤差を誤差検出手段により検出し、少なくともカーブに進入する手前でカーブ路内の所定の位置における前記基準経路との誤差が小さくなるように誤差補正手段により補正し、前記誤差補正手段が補正した誤差に基づいて、前記基準経路に沿って自車両が走行するように当該自車両の操舵量を操舵量算出手段により算出する。 According to a second aspect of the present invention, there is provided a vehicle automatic steering control device that sets a front gazing point in front of the host vehicle and calculates a steering amount based on an error between the front gazing point and a reference route that forms a travel target route. This is an automatic steering control device. The vehicle automatic steering control device sets the forward gazing point farther from the host vehicle by the forward gazing point setting means as the host vehicle speed increases, and the forward gazing point set by the front gazing point setting means and the reference route The error is detected by the error detection means, and is corrected by the error correction means so that the error with respect to the reference path at a predetermined position in the curve road is reduced at least before entering the curve, and the error correction means corrects the error. Based on the error, the steering amount calculation unit calculates the steering amount of the host vehicle so that the host vehicle travels along the reference route.
本発明によれば、カーブ手前で設定した前方注視点に基づく誤差を、当該カーブに進入した際に設定する前方注視点に基づく誤差に近くなるように補正することで、カーブ進入前後で円滑に操舵制御を行うことができる。 According to the present invention, the error based on the forward gazing point set in front of the curve is corrected so as to be close to the error based on the forward gazing point set when entering the curve, so that before and after the curve approach smoothly. Steering control can be performed.
本発明を実施するための最良の形態(以下、実施形態という。)を図面を参照しながら詳細に説明する。
図1は、本発明の第1の実施形態を示す概略構成図であり、図中、1FL、1FR、1RL及び1RRはそれぞれ左前輪、右前輪、左後輪及び右後輪である。後輪1RL及び1RRは、エンジン2の駆動力が自動変速機3、プロペラシャフト4、最終減速装置5及び車軸6を順番に介して伝達される駆動輪である。また、前輪1FL及び1FRは、ステアリングギヤ7及びステアリングシャフト8を介してステアリングホイール9に連結された操舵輪である。ステアリングシャフト8には、電動モータで構成された操舵アクチュエータ10が連結されている。操舵アクチュエータ10は、コントローラ17から出力される操舵制御量δCに応じて、前輪1FL及び1FRの操舵方向、操舵角及び操舵速度を制御するように構成されている。
The best mode for carrying out the present invention (hereinafter referred to as an embodiment) will be described in detail with reference to the drawings.
FIG. 1 is a schematic configuration diagram showing a first embodiment of the present invention, where 1FL, 1FR, 1RL and 1RR are a left front wheel, a right front wheel, a left rear wheel and a right rear wheel, respectively. The rear wheels 1RL and 1RR are drive wheels through which the driving force of the
また、車両には、各車輪1FL〜1RRの回転速度に応じた周波数の車輪速VFL〜VRRを出力する車輪速センサ11FL〜11RRが搭載されている。また、車両には、前後加速度Xgを検出する前後加速度センサ12と、横加速度Ygを検出する横加速度センサ13と、ヨーレートφを検出するヨーレートセンサ14とが搭載されている。また、車両には、人工衛星から送られる衛星電波を受信して現在の自車位置を検出するGPS(GlobalPositioning System)15と、所定領域の道路地図情報を記憶したCD−ROMやDVD−ROM等の情報記憶媒体が装着された記憶ユニット16とが搭載されている。
Further, the vehicle is equipped with wheel speed sensors 11FL to 11RR that output wheel speeds VFL to VRR having frequencies corresponding to the rotational speeds of the wheels 1FL to 1RR. The vehicle is also equipped with a
前述の各車輪速センサ11FL〜11RRで検出する車輪速VFL〜VRRと、前後加速度センサ12で検出される前後加速度Xgと、横加速度センサ13で検出される横加速度Ygと、GPS15で検出する自車位置情報と、記憶ユニット16に記憶された道路地図情報とが、例えばマイクロコンピュータで構成されたコントローラ17に入力される。 コントローラ17は、操舵制御処理を常時実行することで前述した操舵アクチュエータ10に対する操舵制御量δCの出力を制御し、自動操舵により自車両を、走行目標経路をなす基準経路に沿って走行させるように構成されている。図2は操舵制御処理の内容を示す。
The wheel speeds VFL to VRR detected by the wheel speed sensors 11FL to 11RR described above, the longitudinal acceleration Xg detected by the
先ずステップS1において、コントローラ17は、GPS15で検出した自車位置に従って記憶ユニット16に記憶されている道路地図情報を読込む。道路地図情報は、道路形状を複数のノードデータ(X,Y)として表す情報である。そして、コントローラ17は、その読み込んだ道路地図情報を構成するノードデータ(X,Y)のうち、図3に示すように、自車両100の現在位置を基準に、前後の所定距離の範囲内の(n+1)個のノードデータ(X0,Y0)〜(Xn,Yn)を常時バッファに保有する。これらノードデータ(X0,Y0)〜(Xn,Yn)の座標を結べば基準経路の形状になる。
First, in step S1, the
また、車両の前方側の前記所定距離については、例えば車速Vcに所定時間t1を乗じて得た値(Vc×t1)と予め得ている最小値(既定値)のうち大きい方に設定する。
続いてステップS2において、コントローラ17は、各種センサから出力される各車輪速VFL〜VRR、前後加速度Xg、横加速度Yg及びヨーレートφを読込む。
続いてステップS3において、コントローラ17は、各車輪速VFL〜VRRの平均から車速Vcを算出する。
Further, the predetermined distance on the front side of the vehicle is set to, for example, a larger one of a value (Vc × t1) obtained by multiplying the vehicle speed Vc by a predetermined time t1 and a minimum value (predetermined value) obtained in advance.
Subsequently, in step S2, the
Subsequently, in step S3, the
続いてステップS4において、コントローラ17は、前記ステップS3で算出した車速Vcとカーブで許容する横G値Yg_limitとに基づいて、車両が通過可能な道路半径(以下、通過可能道路半径という。)Rn_limitを算出する。例えば下記(1)式により算出する。
Rn_limit=Vc2/Yg_limit ・・・(1)
ここで、横G値Yg_limitは固定値である。例えば、横G値Yg_limitを0.3にする。
続いてステップS5において、コントローラ17は、運転者が注視していると見込まれる車両前方に前方注視点(FB(フィードバック)注視点ともいう、以下、第1前方注視点という。)P1を設定する。例えば図4に示すように、車速Vcが高くなるほど大きくなるような前方注視点距離(以下、第1前方注視点距離という。)D1に、第1前方注視点P1を設定する。
Subsequently, in step S4, the
Rn_limit = Vc 2 / Yg_limit (1)
Here, the lateral G value Yg_limit is a fixed value. For example, the lateral G value Yg_limit is set to 0.3.
In step S5 Subsequently, the
続いてステップS6において、コントローラ17は、前記ステップS5で設定した第1前方注視点P1における道路半径(以下、第1前方注視点位置道路半径という。)Rn_roadを算出する。具体的には以下の手順で算出する。図5を用いて説明する。
先ず、図5に示すように、第1前方注視点P1から前後方向の所定距離DSにあるノードをPF(以下、前直近ノードPFという。)及びPR(以下、後直近ノードPRという。)を選定する。
ここで、所定距離DSは、車速Vcに例えば一定時間(例えば1秒程度)t2を乗じて得た値(Vc×t2)である。なお、所定距離DSが短くなりすぎないように、最小値DMINを用意しておいて、この最小値DMINと前記車速V及び一定時間t2に基づいて算出する値(DS=V×t2)のうち大きい方を、最終的な所定距離DSに設定してもよい。
Subsequently, in step S6, the
First, as shown in FIG. 5, nodes located at a predetermined distance D S in the front-rear direction from the first forward gazing point P 1 are P F (hereinafter referred to as the most recent node P F ) and P R (hereinafter referred to as the most recent node). that P R.) to select the.
Here, the predetermined distance D S is the vehicle speed Vc, for example, a predetermined time (for example, about 1 second) value obtained by multiplying t2 (Vc × t2). Note that, as a predetermined distance D S is not too short, the minimum value in advance to prepare the D MIN, the value (D S = V × be calculated on the basis of this minimum value D MIN to the vehicle speed V and the predetermined time t2 the larger of t2), it may be set to the final predetermined distance D S.
続いて、第1前方注視点P1と前直近ノードPFを結ぶ線分P1PRと、第1前方注視点P1と後直近ノードPFとを結ぶ線分P1PFとがなす角度θ、及び前直近ノードPFと後直近ノードPRとの距離dを算出する。
なお、ここでノードとの対比でいう第1前方注視点P1とは、具体的には、第1前方注視点P1に対応するノードである。すなわち、第1前方注視点P1を通り、自車両の速度ベクトルVに直角な直線を描いた場合に、その直線と基準経路との交点Q或いはその交点Qから最も近傍のノードを、ここでは第1前方注視点P1といっている。よって、道路半径を算出する等のためにノードと対比する以外は、第1前方注視点P1は、ノードをいうものではなく、実際の基準経路からずれた位置に設定される第1前方注視点P1をいうものとする。以下の説明でもこのような関係は同様にして扱うものとする。
Subsequently, the line segment P 1 P R connecting the front nearest node P F and the first forward fixed point P 1, and the line segment P 1 P F connecting the rear nearest node P F first and forward fixed point P 1 angle theta, and calculates the distance d between the front nearest node P F and the rear nearest node P R.
Here, the first forward gazing point P 1 in comparison with the node is specifically a node corresponding to the first forward gazing point P 1 . That is, when a straight line that passes through the first forward gazing point P 1 and is perpendicular to the speed vector V of the host vehicle is drawn, the intersection Q between the straight line and the reference route or the nearest node from the intersection Q is the first is to say that the forward gaze point P 1. Therefore, the first forward gazing point P 1 is not a node, but is compared with a node for the purpose of calculating a road radius, etc., and the first forward gazing point set at a position shifted from the actual reference route. it is assumed that refers to the point of view P 1. In the following description, such a relationship is handled in the same manner.
ここで、前直近ノードPF、第1前方注視点P1及び後直近ノードPRを通る円弧の中心点Oは、線分P1PFの中点aを通る垂直2等分線Aと、線分P1PRの中点bを通る垂直2等分線Bとの交点となる。このようなことから、前記角度θは、線分P1PFの中点aを通る垂直2等分線Aと線分P1PRの中点bを通る垂直2等分線Bとがなす∠aObの角度として得られる。
そして、前直近ノードPFと中心点Oとがなす線分PFOと後直近ノードPRと中心点Oとがなす線分PROとがなす∠PFOPRの角度は、前記∠aObの角度θの2倍になる。
以上のような関係から、下記(2)式を用いて、角度θ及び距離dに基づいて第1前方注視点位置道路半径Rn_roadを算出できる。
Rn_road=d/2×sinθ ・・・(2)
Here, before the nearest node P F, the center point O of the arc through the first forward observation point P 1 and the rear nearest node P R has a vertical bisector A which passes through the middle point a of the line segment P 1 P F , the intersection of the vertical bisector B passing through the middle point b of the line segment P 1 P R. For this reason, the angle θ is, the vertical bisector B passing through the middle point b of the line segment P 1 P perpendicular bisector passing through the midpoint a of F A and the line segment P 1 P R It is obtained as the angle of eggplant aOb.
Then, the angle of the pre-nearest node P F and the line segment formed by the center O P F O and the rear nearest node P line R and a center point O forms P R O and forms ∠P F OP R, the It becomes twice the angle θ of ∠aOb.
From the above relationship, the first forward gazing point position road radius Rn_road can be calculated based on the angle θ and the distance d using the following equation (2).
Rn_road = d / 2 × sinθ (2)
続いてステップS7において、コントローラ17は、前記ステップS4で算出した通過可能道路半径Rn_limitと前記ステップS6で算出した第1前方注視点位置道路半径Rn_roadとを比較して、第1前方注視点P1を補正する。
具体的には、通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとの比較結果に基づいて、第1前方注視点P1の位置を補正した前方注視点(以下、補正後第1前方注視点という。)P1’を算出する。より具体的には、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合で(Rn_limit<Rn_road)、かつ基準経路における通過可能道路半径Rn_limitに対応する前方注視点設定限界点P_limit(自車両と第1前方注視点P1とを含む線上の点、以下同様。)を仮定し、その前方注視点設定限界点P_limitよりも第1前方注視点距離D1を基に設定した第1前方注視点P1が自車両から遠方にある場合、補正後第1前方注視点P1’を前方注視点設定限界点P_limitに設定する(P1’=P_limit)。
Subsequently, in step S7, the
Specifically, based on the comparison result between the passable road radius Rn_limit and the first forward gazing point position road radius Rn_road, the forward gazing point (hereinafter referred to as the corrected first gazing point P1) corrected for the position of the first forward gazing point P1. This is called forward gaze point.) P 1 ′ is calculated. More specifically, when the passable road radius Rn_limit is less than the first forward watch point position road radius Rn_road (Rn_limit <Rn_road), the forward watch point setting limit point P_limit corresponding to the passable road radius Rn_limit in the reference route (point of the vehicle and the line containing the first and forward fixed point P 1, the same applies hereinafter.) assuming the first set based on a first look-ahead point distance D1 above its forward fixed point setting limit point P_limit When the forward gazing point P 1 is far from the host vehicle, the corrected first gazing point P 1 ′ is set as the forward gazing point setting limit point P_limit (P 1 ′ = P_limit).
それ以外の場合、補正後第1前方注視点P1’を第1前方注視点P1に設定する(P1’=P1)。すなわち、第1前方注視点P1の補正を行わない。例えば、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合(Rn_limit<Rn_road)であっても、第1前方注視点P1よりも前方注視点設定限界点P_limitが自車両から遠方にある場合、補正後第1前方注視点P1’を第1前方注視点P1に設定する(P1’=P1)。
これにより、図6に示すように、自車両100の前方に補正後第1前方注視点P1’を設定する。
In other cases, the corrected first forward gazing point P 1 ′ is set to the first forward gazing point P 1 (P 1 ′ = P 1 ). That does not perform a first correction of the forward fixed point P 1. For example, even if the passable road radius Rn_limit is less than the first forward gaze point position road radius Rn_road (Rn_limit <Rn_road), forward fixed point setting limit points P_limit than the first headway point P 1 from the vehicle If it is far away, the corrected first forward gazing point P 1 ′ is set to the first forward gazing point P 1 (P 1 ′ = P 1 ).
Thereby, as shown in FIG. 6, the corrected first forward gazing point P 1 ′ is set in front of the
続いてステップS8において、コントローラ17は、前記ステップS7で得た補正後第1前方注視点P1’について横偏差YEを算出する。具体的には以下の手順で算出する。
先ず、車両のスリップ角θSを算出する。具体的には、下記(3)式により、前後加速度Xg及び横加速度Ygに基づいて車両のスリップ角θSを算出する。
θS=tan−1(Yg/Xg) ・・・(3)
また、図6に示すように、ヨー角ε1及びずれ角εTを定義する。ヨー角ε1は、基準座標に対する自車両100のヨー角となる。また、ずれ角εTは、補正後第1前方注視点P1’を通り自車両100の速度ベクトルVに直角な直線Cを描き、その直線Cと基準経路との交点Qでの基準座標に対する基準経路のずれ角となる。
Subsequently, in step S8, the
First, the vehicle slip angle θ S is calculated. Specifically, the slip angle θ S of the vehicle is calculated based on the longitudinal acceleration Xg and the lateral acceleration Yg by the following equation (3).
θ S = tan −1 (Yg / Xg) (3)
Further, as shown in FIG. 6, a yaw angle ε 1 and a deviation angle ε T are defined. The yaw angle ε 1 is the yaw angle of the
そして、このように定義した前記ヨー角ε1及びずれ角εTに基づいて、下記(4)式によりヨー角εRを算出する。
εR=εT−ε1 ・・・(4)
また、図6に示すように、基準経路と自車両100の現在走行位置との横偏差をYU、車両姿勢に応じた横偏差YS、及び補正後第1前方注視点P1’までの距離D1’を定義する。そして、横偏差YU、補正後第1前方注視点P1’までの距離D1’、ヨー角εR及びスリップ角θSに基づいて下記(5)式により横偏差YSを算出する。
YS=YU+D1’×tan(εR+θS) ・・・(5)
Then, based on the yaw angle ε 1 and the deviation angle ε T defined as above, the yaw angle ε R is calculated by the following equation (4).
ε R = ε T −ε 1 (4)
Further, as shown in FIG. 6, the lateral deviation between the reference route and the current traveling position of the
Y S = Y U + D1 ′ × tan (ε R + θ S ) (5)
また、車両が定常円旋回を行っていると仮定する。このように仮定した場合、スリップレートを無視できるので、車両旋回状態から求まる横偏差YPを下記(6)式により算出する。
YP=D1’×tanβ ・・・(6)
ここで、βは下記(7)式で表される。
β=1/2×sin−1(D1’×ε1/Xg) ・・・(7)
そして、下記(8)式に示すように、横偏差YSと横偏差YPとを加算して基準経路との横偏差YEを算出する。
YE=YS+YP ・・・(8)
このように、補正後第1前方注視点P1’における基準経路との横偏差YEを算出する。
It is also assumed that the vehicle is making a steady circular turn. Assuming this way, it is possible to ignore the slip rate to calculate the lateral deviation Y P obtained from the vehicle turning state by the following equation (6).
Y P = D1 ′ × tan β (6)
Here, β is expressed by the following equation (7).
β = 1/2 × sin −1 (D1 ′ × ε 1 / Xg) (7)
Then, as shown in the following equation (8), by adding the lateral deviation Y S and the lateral deviation Y P by calculating the lateral deviation Y E of the reference path.
Y E = Y S + Y P (8)
In this way, the lateral deviation Y E from the reference route at the corrected first forward gazing point P 1 ′ is calculated.
続いてステップS9において、コントローラ17は、前記ステップS8で算出した横偏差YEに基づいて、下記(9)式により第1操舵量δ1を算出する。
δ1=K1×YE+K2×(dYE/dt) ・・・(9)
ここで、K1,K2は係数である。例えば、K1,K2は、直線走行時の外乱に対して追従誤差が拡大しないように最適な値として、実験により求められることが望ましい。
続いてステップS10において、コントローラ17は、前記ステップS9で算出した第1操舵量δ1を最終的な操舵制御量δCとして、操舵アクチュエータ10に出力する。これにより、補正後第1前方注視点P1’において自車両が基準経路に沿って走行することになるように操舵制御される。
以上がコントローラ17による操舵制御処理になる。
Subsequently, in Step S9, the
δ1 = K1 × Y E + K2 × (dY E / dt) (9)
Here, K1 and K2 are coefficients. For example, it is desirable that K1 and K2 are obtained by experiments as optimum values so that the follow-up error does not increase with respect to disturbance during straight running.
Subsequently, in step S10, the
The above is the steering control process by the
すなわち、自車両100の位置を基準に、前後の所定距離の範囲内のノードデータ(X0,Y0)〜(Xn,Yn)を記憶し、また、各車輪速VFL〜VRR、前後加速度Xg、横加速度Yg及びヨーレートφを読込み、さらに、車速Vcを算出する(ステップS1〜ステップS3)。そして、算出した車速Vcとカーブで許容する横G値Yg_limitとに基づいて通過可能道路半径Rn_limitを算出する(ステップS4)。
続いて、車速Vcに応じて第1前方注視点P1を設定し、その第1前方注視点P1における第1前方注視点位置道路半径Rn_roadを算出する(ステップS5、ステップS6)。
That is, node data (X 0 , Y 0 ) to (X n , Y n ) within a predetermined distance range are stored based on the position of the
Then, first set the forward gaze point P 1 in accordance with the vehicle speed Vc, calculates a first forward gaze point position road radius Rn_road at the first forward observation point P 1 (step S5, step S6).
続いて、通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとを比較して、補正後の補正後第1前方注視点P1’を得る(ステップS7)。具体的には、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合で(Rn_limit<Rn_road)、かつ前方注視点設定限界点P_limitよりも第1前方注視点P1が自車両から遠方にある場合、補正後第1前方注視点P1’を前方注視点設定限界点P_limitに設定する(P1’=P_limit)。それ以外の場合、補正後第1前方注視点P1’を第1前方注視点P1に設定する(P1’=P1)。 Subsequently, the passable road radius Rn_limit and the first forward gazing point position road radius Rn_road are compared to obtain a corrected first forward gazing point P 1 ′ after correction (step S7). Specifically, when the passable road radius Rn_limit is less than the first forward gazing point position road radius Rn_road (Rn_limit <Rn_road), the first forward gazing point P 1 is more than the forward gazing point setting limit point P_limit. In the case of being far from the position, the corrected first forward gazing point P 1 ′ is set as the forward gazing point setting limit point P_limit (P 1 ′ = P_limit). In other cases, the corrected first forward gazing point P 1 ′ is set to the first forward gazing point P 1 (P 1 ′ = P 1 ).
そして、その補正後第1前方注視点P1’における基準経路との横偏差YEを算出し、算出した横偏差YEに応じた第1操舵量δ1を得て、その第1操舵量δ1を操舵制御量δCとして、操舵アクチュエータ10に出力する(ステップS8〜ステップS10)。
そして、コントローラ17は、所定の時間間隔でこの処理を繰り返して行っており、すなわち、所定の時間間隔で逐次操舵制御量δCを得て、その得た操舵制御量δCを操舵アクチュエータ10に出力している。これにより、補正後第1前方注視点P1’において自車両が基準経路に沿って走行することになるように操舵制御される。
Then, a lateral deviation Y E from the reference route at the corrected first forward gazing point P 1 ′ is calculated, a first steering amount δ1 corresponding to the calculated lateral deviation Y E is obtained, and the first steering amount δ1 is obtained. Is output to the
The
次に第1の実施形態における効果を説明する。
前述したように、補正後第1前方注視点P1’における基準経路に沿って走行することになるように操舵制御しており、その補正後第1前方注視点P1’は、通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとの比較結果に基づいて得ている(前記ステップS7)。すなわち、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合で(Rn_limit<Rn_road)、かつ前記前方注視点設定限界点P_limitよりも第1前方注視点P1が自車両から遠方にある場合、補正後第1前方注視点P1’を前方注視点設定限界点P_limitに設定している。それ以外の場合、補正後第1前方注視点P1’を第1前方注視点P1に設定する、すなわち第1前方注視点P1の補正を行わない。具体的には、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合(Rn_limit<Rn_road)であっても、第1前方注視点P1よりも前方注視点設定限界点P_limitが自車両から遠方にある場合、第1前方注視点P1を補正後第1前方注視点P1’として、第1前方注視点P1をそのまま用いている。
Next, effects of the first embodiment will be described.
As described above, 'has been steering control so as to travel along a reference path in its corrected first forward gaze point P 1' first forward observation point P 1 after correction passable road This is obtained based on the comparison result between the radius Rn_limit and the first forward gazing point position road radius Rn_road (step S7). That is, if passable road radius Rn_limit is less than the first forward gaze point position road radius Rn_road (Rn_limit <Rn_road), and said first forward gaze point P 1 than forward fixed point setting limit point P_limit is far from the vehicle In this case, the corrected first forward gazing point P 1 ′ is set as the forward gazing point setting limit point P_limit. Otherwise, the first forward observation point P 1 'is set to the first forward fixed point P 1 after correction, that is not carried out first correction of forward fixed point P 1. Specifically, even if passable road radius Rn_limit is less than the first forward gaze point position road radius Rn_road (Rn_limit <Rn_road), the forward fixed point setting limit points P_limit than the first headway point P 1 when in the distant from the vehicle, the first front watch point P 1 as the first forward observation point P 1 'after correction, and using the first forward observation point P 1 as it is.
ここで、前述したように、第1前方注視点距離D1又は第1前方注視点P1は、車速Vcに応じて決定しており、具体的には車速Vcが高くなるほど遠方になるようにしている。すなわち、第1前方注視点距離D1又は第1前方注視点P1は、従来の手法と同様に車速Vcに応じて決定している。一方、前述したように、通過可能道路半径Rn_limitは、車両が通過可能な道路半径であり、具体的には車速Vcとカーブで許容する横G値Yg_limitとに基づいて決定している。 Here, as described above, the first look-ahead point distance D1 or the first forward observation point P 1 is determined according to the vehicle speed Vc, in particular so as to become distant as the vehicle speed Vc is higher Yes. That is, the first look-ahead point distance D1 or the first forward observation point P 1 is determined according to the same manner as the vehicle speed Vc and conventional techniques. On the other hand, as described above, the passable road radius Rn_limit is a road radius through which the vehicle can pass, and is specifically determined based on the vehicle speed Vc and the lateral G value Yg_limit allowed by the curve.
以上のような関係から、車速Vcに応じて決定した第1前方注視点P1が前方注視点設定限界点P_limitよりも自車両から遠方にある場合で、かつ通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合には、補正後第1前方注視点P1’を前方注視点設定限界点P_limitに設定している。
すなわち、図7に示すように、車速Vcに基づけば本来であれば第1前方注視点距離D1に基づいて制御目標となる前方注視点P1が設定され、さらにはその前方注視点P1において基準経路との横偏差YEを算出するところを、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合には、前方注視点P1よりも手前側の前方注視点設定限界点P_limitを制御目標となる前方注視点P1’として設定することで、前方注視点P1’が前方側に進行するのを抑制して、その前方注視点P1’において基準経路との横偏差YEを算出している。そして、この横偏差YEに基づく操舵制御量により操舵制御を行っている。
From the relationship described above, when the first forward gaze point P 1 determined according to the vehicle speed Vc is from the vehicle than the forward fixed point setting limit point P_limit distant, and passable road radius Rn_limit first forward When the gazing point position road radius is less than Rn_road, the corrected first forward gazing point P 1 ′ is set as the forward gazing point setting limit point P_limit.
That is, as shown in FIG. 7, is set forward fixed point P 1 as a control target based on the first look-ahead point distance D1 would otherwise Based on the vehicle speed Vc is more standards in the forward gaze point P1 the place of calculating the lateral deviation Y E of a path, passable road radius Rn_limit is the case of less than the first forward gaze point position road radius Rn_road is forward fixed point setting limit point on the near side of the forward fixed point P 1 P_limit 'by setting a forward gaze point P 1' forward observation point P 1 which becomes a control target lateral deviation is suppressed from traveling in front, a reference path at its forward gaze point P 1 ' and calculates the Y E. Then it is performed the steering control by the steering control amount based on the lateral deviation Y E.
これにより、カーブに進入する前から横偏差YEが小さく補正されていることから、当該横偏差YEが、自車両が減速してカーブに進入し、その車速に対応した前方注視点が設定され、当該設定された前方注視点に基づいて得られる横偏差YEに近い値に設定されることになる。これにより、カーブ進入前後で、操舵制御量を急変することなくなり、円滑に操舵制御を行うことができる。 Thus, since the lateral deviation Y E is smaller corrected before entering a curve, the lateral deviation Y E is, enters the curve the host vehicle is decelerated, the forward gaze point set corresponding to the vehicle speed It is, would be set to a value close to the lateral deviation Y E obtained based on the forward fixed point that is the setting. Thus, the steering control amount does not change suddenly before and after entering the curve, and the steering control can be performed smoothly.
次に第2の実施形態を説明する。
第2の実施形態では、前述の第1の実施形態と、操舵制御処理の内容を異ならせている。図8は、第2の実施形態における操作制御処理の内容を示す。この図8に示すように、前記ステップS6に換えて、ステップS5とステップS7との間にステップS21及びステップS22の処理を設けている。
ステップS21では、コントローラ17は、将来の操舵量を予測するための前方注視点(FF(フィードフォワード)注視点ともいう、以下、第2前方注視点という。)P2を設定する。
Next, a second embodiment will be described.
In the second embodiment, the content of the steering control process is different from that of the first embodiment. FIG. 8 shows the contents of the operation control process in the second embodiment. As shown in FIG. 8, instead of step S6, steps S21 and S22 are provided between steps S5 and S7.
In step S21, the
第2前方注視点P2は前記ステップS5で設定した第1前方注視点P1とは異なる前方注視点として設定される。具体的には、第2前方注視点P2を、図9に示すように、その前方注視点距離(以下、第2前方注視点距離という。)が車速Vcが高くなるほど大きくなるように設定する。そして、第2前方注視点P2を、同一速度において第1前方注視点距離D1よりも第2前方注視点距離D2が大きくなるように、すなわち、第1前方注視点P1よりも自車両から遠方になるように設定する。 The second forward fixed point P 2 is set as the forward fixed point different from the first forward fixed point P 1 set in step S5. Specifically, the second headway point P 2, as shown in FIG. 9, the forward gaze point distance (hereinafter, referred to as a second forward observation point distance.) Is set larger as the vehicle speed Vc is higher . Then, the second forward observation point P 2, at the same speed as than the first look-ahead point distance D1 and the second look-ahead point distance D2 increases, i.e., from the vehicle than the first headway point P 1 Set to be far away.
続いてステップS22において、コントローラ17は、第2前方注視点P2における道路半径(以下、第2前方注視点位置道路半径という。)Rffを算出する。第2前方注視点位置道路半径Rffの算出手順は、基本的には前述の第1の実施形態においてステップS6でした第1前方注視点位置道路半径Rn_roadの算出手順と同様になる。
すなわち、先ず、図10に示すように、第2前方注視点P2から前後方向の所定距離DSにあるノードを前直近ノードPF及び後直近ノードPRを選定する。
続いて、第2前方注視点P2と前直近ノードPFを結ぶ線分P2PRと、第2前方注視点P2と後直近ノードPFとを結ぶ線分P2PFとがなす角度θ、及び前直近ノードPFと後直近ノードPRとの距離dを算出する。
Subsequently, in Step S22, the
That is, first, as shown in FIG. 10, selects a pre-nearest node P F and the rear nearest node P R a node in the longitudinal direction of the predetermined distance D S from the second forward observation point P 2.
Subsequently, the
ここで、前直近ノードPF、第2前方注視点P2及び後直近ノードPRを通る円弧の中心点Oは、線分P2PFの中点aを通る垂直2等分線Aと、線分P2PRの中点bを通る垂直2等分線Bとの交点となる。このようなことから、前記角度θは、線分P2PFの中点aを通る垂直2等分線Aと線分P2PRの中点bを通る垂直2等分線Bとがなす∠aObの角度として得られる。
そして、前直近ノードPFと中心点Oとがなす線分PFOと後直近ノードPRと中心点Oとがなす線分PROとがなす∠PFOPRの角度は、前記∠aObの角度θの2倍になる。
Here, before the nearest node P F, the center point O of the arc through the second forward observation point P 2 and the rear nearest node P R has a vertical bisector A which passes through the middle point a of the
Then, the angle of the pre-nearest node P F and the line segment formed by the center O P F O and the rear nearest node P line R and a center point O forms P R O and forms ∠P F OP R, the It becomes twice the angle θ of ∠aOb.
以上のような関係から、下記(10)式を用いて、角度θ及び距離dに基づいて第2前方注視点位置道路半径Rffを算出できる。
Rff=d/2×sinθ ・・・(10)
続いてステップS7において、コントローラ17は前方注視点距離を補正する。
前記ステップS5では、前述の第1の実施形態と同様に、第1前方注視点P1も設定している。しかし、このステップS7では、前記ステップS21で設定した第2前方注視点P2だけを補正する。
From the above relationship, the second forward gazing point position road radius Rff can be calculated based on the angle θ and the distance d using the following equation (10).
Rff = d / 2 × sinθ (10)
Subsequently, in step S7, the
In the step S5, as in the first embodiment described above, the first forward fixed point P 1 is also set. However, in the step S7, it corrects only the second forward observation point P 2 set in step S21.
具体的には、通過可能道路半径Rn_limitと第2前方注視点位置道路半径Rffとの比較結果に基づいて、第2前方注視点P2の位置を補正した前方注視点(以下、補正後第2前方注視点という。)P2’を算出する。より具体的には、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合で(Rn_limit<Rff)、かつ基準経路における通過可能道路半径Rn_limitに対応する前方注視点設定限界点P_limitを仮定し、その前方注視点設定限界点P_limitよりも第2前方注視点距離D2にある第2前方注視点P2が自車両から遠方にある場合、第2前方注視点P2の補正後の値としての補正後第2前方注視点P2’を前方注視点設定限界点P_limitに設定する(P2’=P_limit)。 Specifically, based on a result of comparison between the passable road radius Rn_limit and second forward gaze point position road radius Rff, forward fixed point obtained by correcting the second position of the forward fixed point P 2 (hereinafter, corrected second This is referred to as a forward gazing point.) P 2 ′ is calculated. More specifically, the forward gazing point setting limit point P_limit corresponding to the passable road radius Rn_limit in the reference route when the passable road radius Rn_limit is smaller than the second forward gazing point position road radius Rff (Rn_limit <Rff). assuming, the second forward observation point P 2 than the forward fixed point setting limit point P_limit in a second look-ahead point distance D2 is the vehicle when in the distance, the second forward gaze point P 2 after correction thereof The corrected second forward gazing point P 2 ′ as a value is set as the forward gazing point setting limit point P_limit (P 2 ′ = P_limit).
それ以外の場合、補正後第2前方注視点P2’を第2前方注視点P2に設定する(P2’=P2)。すなわち、それ以外の場合には、第2前方注視点P2の補正を行わない。例えば、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合(Rn_limit<Rff)であっても、第2前方注視点P2よりも前方注視点設定限界点P_limitが自車両から遠方にある場合、補正後第2前方注視点P2’を第2前方注視点P2に設定する(P2’=P2)。 In other cases, the corrected second forward gazing point P 2 ′ is set to the second forward gazing point P 2 (P 2 ′ = P 2 ). That is, otherwise, not perform the second correction of the forward fixed point P 2. For example, even if the passable road radius Rn_limit is smaller than the second forward gaze point position road radius Rff (Rn_limit <Rff), forward fixed point setting limit points than the second headway point P 2 P_limit from vehicle If it is far away, the corrected second front gazing point P 2 ′ is set to the second front gazing point P 2 (P 2 ′ = P 2 ).
この結果、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合(Rn_limit<Rff)、補正後第2前方注視点P2’における道路半径(以下、補正後第2前方注視点位置道路半径という。)Pff’は通過可能道路半径Rn_limitとなり、それ以外の場合、補正後第2前方注視点位置道路半径Pff’は第2前方注視点位置道路半径Rffとなる。 As a result, when the passable road radius Rn_limit is smaller than the second forward gazing point position road radius Rff (Rn_limit <Rff), the road radius at the corrected second forward gazing point P 2 ′ (hereinafter referred to as the corrected second forward gazing point). Pff 'is the passable road radius Rn_limit. In other cases, the corrected second forward gazing point position road radius Pff' is the second forward gazing point position road radius Rff.
続いてステップS8及びステップS9において、コントローラ17は、補正後第1前方注視点P1’に基づいて横偏差YEを算出し、そして第1操舵量δ1を算出する。
なお、前記ステップS7で第2前方注視点P2だけを補正し、第1前方注視点P1を補正していないので、ここで用いる補正後第1前方注視点P1’は第1前方注視点P1そのものである。よって、第1前方注視点P1である補正後第1前方注視点P1’に基づいて、前述の第1の実施形態と同様に、前記(3)式〜(9)式を用いて、第1操舵量δ1を算出する。
Subsequently, in step S8 and step S9, the
Incidentally, the second corrected only forward observation point P 2 in step S7, since no correction of the first headway point P 1, the corrected first forward gaze point P 1 'is first forward used herein Note point of view P 1 is the thing. Therefore, the corrected first is a forward gaze point P 1 on the basis of the first forward fixed point P 1 ', as in the first embodiment described above, using the (3) to (9), A first steering amount δ1 is calculated.
そして、第2の実施形態では、ステップS9で、コントローラ17は、前記補正後第2前方注視点位置道路半径Rff’に基づいて第2操舵量δ2を算出する。具体的には、補正後第2前方注視点位置道路半径Rff’(ρ)及び車両のホイールベースLに基づいて、下記(11)式により第2操舵量δ2を算出する。
δ2=L/ρ ・・・(11)
この(11)式により算出した第2操舵量δ2は、補正後第2前方注視点位置道路半径Rff’の走行路を旋回するために幾何学的に必要となる操舵量になる。
In the second embodiment, in step S9, the
δ2 = L / ρ (11)
The second steering amount δ2 calculated by the equation (11) is a steering amount that is geometrically necessary for turning on the travel path of the corrected second forward gazing point position road radius Rff ′.
そして、ステップS10において、コントローラ17は、前記ステップS9で算出した第1操舵量δ1及び第2操舵量δ2の加算値を最終的な操舵制御量δC(=δ1+δ2)として、操舵アクチュエータ10に出力する。なお、操舵制御量δCを、第1操舵量δ1と第2操舵量δ2との平均値((δ1+δ2)/2)として得てもよい。
以上が第2の実施形態におけるコントローラ17の操舵制御処理になる。
In step S10, the
The above is the steering control processing of the
すなわち、自車両100の位置を基準に、前後の所定距離の範囲内のノードデータ(X0,Y0)〜(Xn,Yn)を記憶し、また、各車輪速VFL〜VRR、前後加速度Xg、横加速度Yg及びヨーレートφを読込み、さらに、車速Vcを算出する(ステップS1〜ステップS3)。そして、算出した車速Vcとカーブで許容する横G値Yg_limitとに基づいて通過可能道路半径Rn_limitを算出する(ステップS4)。
That is, node data (X 0 , Y 0 ) to (X n , Y n ) within a predetermined distance range are stored based on the position of the
続いて、車速Vcに応じて第1前方注視点P1を設定する。(ステップS5)。なお、第1前方注視点P1の位置を補正しないことから、その補正時に必要になる第1前方注視点P1における第1前方注視点位置道路半径Rn_roadの算出(ステップS6)は行わない。
一方、第2前方注視点P2を設定し、その第2前方注視点P2における第2前方注視点位置道路半径Rffを算出する(ステップS21、ステップS22)。
Then, set the first forward observation point P 1 in accordance with the vehicle speed Vc. (Step S5). Incidentally, since no correcting the position of the first forward gaze point P 1, the calculation of the first forward gaze point position road radius Rn_road at the first forward observation point P 1 that are required when the correction (step S6) is not performed.
On the other hand, the second set the forward gaze point P 2, calculates a second forward gaze point position road radius Rff at the second forward observation point P 2 (step S21, step S22).
続いて、通過可能道路半径Rn_limitと第2前方注視点位置道路半径Rffとを比較して、第2前方注視点P2の位置を補正して、補正後の補正後第2前方注視点P2’を得る(ステップS7)。具体的には、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合で(Rn_limit<Rff)、かつ前方注視点設定限界点P_limitよりも第2前方注視点P2が自車両から遠方にある場合、補正後第2前方注視点P2’を前方注視点設定限界点P_limitに設定する(P2’=P_limit)。それ以外の場合、補正後第2前方注視点P2’を第2前方注視点P2に設定する(P2’=P2)。 Subsequently, passable road radius Rn_limit and by comparing the second forward gaze point position road radius Rff, by correcting the second position of the forward fixed point P 2, second forward after correction after correction gaze point P 2 'Is obtained (step S7). Specifically, passable road radius Rn_limit second forward gaze point position road in the case of less than the radius Rff (Rn_limit <Rff), and second forward observation point P 2 is the vehicle than forward fixed point setting limit point P_limit If it is far from the position, the corrected second forward gazing point P 2 ′ is set as the forward gazing point setting limit point P_limit (P 2 ′ = P_limit). In other cases, the corrected second forward gazing point P 2 ′ is set to the second forward gazing point P 2 (P 2 ′ = P 2 ).
そして、補正後第1前方注視点P1’における基準経路との横偏差YEを算出し、算出した横偏差YEに応じた第1操舵量δ1を算出する。さらに、補正後第2前方注視点P2’における補正後第2前方注視点位置道路半径Pff’に基づいて第2操舵量δ2を算出する(ステップS8、ステップS9)。
そして、第1操舵量δ1及び第2操舵量δ2の加算値を最終的な操舵制御量δCとして、操舵アクチュエータ10に出力する(ステップS10)。
そして、コントローラ17は、所定の時間間隔でこの処理を繰り返して行っており、すなわち、所定の時間間隔で逐次操舵制御量δCを得て、その得た操舵制御量δCを操舵アクチュエータ10に出力している。
Then, to calculate the lateral deviation Y E of the reference path at the first forward observation point P 1 'after correction, to calculate a first steering amount δ1 corresponding to the calculated lateral deviation Y E. Further, the second steering amount δ2 is calculated based on the corrected second forward gazing point position road radius Pff ′ at the corrected second forward gazing point P 2 ′ (steps S8 and S9).
Then, the addition value of the first steering amount δ1 and the second steering amount δ2 is output to the
The
次に第2の実施形態における効果を説明する。
前述したように、第2前方注視点P2を第1前方注視点P1より自車両から遠方に設定し、第2前方注視点P2をできるだけ自車両から遠方に位置させ、この第2前方注視点P2を補正した補正後第2前方注視点P2’を考慮して自動操舵制御している。ここで、補正後第2前方注視点P2’を、通過可能道路半径Rn_limitと第2前方注視点位置道路半径Rffとの比較結果に基づいて得ている(前記ステップS7)。すなわち、通過可能道路半径Rn_limitが第2前方注視点P2における第2前方注視点位置道路半径Rff未満の場合で(Rn_limit<Rff)、かつ前記前方注視点設定限界点P_limitよりも第2前方注視点P2が自車両から遠方にある場合、補正後第2前方注視点P2’を前方注視点設定限界点P_limitに設定している。それ以外の場合、補正後第2前方注視点P2’を第2前方注視点P2に設定する、すなわち、第2前方注視点P2の補正を行わない。具体的には、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合(Rn_limit<Rff)であっても、第2前方注視点P2よりも前方注視点設定限界点P_limitが前方になっている場合、第2前方注視点P2を補正後第2前方注視点P2’として、第2前方注視点P2をそのまま用いている。
Next, the effect in 2nd Embodiment is demonstrated.
As described above, the second forward gaze point P 2 is set remote from the first forward fixed point vehicle than P 1, is positioned far as possible from the vehicle the second headway point P 2, the second front gazing point P 2 in consideration of the second headway point P 2 'after the correction that corrects have automatic steering control. Here, the corrected second forward gazing point P 2 ′ is obtained based on the comparison result between the passable road radius Rn_limit and the second forward gazing point position road radius Rff (step S7). That is, passable road radius Rn_limit is in the case of less than the second forward gaze point position road radius Rff at the second forward observation point P 2 (Rn_limit <Rff), and second forward Note than the forward gaze point set limit point P_limit when the viewpoint P 2 is distant from the vehicle, and sets the second forward observation point P 2 'to forward fixed point setting limit points P_limit corrected. Otherwise, a second forward gaze point P 2 'is set to the second forward fixed point P 2 after correction, that is, does not perform a second correction of the forward fixed point P 2. Specifically, passable road radius Rn_limit even when less than the second forward gaze point position road radius Rff (Rn_limit <Rff), the forward fixed point setting limit points P_limit than second headway point P 2 If it is forward, the second headway point P 2 as the second forward observation point P 2 'after the correction, and using the second front watch point P 2 as it is.
これにより、例えば図11に示すように、本来であれば第2前方注視点距離D2に基づいて制御目標となる前方注視点P2が設定されるところを、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合には、前方注視点P2が前方側に進行するのを抑制し、前方注視点P2よりも手前側の前方注視点設定限界点P_limitを制御目標となる前方注視点P2’として設定している。
一方、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rffより大きい場合には、前方注視点P2を補正することなく、その前方注視点P2を基に操舵量又は操舵制御量を決定している。
Thus, for example, as shown in FIG. 11, the place where the forward gaze point P 2 as a control target based on a second look-ahead point distance D2 would otherwise be set, passable road radius Rn_limit second front If it is less than the gazing point position road radius Rff is to prevent the forward gaze point P 2 is advanced to the front side, the control target forward fixed point setting limit points P_limit the front of the forward fixed point P 2 This is set as the forward gazing point P 2 ′.
On the other hand, passable road radius Rn_limit is larger than the second forward gaze point position road radius Rff, without correcting the forward gaze point P 2, the steering amount or the steering control amount based on the forward fixed point P 2 Has been decided.
このように、操舵量を左右する第2前方注視点P2を第1前方注視点P1よりも自車両から遠方に設定することで、第1前方注視点P1よりも遠方の走行路で将来必要になる操舵量を予測するようにしている。これにより、例えば、第1前方注視点P1(補正後第1前方注視点P1’)が自車両から比較的短い距離に設定された場合でも、道路形状に応じて将来必要な量も加味して操舵量を決定することができる。
さらに、前述したように所定の条件となる場合には、この第2前方注視点P2(補正後第2前方注視点P2’)を前方注視点設定限界点P_limitにして、第2前方注視点P2(補正後第2前方注視点P2’)が前方側に進行するのを抑制することで、結果的に、第1の実施形態と同様に、カーブ進入前後で、操舵制御量を急変することなくなり、円滑に操舵制御を行うことができる。
Thus, the second front watch point P 2 affects the steering amount by setting remote from the first vehicle than forward fixed point P 1, the far traveling path than the first headway point P 1 The steering amount required in the future is predicted. Thereby, for example, even when the first forward gazing point P 1 (corrected first forward gazing point P 1 ′) is set at a relatively short distance from the host vehicle, the amount necessary in the future is also taken into account according to the road shape. Thus, the steering amount can be determined.
Further, as described above, when the predetermined condition is satisfied, the second forward gazing point P 2 (corrected second forward gazing point P 2 ′) is set as the forward gazing point setting limit point P_limit. By suppressing the viewpoint P 2 (corrected second forward gazing point P 2 ′) from proceeding forward, the steering control amount can be reduced before and after entering the curve, as in the first embodiment. Steering control can be performed smoothly without sudden change.
次に第3の実施形態を説明する。
第3の実施形態では、前述の第1及び第2の実施形態と、操舵制御処理の内容を異ならせている。図12は、第3の実施形態における操作制御処理の内容を示す。この図12に示すように、前述の第1の実施形態の操作制御処理との比較において、前記ステップS6及びステップS7の処理を省略する一方、前記ステップS8とステップS9との間に新たにステップS31の処理を設けている。
前記ステップS6及びステップS7の処理は、第1前方注視点P1を補正するための処理であったので、これらの処理を省略することで、補正後第1前方注視点P1’は、補正されない第1前方注視点P1となる。
これにより、ステップS8では、第1前方注視点P1に基づいて横偏差YEを算出することになる。
Next, a third embodiment will be described.
In the third embodiment, the contents of the steering control process are different from those of the first and second embodiments described above. FIG. 12 shows the contents of the operation control process in the third embodiment. As shown in FIG. 12, in the comparison with the operation control process of the first embodiment described above, the process of step S6 and step S7 is omitted, while a new step is performed between step S8 and step S9. The process of S31 is provided.
Processing of step S6 and step S7, since a process for correcting the first look-ahead point P 1, by omitting these processes, the first forward gaze point after correction P 1 'is corrected a first forward fixed point P 1 which is not.
Thus, in step S8, leading to calculation of a lateral deviation Y E based on the first headway point P 1.
そして、新たに設けたステップS31において、コントローラ17は、前記ステップS8で算出した横偏差YEを前記ステップS4で算出した通過可能道路半径Rn_limitの経路に基づいて補正する。その補正について、図13を用いて説明する。
前述したように、ノードの集合が基準経路の形状をなすものであるので、ノードにより構成される基準経路が曲線路である場合、各ノードについて道路半径Rを得ることができる。このようなことから、各ノードについて得た道路半径Rのうち、前記ステップS4で算出した通過可能道路半径R_limitと同値になる道路半径Rを特定して、当該道路半径Rを得ているG点(ノード)を特定する。
Then, in step S31 newly provided, the
As described above, since the set of nodes forms the shape of the reference route, when the reference route constituted by the nodes is a curved road, the road radius R can be obtained for each node. For this reason, among the road radii R obtained for each node, the road radius R having the same value as the passable road radius R_limit calculated in step S4 is specified, and the G point that obtains the road radius R is obtained. (Node) is specified.
そして、その特定したG点を基準にした通過可能道路半径R_limitと同値の半径R_virの仮想円を想定し、その想定した仮想円に基づいて、補正後の横偏差(以下、補正後横偏差という。)YE’を算出する。
補正後横偏差YE’の具体的な算出方法を図14を用いて説明する。
なお、前記図13では、基準経路が右カーブとなっている場合を示しており、図14は、基準経路が左カーブとなっている場合を示す。しかし、ここで説明する補正後横偏差YE’の演算は、基準経路のカーブの方向により影響されるものではない。
Then, a virtual circle having a radius R_vir equal to the passable road radius R_limit based on the specified G point is assumed, and a corrected lateral deviation (hereinafter referred to as a corrected lateral deviation) is based on the assumed virtual circle. .) Calculate Y E '.
A specific method for calculating the corrected lateral deviation Y E ′ will be described with reference to FIG.
13 shows a case where the reference route has a right curve, and FIG. 14 shows a case where the reference route has a left curve. However, the calculation of the corrected lateral deviation Y E ′ described here is not influenced by the curve direction of the reference path.
その演算では、先ず車両のスリップ角θSを算出する。具体的には、下記(12)式により、前後加速度Xg及び横加速度Ygに基づいて車両のスリップ角θSを算出する。
θS=tan−1(Yg/Xg) ・・・(12)
また、図14に示すように、ヨー角ε1及びずれ角εT’を定義する。ヨー角ε1は、基準座標に対する自車両100のヨー角となる。ずれ角εT’は、補正後第1前方注視点P1’を通り自車両100の速度ベクトルVに直角な直線Cを描き、その直線Cと前記仮想円の経路(以下、仮想円経路という。)との交点Q’での基準座標に対する基準経路のずれ角となる。
In the calculation, first, the slip angle θ S of the vehicle is calculated. Specifically, the vehicle slip angle θ S is calculated based on the longitudinal acceleration Xg and the lateral acceleration Yg by the following equation (12).
θ S = tan −1 (Yg / Xg) (12)
Further, as shown in FIG. 14, a yaw angle ε 1 and a deviation angle ε T ′ are defined. The yaw angle ε 1 is the yaw angle of the
そして、このように定義した前記ヨー角ε1及びずれ角εT’に基づいて、下記(13)式によりヨー角εR’を算出する。
εR’=εT’−ε1 ・・・(13)
また、図14に示すように、基準経路と自車両100の現在走行位置との横偏差をYU、仮想円経路を基準とした車両姿勢に応じた横偏差(以下、仮想円経路基準横偏差という。)YS’、及び補正後第1前方注視点P1’までの距離D1’を定義する。そして、横偏差YU、補正後第1前方注視点P1’までの距離D1’、ヨー角εR及びスリップ角θSに基づいて下記(14)式により仮想円経路基準横偏差YS’を算出する。
YS’=YU+D1’×tan(εR+θS) ・・・(14)
Then, based on the yaw angle ε 1 and the deviation angle ε T ′ defined in this way, the yaw angle ε R ′ is calculated by the following equation (13).
ε R '= ε T ' -ε 1 (13)
Further, as shown in FIG. 14, the lateral deviation between the reference route and the current travel position of the
Y S ′ = Y U + D 1 ′ × tan (ε R + θ S ) (14)
また、車両が定常円旋回を行っていると仮定する。この仮定により、スリップレートを無視できるので、車両旋回状態から求まる横偏差YPを下記(15)式により算出する。
YP=D1’×tanβ ・・・(15)
ここで、βは下記(16)式で表される。
β=1/2×sin−1(D1’×ε1/Xg) ・・・(16)
そして、下記(17)式に示すように、横偏差YSと横偏差YPとを加算して仮想円経路に対する横偏差(以下、仮想円経路基準横偏差という。)YE’を算出する。
YE’=YS’+YP ・・・(17)
このように、ステップS31において、仮想円経路を基準として、補正後第1前方注視点P1’における仮想円経路基準横偏差YE’を算出する。
It is also assumed that the vehicle is making a steady circular turn. This assumption, since negligible slip rate to calculate the lateral deviation Y P obtained from the vehicle turning state by the following equation (15).
Y P = D1 ′ × tan β (15)
Here, β is expressed by the following equation (16).
β = 1/2 × sin −1 (D1 ′ × ε 1 / Xg) (16)
Then, as shown in the following equation (17), the lateral deviation relative to the virtual circle path by adding the lateral deviation Y S and the lateral deviation Y P is calculated (hereinafter, referred to. Virtual circle path reference lateral deviation) Y E ' .
Y E '= Y S ' + Y P (17)
As described above, in step S31, the virtual circular path reference lateral deviation Y E ′ at the corrected first forward gazing point P 1 ′ is calculated using the virtual circular path as a reference.
なお、各ノードについて得た道路半径Rのうち、前記ステップS4で算出した通過可能道路半径R_limitと同値になる道路半径Rがないような場合には、仮想円経路基準横偏差YE’を、前記ステップS8で算出した横偏差YEに設定してもよい。
続いてステップS9において、コントローラ17は、前記ステップS31で算出した仮想円経路基準横偏差YE’に基づいて、下記(18)式により第1操舵量(以下、仮想円経路基準第1操舵量という。)δ1’を算出する。
δ1’=K1×YE’+K2×(dYE’/dt) ・・・(18)
If there is no road radius R that is equal to the passable road radius R_limit calculated in step S4 among the road radii R obtained for each node, the virtual circular path reference lateral deviation Y E ′ is set as it may be set in the lateral deviation Y E calculated at step S8.
Subsequently, in step S9, the
δ1 ′ = K1 × Y E ′ + K2 × (dY E ′ / dt) (18)
ここで、K1,K2は係数である。例えば、K1,K2は、直線走行時の外乱に対して追従誤差が拡大しないように最適な値として、実験により求められることが望ましい。
続いてステップS10において、コントローラ17は、前記ステップS9で算出した仮想円基準第1操舵量δ1’を最終的な操舵制御量δCとして、操舵アクチュエータ10に出力する。これにり、補正後第1前方注視点P1’において自車両が仮想円経路に沿って走行することになるように操舵制御される。
Here, K1 and K2 are coefficients. For example, it is desirable that K1 and K2 are obtained by experiments as optimum values so that the follow-up error does not increase with respect to disturbance during straight running.
Subsequently, in step S10, the
以上が第3の実施形態におけるコントローラ17の操舵制御処理になる。
すなわち、自車両100の位置を基準に、前後の所定距離の範囲内のノードデータ(X0,Y0)〜(Xn,Yn)を記憶し、また、各車輪速VFL〜VRR、前後加速度Xg、横加速度Yg及びヨーレートφを読込み、さらに、車速Vcを算出する(ステップS1〜ステップS3)。そして、算出した車速Vcとカーブで許容する横G値Yg_limitとに基づいて通過可能道路半径Rn_limitを算出する(ステップS4)。
The above is the steering control processing of the
That is, node data (X 0 , Y 0 ) to (X n , Y n ) within a predetermined distance range are stored based on the position of the
続いて、車速Vcに応じて第1前方注視点P1を設定する(ステップS5)。なお、第1前方注視点P1の位置を補正しないことから、その補正時に必要になる第1前方注視点P1における第1前方注視点位置道路半径Rn_roadの算出(ステップS6)は行わない。
そして、その補正後第1前方注視点P1’(=P1)における基準経路との横偏差YEを算出する(ステップS8)。
一方、通過可能道路半径Rn_limitの仮想円経路を設定し、補正後第1前方注視点P1’におけるその仮想円経路との仮想円経路基準横偏差YE’を算出する(ステップS31)。そして、その算出した仮想円経路基準横偏差YE’に応じた仮想円経路基準第1操舵量δ1’を得て、その仮想円経路基準第1操舵量δ1’を操舵制御量δCとして、操舵アクチュエータ10に出力する(ステップS9、ステップS10)。
Subsequently, the first set forward fixed point P 1 in accordance with the vehicle speed Vc (Step S5). Incidentally, since no correcting the position of the first forward gaze point P 1, the calculation of the first forward gaze point position road radius Rn_road at the first forward observation point P 1 that are required when the correction (step S6) is not performed.
Then, the lateral deviation Y E from the reference route at the corrected first forward gazing point P 1 ′ (= P 1 ) is calculated (step S8).
On the other hand, a virtual circular route having a passable road radius Rn_limit is set, and a virtual circular route reference lateral deviation Y E ′ with the virtual circular route at the corrected first forward gazing point P 1 ′ is calculated (step S31). Then, the virtual circular path reference first steering amount δ1 ′ corresponding to the calculated virtual circular path reference lateral deviation Y E ′ is obtained, and the virtual circular path reference first steering amount δ1 ′ is used as the steering control amount δC. It outputs to the actuator 10 (step S9, step S10).
次に第3の実施形態における効果を説明する。
前述したように、補正後第1前方注視点P1’において仮想円経路との仮想円経路基準横偏差YE’を算出して、この仮想円経路基準横偏差YE’に基づいて仮想円経路基準第1操舵量δ1’を決定することで、補正後第1前方注視点P1’において仮想円経路に沿って走行することになるように操舵制御している。そして、前述したように、基準経路を構成する各ノードについて通過可能道路半径R_limitとなるノードを特定し、そのノード(G点)を基準にして仮想円経路を設定している。
Next, effects in the third embodiment will be described.
As described above, the virtual circle path reference lateral deviation Y E ′ with the virtual circle path is calculated at the corrected first forward gazing point P 1 ′, and the virtual circle is calculated based on the virtual circle path reference lateral deviation Y E ′. By determining the route reference first steering amount δ1 ′, the steering control is performed so that the vehicle travels along the virtual circular route at the corrected first forward gazing point P 1 ′. As described above, for each node constituting the reference route, a node having a passable road radius R_limit is specified, and a virtual circular route is set based on the node (point G).
これにより、例えば図13に示すように、補正後第1前方注視点P1’において基準経路を基準に横偏差YEを得るところを、当該補正後第1前方注視点P1’において当該基準経路よりも道路半径が大きく設定した仮想円経路を基準にした基準横偏差YE’を得ている。このようにすることで、図13に示すように、横偏差YEよりも小さい基準横偏差YE’に基づいて操舵制御量を算出することができる。 As a result, for example, as shown in FIG. 13, the lateral deviation Y E is obtained with reference to the reference route at the corrected first forward gazing point P 1 ′, and the reference at the corrected first forward gazing point P 1 ′. A reference lateral deviation Y E ′ based on a virtual circular route having a road radius larger than the route is obtained. By doing so, as shown in FIG. 13, it is possible to calculate the steering control amount based on a small reference transverse deviation Y E 'than the lateral deviation Y E.
この結果、カーブに進入する前から横偏差YEが小さく補正されて基準横偏差YE’となっていることから、当該基準横偏差YE’が、自車両が減速してカーブに進入し、その車速に対応した前方注視点が設定され、当該設定された前方注視点に基づいて得られる横偏差に近い値に設定されていることになる。これにより、カーブ進入前後で、操舵制御量を急変することなくなり、円滑に操舵制御を行うことができる。 As a result, 'since it has become, the reference lateral deviation Y E' lateral deviation Y E is less corrected by the reference lateral deviation Y E before entering the curve, enters the curve the host vehicle is decelerated The forward gazing point corresponding to the vehicle speed is set, and is set to a value close to the lateral deviation obtained based on the set forward gazing point. Thus, the steering control amount does not change suddenly before and after entering the curve, and the steering control can be performed smoothly.
また、仮想円経路を車両が通過可能な道路半径Rn_limitとなるように設定することで、横偏差を小さく補正する場合でも、道路形状に応じて最適な操舵量を得ることができるようになる。
以上、本発明の実施の形態について説明した。しかし、本発明は、前述の実施の形態として実現されることに限定されるものではない。
すなわち、前述の実施形態では、所定の自車両の横加速度としての横G値Yg_limitを固定値とし、具体的には、横G値Yg_limitを0.3にしている。しかし、これに限定されるものではない。例えば、図15に示すように、車速が大きくなるほど、横G値Yg_limitを小さくしてもよい。
In addition, by setting the virtual circular route to be the road radius Rn_limit through which the vehicle can pass, even when the lateral deviation is corrected to be small, an optimal steering amount can be obtained according to the road shape.
The embodiment of the present invention has been described above. However, the present invention is not limited to being realized as the above-described embodiment.
That is, in the above-described embodiment, the lateral G value Yg_limit as the lateral acceleration of the predetermined host vehicle is set to a fixed value, and specifically, the lateral G value Yg_limit is set to 0.3. However, it is not limited to this. For example, as shown in FIG. 15, the lateral G value Yg_limit may be decreased as the vehicle speed increases.
また、前述の第1の実施形態では、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合で、かつ第1前方注視点P1が前方注視点設定限界点P_limitよりも自車両から遠方にある場合、補正後第1前方注視点P1’を、第1前方注視点P1よりも自車両の手前側にある前方注視点設定限界点P_limitに設定している。この場合、絶対位置で考えた場合、今回演算時の補正後第1前方注視点P1’が、前回演算時の補正後第1前方注視点P1’よりも自車両手前側に移動する、すなわち補正後第1前方注視点P1’が逆戻りしてしまう場合がある。このような逆戻りを防止するような処理を行ってもよい。 In the first embodiment described above, if passable road radius Rn_limit is less than the first forward gaze point position road radius Rn_road, and first forward observation point P 1 than forward fixed point setting limit point P_limit own When the vehicle is far from the vehicle, the corrected first forward gazing point P 1 ′ is set to the forward gazing point setting limit point P_limit that is closer to the vehicle than the first forward gazing point P 1 . In this case, when considered in terms of absolute position, the corrected first forward gazing point P 1 ′ at the time of the current calculation moves closer to the vehicle front side than the corrected first front gazing point P 1 ′ at the time of the previous calculation. That is, the corrected first front gazing point P 1 ′ may be reversed. You may perform the process which prevents such a return.
具体的には、前回演算時の補正後第1前方注視点P1’を前回値P1’_oldに代入していき、この前回値P1’_oldと今回演算時の補正後第1前方注視点P1’とを比較し、今回演算時の補正後第1前方注視点P1’が前回値P1’_oldよりも自車両に近い位置に存在する場合、今回演算時の補正後第1前方注視点P1’を前回値P1’_oldに設定する。これにより、補正後第1前方注視点P1’が逆戻りしてしまうことを防止する。 Specifically, we are substituting 'the previous value P 1' first forward observation point P 1 the corrected during the previous operation on _old, first forward Note the corrected during the previous value P 1 '_old and current operation When the first forward gazing point P 1 ′ after correction at the time of the current calculation is present at a position closer to the vehicle than the previous value P 1 ′ _old, the first point after correction at the time of the current calculation is compared with the viewpoint P 1 ′. The forward gazing point P 1 ′ is set to the previous value P 1 ′ _old. This prevents the corrected first front gazing point P 1 ′ from returning backward.
また、第2の実施形態において補正後第2前方注視点P2’を設定する場合も同様な処理を行ってもよい。すなわち、前回演算時の補正後第2前方注視点P2’を前回値P2’_oldに代入していき、この前回値P2’_oldと今回演算時の補正後第2前方注視点P2’とを比較し、今回演算時の補正後第2前方注視点P2’が前回値P2’_oldよりも自車両に近い位置に存在する場合、今回演算時の補正後第1前方注視点P2’を前回値P2’_oldに設定する。これにより、補正後第2前方注視点P2’が逆戻りしてしまうことを防止する。 In addition, the same process may be performed when the corrected second forward gazing point P 2 ′ is set in the second embodiment. In other words, previously calculated time of 'the previous value P 2' second forward observation point P 2 corrected gradually substituted for _old, the previous value P 2 '_old a current operation the second forward observation point after correction at P 2 , And when the corrected second forward gazing point P 2 ′ at the time of the current calculation is present at a position closer to the host vehicle than the previous value P 2 ′ _old, the corrected first forward gazing point at the time of the current calculation P 2 'is set to the previous value P 2 ' _old. This prevents the corrected second front gazing point P 2 ′ from returning backward.
また、前述の実施形態では、第1前方注視点距離D1及び第2前方注視点距離D2を、図4及び図9を用いて具体的に説明した。しかし、これに限定されるものではない。例えば、図16に示すように、第2の実施形態で用いている第2前方注視点距離D2を、車速に対応して増加させていった場合に、ある車速で第1前方注視点距離D1と交差するようにしてもよい。 In the above-described embodiment, the first front gazing point distance D1 and the second front gazing point distance D2 have been specifically described with reference to FIGS. However, it is not limited to this. For example, as shown in FIG. 16, when the second forward gazing distance D2 used in the second embodiment is increased corresponding to the vehicle speed, the first forward gazing distance D1 at a certain vehicle speed. You may make it cross.
また、前述の第2の実施形態では、第1前方注視点P1の位置を補正しない場合、すなわち第1前方注視点P1の位置を固定した場合を説明した。しかし、これに限定されるものではない。例えば、第1前方注視点P1についても、前述の第1の実施形態のように、通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとの比較結果に応じて補正してもよい。このように補正を行った場合、前方注視点設定限界点P_limitに補正された補正後第1前方注視点P1’に基づいて得た第1操舵量δ1と補正後第2前方注視点P2’に基づいて得た第2操舵量δ2との加算値からなる制御量δCを得ることができる。 In the second embodiment described above, if not corrected first position of the forward gaze point P 1, i.e. has been described a case of fixing the first position of the forward gaze point P 1. However, it is not limited to this. For example, for the first forward fixed point P 1, as in the first embodiment described above, it may be corrected according to a result of comparison between the passable road radius Rn_limit a first forward gaze point position road radius Rn_road . When the correction is performed in this way, the first steering amount δ1 obtained based on the corrected first forward gazing point P 1 ′ corrected to the forward gazing point setting limit point P_limit and the corrected second forward gazing point P 2 are obtained. A control amount δC composed of an addition value with the second steering amount δ2 obtained based on 'can be obtained.
また、前述の第3の実施形態では、第1前方注視点P1の位置を補正しない場合、すなわち第1前方注視点P1の位置を固定した場合を説明した。しかし、これに限定されるものではない。例えば、前述の第1の実施形態のように、第1前方注視点P1を通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとの比較結果に応じて補正してもよい。このように補正を行った場合、その補正後の第1前方注視点P1(補正後第1前方注視点P1’)において仮想円経路との仮想円経路基準横偏差YE’を算出することができるようになる。
なお、前述の実施形態の説明において、コントローラ17の図2に示すステップS5の処理は、第1前方注視点を自車速が高くなるほど自車両から遠方に設定する第1前方注視点設定手段を実現している。
In the third embodiment described above, if not corrected first position of the forward gaze point P 1, i.e. has been described a case of fixing the first position of the forward gaze point P 1. However, it is not limited to this. For example, as in the first embodiment described above, may be corrected according to a result of comparison between the passable road radius Rn_limit a first forward gaze point position road radius Rn_road the first forward gaze point P 1. When the correction is performed in this way, the virtual circular path reference lateral deviation Y E ′ with the virtual circular path is calculated at the corrected first forward gazing point P 1 (corrected first forward gazing point P 1 ′). Will be able to.
In the description of the above-described embodiment, the process of step S5 shown in FIG. 2 of the
また、前述したように、車速Vcに基づけば本来であれば第1前方注視点距離D1に基づいて制御目標となる前方注視点P1が設定され、さらにはその前方注視点P1において基準経路との横偏差YEが算出されるところを、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合には、前方注視点が前方側に進行するのを抑制し、前方注視点P1よりも手前側の前方注視点設定限界点P_limitを制御目標となる前方注視点P1’として設定し、その前方注視点P1’において基準経路との横偏差YEを算出している。すなわち、前方注視点P1を補正することで、横偏差YEを補正している。このような処理は、第1前方注視点設定手段が設定した第1前方注視点と基準経路との第1誤差(横偏差YE)を検出する誤差検出手段と、少なくともカーブに進入する手前でカーブ走行路の所定の位置における基準経路との第1誤差が小さくなるように補正する誤差補正手段とを実現している。ここで、所定の位置とは、前方注視点P1である。 Further, as described above, based on the vehicle speed Vc, the forward gazing point P1, which is a control target, is set based on the first forward gazing point distance D1. the place where the lateral deviation Y E is calculated, passable road radius Rn_limit is the case of less than the first forward gaze point position road radius Rn_road is to prevent the forward gaze point progresses to the front side, forward fixed point P1 and 'set as its forward fixed point P1' forward fixed point P1 to the forward gaze point set limit point P_limit the front side becomes a control target to calculate the lateral deviation Y E of the reference path in than. That is, by correcting the headway point P1, it is corrected lateral deviation Y E. Such processing includes error detection means for detecting a first error (lateral deviation Y E ) between the first forward gazing point set by the first forward gazing point setting means and the reference path, and at least before entering the curve. An error correction unit that corrects the first error with respect to the reference route at a predetermined position on the curve traveling route to be small is realized. Here, the predetermined position is the forward gazing point P1.
また、コントローラ17の図2に示すステップS9及びステップS10の処理は、誤差補正手段が補正した第1誤差に基づいて、基準経路に沿って自車両が走行するように当該自車両の操舵量を算出する操舵量算出手段を実現している。
また、コントローラ17の図2に示すステップS4の処理は、自車両が走行可能な道路半径を算出する走行可能道路半径算出手段を実現しており、コントローラ17の図2に示すステップS6の処理は、第1前方注視点における走行路の道路半径を検出する道路半径検出手段を実現しており、コントローラ17の図2に示すステップS7の処理は、道路半径検出手段が検出した第1前方注視点における道路半径と、走行可能道路半径算出手段が算出した自車両が走行可能な道路半径とを比較する比較手段を実現している。また、コントローラ17の図2に示すステップS7の処理は、比較手段の比較結果が、自車両が走行可能な道路半径が第1前方注視点における道路半径未満になっている場合で、かつ走行可能な道路半径となる走行路位置よりも自車両から遠方に第1前方注視点が存在する場合、走行可能な道路半径となる走行路位置に第1前方注視点の位置を変更する誤差補正手段による処理を実現している。
In addition, the processing of step S9 and step S10 shown in FIG. Steering amount calculation means for calculating is realized.
Further, the process of step S4 shown in FIG. 2 of the
10 操舵アクチュエータ
11FL〜11RR 車輪速センサ
12 前後加速度センサ
13 横加速度センサ
14 ヨーレートセンサ
15 GPS
16 記憶ユニット
17 コントローラ
DESCRIPTION OF
16
Claims (10)
カーブ手前で設定した前方注視点に基づく前記誤差を、当該カーブに進入した際に設定する前方注視点に基づく前記誤差に近くなるように補正することを特徴とする車両用自動操舵制御装置。 Automatic steering for vehicles that sets the front gazing point set in front of the host vehicle further from the host vehicle as the host vehicle speed increases, and calculates the steering amount based on the error between the front gazing point and the reference route that forms the travel target route In the control device,
An automatic steering control device for a vehicle, wherein the error based on a forward gazing point set in front of a curve is corrected so as to be close to the error based on a forward gazing point set when entering the curve.
前記前方注視点を自車速が高くなるほど自車両から遠方に設定する前方注視点設定手段と、
前記前方注視点設定手段が設定した前方注視点と前記基準経路との前記誤差を検出する誤差検出手段と、
少なくともカーブに進入する手前でカーブ路内の所定の位置における前記前方注視点と前記基準経路との誤差が小さくなるように補正する誤差補正手段と、
前記誤差補正手段が補正した誤差に基づいて、前記基準経路に沿って自車両が走行するように当該自車両の操舵量を算出する操舵量算出手段と、
を備えたことを特徴とする車両用自動操舵制御装置。 In a vehicle automatic steering control device that sets a forward gazing point in front of the host vehicle and calculates a steering amount based on an error between the forward gazing point and a reference route that forms a travel target route,
Forward gazing point setting means for setting the forward gazing point farther from the host vehicle as the host vehicle speed increases;
Error detecting means for detecting the error between the forward gazing point set by the forward gazing point setting means and the reference path;
Error correction means for correcting so that an error between the forward gazing point and the reference path at a predetermined position in the curve road is reduced at least before entering the curve;
Steering amount calculation means for calculating the steering amount of the host vehicle so that the host vehicle travels along the reference route based on the error corrected by the error correction unit;
An automatic steering control device for a vehicle, comprising:
前記誤差補正手段は、前記比較手段の比較結果が、前記自車両が走行可能な道路半径が前記前方注視点における道路半径未満になっている場合で、かつ前記走行可能な道路半径となる走行路位置よりも自車両から遠方に前記前方注視点が存在する場合、前記走行可能な道路半径となる走行路位置に前記前方注視点の位置を変更することで、前記誤差の補正を行うことを特徴とする請求項2記載の車両用自動操舵制御装置。 Road radius detection means for detecting the road radius of the travel path at the forward gazing point, travelable road radius calculation means for calculating the road radius on which the host vehicle can travel, and the forward gazing point detected by the road radius detection means And a comparison means for comparing the road radius that can be traveled by the host vehicle calculated by the travelable road radius calculation means,
The error correction means is a travel path in which the comparison result of the comparison means is the road radius that allows the vehicle to travel when the road radius on which the host vehicle can travel is less than the road radius at the front gazing point. When the forward gazing point is located farther from the vehicle than the position, the error is corrected by changing the position of the forward gazing point to a traveling road position that is the road radius where the vehicle can travel. The automatic steering control device for a vehicle according to claim 2.
前記操舵量算出手段は、前記第2前方注視点設定手段が設定した第2の前方注視点に基づいて、前記基準経路に沿って自車両が走行するように当該自車両の操舵量を算出することを特徴とする請求項2乃至4のいずれか一項に記載の車両用自動操舵制御装置。 A second forward gazing point setting means for setting a second forward gazing point farther from the vehicle than the forward gazing point;
The steering amount calculation means calculates the steering amount of the host vehicle based on the second forward gazing point set by the second forward gazing point setting unit so that the host vehicle travels along the reference route. The automatic steering control device for a vehicle according to any one of claims 2 to 4, wherein the automatic steering control device is used.
前記操舵量算出手段は、前記第2前方注視点変更手段により位置が変更された第2の前方注視点に基づいて、前記基準経路に沿って自車両が走行するように当該自車両の操舵量を算出することを特徴とする請求項5記載の車両用自動操舵制御装置。 Road radius detecting means for detecting the road radius of the traveling road at the second forward gazing point set by the second forward gazing point setting means, and travelable road radius calculating means for calculating the road radius on which the host vehicle can travel. Comparison means for comparing the road radius at the second forward gazing point detected by the road radius detection means with the road radius on which the host vehicle can be traveled calculated by the travelable road radius calculation means, and the comparison If the road radius in which the vehicle can travel is less than the road radius at the second forward gazing point and the vehicle is more than the travel road position that is the travelable road radius. And a second forward gazing point changing means for changing a position of the second forward gazing point to a travel path position having a radius capable of traveling when the second forward gazing point is present far away from the vehicle. And
The steering amount calculating means controls the steering amount of the host vehicle so that the host vehicle travels along the reference route based on the second forward gazing point whose position has been changed by the second forward gazing point changing unit. The vehicle automatic steering control device according to claim 5, wherein:
前記誤差補正手段は、前記前方注視点設定手段が設定した前方注視点と前記仮想経路設定手段が設定した仮想の曲線経路との第2の誤差を検出し、前記誤差補正手段は、前記誤差を第2の誤差に変更することを特徴とする請求項2乃至4のいずれか一項に記載の車両用自動操舵制御装置。 A travelable road radius calculation unit that calculates a road radius on which the host vehicle can travel, a travel path position that is a road radius calculated by the travelable road radius calculation unit, and a virtual curved path that is in contact with the identified position Virtual route setting means for setting
The error correction unit detects a second error between the forward gazing point set by the forward gazing point setting unit and the virtual curved path set by the virtual route setting unit, and the error correction unit detects the error. The automatic steering control device for a vehicle according to any one of claims 2 to 4, wherein the second error is changed.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003416784A JP4599835B2 (en) | 2003-12-15 | 2003-12-15 | Automatic steering control device for vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003416784A JP4599835B2 (en) | 2003-12-15 | 2003-12-15 | Automatic steering control device for vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2005170327A true JP2005170327A (en) | 2005-06-30 |
JP4599835B2 JP4599835B2 (en) | 2010-12-15 |
Family
ID=34735888
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003416784A Expired - Fee Related JP4599835B2 (en) | 2003-12-15 | 2003-12-15 | Automatic steering control device for vehicle |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4599835B2 (en) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010126077A (en) * | 2008-11-28 | 2010-06-10 | Jtekt Corp | Travel supporting device |
JP2014139063A (en) * | 2012-12-21 | 2014-07-31 | Nippon Soken Inc | Vehicle control device |
DE102014108937A1 (en) | 2013-07-04 | 2015-01-08 | Fuji Jukogyo Kabushiki Kaisha | Travel assistance control device for a vehicle |
JP2015074425A (en) * | 2013-10-11 | 2015-04-20 | 日産自動車株式会社 | Steering controller and steering control method |
JP2017013586A (en) * | 2015-06-30 | 2017-01-19 | 富士重工業株式会社 | Own vehicle position estimation device, steering control device using the same and own vehicle position estimation method |
JP2017206248A (en) * | 2016-12-30 | 2017-11-24 | 東軟集団股▲分▼有限公司 | Method, equipment and device for planning vehicle speed |
JP2018047754A (en) * | 2016-09-20 | 2018-03-29 | 三菱自動車工業株式会社 | Lane-keep support apparatus |
JP2020152137A (en) * | 2019-03-18 | 2020-09-24 | トヨタ自動車株式会社 | Drive assist device |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0667725A (en) * | 1992-08-19 | 1994-03-11 | Nissan Motor Co Ltd | Autonomously running vehicle |
JPH06300580A (en) * | 1993-04-15 | 1994-10-28 | Fuji Heavy Ind Ltd | Control device for tracking vehicle course |
JPH06300581A (en) * | 1993-04-15 | 1994-10-28 | Fuji Heavy Ind Ltd | Control device for tracking vehicle course |
JPH0781602A (en) * | 1993-09-16 | 1995-03-28 | Mitsubishi Motors Corp | Automatic steering gear for vehicle |
JPH10143794A (en) * | 1996-11-07 | 1998-05-29 | Honda Motor Co Ltd | Vehicle controller |
JPH10167100A (en) * | 1996-12-09 | 1998-06-23 | Toyota Motor Corp | Vehicle steering control device |
JP2001001921A (en) * | 1999-06-18 | 2001-01-09 | Mazda Motor Corp | Steering device for vehicle |
JP2003312505A (en) * | 2002-04-18 | 2003-11-06 | Mitsubishi Electric Corp | Steering control device for vehicle |
-
2003
- 2003-12-15 JP JP2003416784A patent/JP4599835B2/en not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0667725A (en) * | 1992-08-19 | 1994-03-11 | Nissan Motor Co Ltd | Autonomously running vehicle |
JPH06300580A (en) * | 1993-04-15 | 1994-10-28 | Fuji Heavy Ind Ltd | Control device for tracking vehicle course |
JPH06300581A (en) * | 1993-04-15 | 1994-10-28 | Fuji Heavy Ind Ltd | Control device for tracking vehicle course |
JPH0781602A (en) * | 1993-09-16 | 1995-03-28 | Mitsubishi Motors Corp | Automatic steering gear for vehicle |
JPH10143794A (en) * | 1996-11-07 | 1998-05-29 | Honda Motor Co Ltd | Vehicle controller |
JPH10167100A (en) * | 1996-12-09 | 1998-06-23 | Toyota Motor Corp | Vehicle steering control device |
JP2001001921A (en) * | 1999-06-18 | 2001-01-09 | Mazda Motor Corp | Steering device for vehicle |
JP2003312505A (en) * | 2002-04-18 | 2003-11-06 | Mitsubishi Electric Corp | Steering control device for vehicle |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010126077A (en) * | 2008-11-28 | 2010-06-10 | Jtekt Corp | Travel supporting device |
JP2014139063A (en) * | 2012-12-21 | 2014-07-31 | Nippon Soken Inc | Vehicle control device |
DE102014108937A1 (en) | 2013-07-04 | 2015-01-08 | Fuji Jukogyo Kabushiki Kaisha | Travel assistance control device for a vehicle |
US9227663B2 (en) | 2013-07-04 | 2016-01-05 | Fuji Jukogyo Kabushiki Kaisha | Driving assist controller for vehicle |
DE102014108937B4 (en) | 2013-07-04 | 2018-08-16 | Subaru Corporation | Travel assistance control device for a vehicle |
JP2015074425A (en) * | 2013-10-11 | 2015-04-20 | 日産自動車株式会社 | Steering controller and steering control method |
JP2017013586A (en) * | 2015-06-30 | 2017-01-19 | 富士重工業株式会社 | Own vehicle position estimation device, steering control device using the same and own vehicle position estimation method |
JP2018047754A (en) * | 2016-09-20 | 2018-03-29 | 三菱自動車工業株式会社 | Lane-keep support apparatus |
JP2017206248A (en) * | 2016-12-30 | 2017-11-24 | 東軟集団股▲分▼有限公司 | Method, equipment and device for planning vehicle speed |
US10407065B2 (en) | 2016-12-30 | 2019-09-10 | Neusoft Corporation | Method, device and apparatus for planning vehicle speed |
JP2020152137A (en) * | 2019-03-18 | 2020-09-24 | トヨタ自動車株式会社 | Drive assist device |
JP7147643B2 (en) | 2019-03-18 | 2022-10-05 | トヨタ自動車株式会社 | Driving support device |
Also Published As
Publication number | Publication date |
---|---|
JP4599835B2 (en) | 2010-12-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108137039B (en) | Vehicle motion control apparatus and method thereof | |
JP4270259B2 (en) | Obstacle avoidance control device | |
US11435195B2 (en) | Route generation device, vehicle and vehicle system | |
JP7193408B2 (en) | vehicle controller | |
WO2023139867A1 (en) | Vehicle movement control device and vehicle movement control method | |
WO2017077807A1 (en) | Vehicle travel control device | |
WO2016110733A1 (en) | Target route generation device and drive control device | |
JP6419671B2 (en) | Vehicle steering apparatus and vehicle steering method | |
KR102378313B1 (en) | Control apparatus and method of autonomous vehicle | |
JP2007331580A (en) | Vehicle speed control system | |
CN111629943B (en) | Driving support device, driving support method, and driving support system | |
JP7188236B2 (en) | vehicle controller | |
JP2021169291A (en) | Drive assist device for vehicle | |
JP4599835B2 (en) | Automatic steering control device for vehicle | |
JP2008059366A (en) | Steering angle determination device, automobile, and steering angle determination method | |
JP4622453B2 (en) | Self-steering vehicle | |
US12103555B2 (en) | Vehicle motion control device and vehicle motion control method | |
JP3933085B2 (en) | Automatic steering device for vehicles | |
JP5045108B2 (en) | Driving support device | |
JP5120300B2 (en) | Driving support device, driving support method, and driving support program | |
JP4403962B2 (en) | Automatic steering control device | |
JP7300068B2 (en) | VEHICLE CONTROL DEVICE, VEHICLE CONTROL METHOD, AND VEHICLE CONTROL SYSTEM | |
JP7463264B2 (en) | Vehicle motion control device and vehicle motion control method | |
JP4148022B2 (en) | Vehicle steering control device | |
WO2023238588A1 (en) | Vehicle motion control device, and vehicle motion control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20061025 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090728 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090924 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100330 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100519 |
|
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: 20100831 |
|
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: 20100913 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131008 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4599835 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |