JP2005170327A - Automatic steering control device for vehicle - Google Patents

Automatic steering control device for vehicle Download PDF

Info

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
Application number
JP2003416784A
Other languages
Japanese (ja)
Other versions
JP4599835B2 (en
Inventor
Yasuhisa Hayakawa
泰久 早川
Takeshi Kimura
健 木村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2003416784A priority Critical patent/JP4599835B2/en
Publication of JP2005170327A publication Critical patent/JP2005170327A/en
Application granted granted Critical
Publication of JP4599835B2 publication Critical patent/JP4599835B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide an automatic steering control device for a vehicle capable of performing steering control smoothly before intruding into a curve and after it. <P>SOLUTION: The automatic steering control device for the vehicle works with such steps as setting the first ahead attention point P<SB>1</SB>farther from the vehicle concerned with higher vehicle speed (Step S5), correcting the first ahead attention point P<SB>1</SB>before intruding to the curve and thereby lessening the transverse deviation Y<SB>E</SB>of the first ahead attention point P<SB>1</SB>in the curve from the reference path (Steps S6-S8), and calculating the steering amount of the vehicle concerned so that it runs along the reference path on the basis of the corrected transverse deviation Y<SB>E</SB>(Step S9). <P>COPYRIGHT: (C)2005,JPO&NCIPI

Description

本発明は、車両の自動操舵を行う車両用自動操舵制御装置に関する。   The present invention relates to an automatic steering control device for a vehicle that performs automatic steering of the vehicle.

車両用自動操舵制御装置として、既知の経路と現在の車両の位置との照合を逐一行うことでトレースする装置が提案されている。例えば特許文献1で開示されている技術では、車両の位置と経路との誤差を検出するために2つの注視点を設けるようにして、車速が高くなればなるほどそれらの注視点を遠くに設定するようにしている。これにより、運転者の感覚に近づけた自動操舵を可能にしている。
特開2000−122719号公報
As an automatic steering control device for a vehicle, a device has been proposed that performs tracing by sequentially comparing a known route with the current vehicle position. For example, in the technique disclosed in Patent Document 1, two gazing points are provided to detect an error between the position of the vehicle and the route, and the gazing points are set farther as the vehicle speed increases. I am doing so. This enables automatic steering close to the driver's feeling.
JP 2000-122719 A

このような従来の車両用自動操舵制御装置にあっては、減速してカーブに進入する場合でも、カーブ直前でまだ車速が高ければ前方注視点距離が長く保たれたままとなる。この場合、カーブ直前で設定される前方注視点がカーブ内において本来通過できないぐらい小さい曲率半径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 engine 2 is transmitted in order through the automatic transmission 3, the propeller shaft 4, the final reduction gear 5, and the axle 6. The front wheels 1FL and 1FR are steering wheels connected to the steering wheel 9 via the steering gear 7 and the steering shaft 8. A steering actuator 10 composed of an electric motor is coupled to the steering shaft 8. The steering actuator 10 is configured to control the steering direction, steering angle, and steering speed of the front wheels 1FL and 1FR according to the steering control amount δC output from the controller 17.

また、車両には、各車輪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 longitudinal acceleration sensor 12 that detects longitudinal acceleration Xg, a lateral acceleration sensor 13 that detects lateral acceleration Yg, and a yaw rate sensor 14 that detects yaw rate φ. The vehicle also includes a GPS (Global Positioning System) 15 that receives satellite radio waves transmitted from an artificial satellite and detects the current position of the vehicle, and a CD-ROM or DVD-ROM that stores road map information in a predetermined area. And a storage unit 16 mounted with the information storage medium.

前述の各車輪速センサ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 longitudinal acceleration sensor 12, the lateral acceleration Yg detected by the lateral acceleration sensor 13, and the self detected by the GPS 15 The vehicle position information and the road map information stored in the storage unit 16 are input to the controller 17 constituted by, for example, a microcomputer. The controller 17 controls the output of the steering control amount δC for the steering actuator 10 described above by constantly executing the steering control process, and causes the host vehicle to travel along the reference route that forms the travel target route by automatic steering. It is configured. FIG. 2 shows the contents of the steering control process.

先ずステップS1において、コントローラ17は、GPS15で検出した自車位置に従って記憶ユニット16に記憶されている道路地図情報を読込む。道路地図情報は、道路形状を複数のノードデータ(X,Y)として表す情報である。そして、コントローラ17は、その読み込んだ道路地図情報を構成するノードデータ(X,Y)のうち、図3に示すように、自車両100の現在位置を基準に、前後の所定距離の範囲内の(n+1)個のノードデータ(X,Y)〜(X,Y)を常時バッファに保有する。これらノードデータ(X,Y)〜(X,Y)の座標を結べば基準経路の形状になる。 First, in step S1, the controller 17 reads the road map information stored in the storage unit 16 in accordance with the vehicle position detected by the GPS 15. The road map information is information representing a road shape as a plurality of node data (X, Y). And the controller 17 is within the range of the predetermined distance before and behind on the basis of the present position of the own vehicle 100 among the node data (X, Y) which comprises the read road map information, as shown in FIG. (N + 1) node data (X 0 , Y 0 ) to (X n , Y n ) are always held in the buffer. If the coordinates of these node data (X 0 , Y 0 ) to (X n , Y n ) are connected, the shape of the reference path is obtained.

また、車両の前方側の前記所定距離については、例えば車速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 controller 17 reads the wheel speeds VFL to VRR, the longitudinal acceleration Xg, the lateral acceleration Yg, and the yaw rate φ output from various sensors.
Subsequently, in step S3, the controller 17 calculates the vehicle speed Vc from the average of the wheel speeds VFL to VRR.

続いてステップS4において、コントローラ17は、前記ステップS3で算出した車速Vcとカーブで許容する横G値Yg_limitとに基づいて、車両が通過可能な道路半径(以下、通過可能道路半径という。)Rn_limitを算出する。例えば下記(1)式により算出する。
Rn_limit=Vc/Yg_limit ・・・(1)
ここで、横G値Yg_limitは固定値である。例えば、横G値Yg_limitを0.3にする。
続いてステップS5において、コントローラ17は、運転者が注視していると見込まれる車両前方に前方注視点(FB(フィードバック)注視点ともいう、以下、第1前方注視点という。)Pを設定する。例えば図4に示すように、車速Vcが高くなるほど大きくなるような前方注視点距離(以下、第1前方注視点距離という。)D1に、第1前方注視点Pを設定する。
Subsequently, in step S4, the controller 17 determines a road radius through which the vehicle can pass (hereinafter referred to as a passable road radius) Rn_limit based on the vehicle speed Vc calculated in step S3 and the lateral G value Yg_limit allowed by the curve. Is calculated. For example, it is calculated by the following equation (1).
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 controller 17, the driver (also referred to as a FB (Feedback) fixation point, hereinafter referred to as the first forward fixed point.) And expected vehicle front forward gaze point gazing setting the P 1 To do. For example, as shown in FIG. 4, as the vehicle speed Vc increases larger such forward observation point distance (hereinafter, referred to as a first look-ahead point distance.) In D1, setting the first forward gaze point P 1.

続いてステップS6において、コントローラ17は、前記ステップS5で設定した第1前方注視点Pにおける道路半径(以下、第1前方注視点位置道路半径という。)Rn_roadを算出する。具体的には以下の手順で算出する。図5を用いて説明する。
先ず、図5に示すように、第1前方注視点Pから前後方向の所定距離DにあるノードをP(以下、前直近ノードPという。)及びP(以下、後直近ノードPという。)を選定する。
ここで、所定距離Dは、車速Vcに例えば一定時間(例えば1秒程度)t2を乗じて得た値(Vc×t2)である。なお、所定距離Dが短くなりすぎないように、最小値DMINを用意しておいて、この最小値DMINと前記車速V及び一定時間t2に基づいて算出する値(D=V×t2)のうち大きい方を、最終的な所定距離Dに設定してもよい。
Subsequently, in step S6, the controller 17, the road radius at the first forward observation point P 1 set in step S5 (hereinafter referred to as the first forward gaze point position road radius.) Is calculated Rn_road. Specifically, it is calculated by the following procedure. This will be described with reference to FIG.
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前方注視点Pと前直近ノードPを結ぶ線分Pと、第1前方注視点Pと後直近ノードPとを結ぶ線分Pとがなす角度θ、及び前直近ノードPと後直近ノードPとの距離dを算出する。
なお、ここでノードとの対比でいう第1前方注視点Pとは、具体的には、第1前方注視点Pに対応するノードである。すなわち、第1前方注視点Pを通り、自車両の速度ベクトルVに直角な直線を描いた場合に、その直線と基準経路との交点Q或いはその交点Qから最も近傍のノードを、ここでは第1前方注視点Pといっている。よって、道路半径を算出する等のためにノードと対比する以外は、第1前方注視点Pは、ノードをいうものではなく、実際の基準経路からずれた位置に設定される第1前方注視点Pをいうものとする。以下の説明でもこのような関係は同様にして扱うものとする。
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.

ここで、前直近ノードP、第1前方注視点P及び後直近ノードPを通る円弧の中心点Oは、線分Pの中点aを通る垂直2等分線Aと、線分Pの中点bを通る垂直2等分線Bとの交点となる。このようなことから、前記角度θは、線分Pの中点aを通る垂直2等分線Aと線分Pの中点bを通る垂直2等分線Bとがなす∠aObの角度として得られる。
そして、前直近ノードPと中心点Oとがなす線分POと後直近ノードPと中心点Oとがなす線分POとがなす∠POPの角度は、前記∠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前方注視点Pを補正する。
具体的には、通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとの比較結果に基づいて、第1前方注視点Pの位置を補正した前方注視点(以下、補正後第1前方注視点という。)P’を算出する。より具体的には、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合で(Rn_limit<Rn_road)、かつ基準経路における通過可能道路半径Rn_limitに対応する前方注視点設定限界点P_limit(自車両と第1前方注視点Pとを含む線上の点、以下同様。)を仮定し、その前方注視点設定限界点P_limitよりも第1前方注視点距離D1を基に設定した第1前方注視点Pが自車両から遠方にある場合、補正後第1前方注視点P’を前方注視点設定限界点P_limitに設定する(P’=P_limit)。
Subsequently, in step S7, the controller 17 compares the passable road radius Rn_limit calculated in step S4 with the first forward gazing point position road radius Rn_road calculated in step S6, thereby comparing the first forward gazing point P 1. Correct.
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前方注視点P’を第1前方注視点Pに設定する(P’=P)。すなわち、第1前方注視点Pの補正を行わない。例えば、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合(Rn_limit<Rn_road)であっても、第1前方注視点Pよりも前方注視点設定限界点P_limitが自車両から遠方にある場合、補正後第1前方注視点P’を第1前方注視点Pに設定する(P’=P)。
これにより、図6に示すように、自車両100の前方に補正後第1前方注視点P’を設定する。
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 host vehicle 100.

続いてステップS8において、コントローラ17は、前記ステップS7で得た補正後第1前方注視点P’について横偏差Yを算出する。具体的には以下の手順で算出する。
先ず、車両のスリップ角θを算出する。具体的には、下記(3)式により、前後加速度Xg及び横加速度Ygに基づいて車両のスリップ角θを算出する。
θ=tan−1(Yg/Xg) ・・・(3)
また、図6に示すように、ヨー角ε及びずれ角εを定義する。ヨー角εは、基準座標に対する自車両100のヨー角となる。また、ずれ角εは、補正後第1前方注視点P’を通り自車両100の速度ベクトルVに直角な直線Cを描き、その直線Cと基準経路との交点Qでの基準座標に対する基準経路のずれ角となる。
Subsequently, in step S8, the controller 17 calculates the lateral deviation Y E for the first forward observation point P 1 'after correction obtained in step S7. Specifically, it is calculated by the following procedure.
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 host vehicle 100 with respect to the reference coordinates. Further, the deviation angle ε T draws a straight line C that passes through the corrected first forward gazing point P 1 ′ and is perpendicular to the speed vector V of the host vehicle 100, and is relative to the reference coordinates at the intersection point Q of the straight line C and the reference route. This is the deviation angle of the reference path.

そして、このように定義した前記ヨー角ε及びずれ角εに基づいて、下記(4)式によりヨー角εを算出する。
ε=ε−ε ・・・(4)
また、図6に示すように、基準経路と自車両100の現在走行位置との横偏差をY、車両姿勢に応じた横偏差Y、及び補正後第1前方注視点P’までの距離D1’を定義する。そして、横偏差Y、補正後第1前方注視点P’までの距離D1’、ヨー角ε及びスリップ角θに基づいて下記(5)式により横偏差Yを算出する。
=Y+D1’×tan(ε+θ) ・・・(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 host vehicle 100 is represented by Y U , the lateral deviation Y S according to the vehicle posture, and the corrected first front gazing point P 1 ′. Define a distance D1 '. Then, based on the lateral deviation Y U , the corrected distance D1 ′ to the first forward gazing point P 1 ′, the yaw angle ε R and the slip angle θ S , the lateral deviation Y S is calculated by the following equation (5).
Y S = Y U + D1 ′ × tan (ε R + θ S ) (5)

また、車両が定常円旋回を行っていると仮定する。このように仮定した場合、スリップレートを無視できるので、車両旋回状態から求まる横偏差Yを下記(6)式により算出する。
=D1’×tanβ ・・・(6)
ここで、βは下記(7)式で表される。
β=1/2×sin−1(D1’×ε/Xg) ・・・(7)
そして、下記(8)式に示すように、横偏差Yと横偏差Yとを加算して基準経路との横偏差Yを算出する。
=Y+Y ・・・(8)
このように、補正後第1前方注視点P’における基準経路との横偏差Yを算出する。
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で算出した横偏差Yに基づいて、下記(9)式により第1操舵量δ1を算出する。
δ1=K1×Y+K2×(dY/dt) ・・・(9)
ここで、K1,K2は係数である。例えば、K1,K2は、直線走行時の外乱に対して追従誤差が拡大しないように最適な値として、実験により求められることが望ましい。
続いてステップS10において、コントローラ17は、前記ステップS9で算出した第1操舵量δ1を最終的な操舵制御量δCとして、操舵アクチュエータ10に出力する。これにより、補正後第1前方注視点P’において自車両が基準経路に沿って走行することになるように操舵制御される。
以上がコントローラ17による操舵制御処理になる。
Subsequently, in Step S9, the controller 17, based on the lateral deviation Y E calculated in step S8, to calculate a first steering amount δ1 by the following equation (9).
δ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 controller 17 outputs the first steering amount δ1 calculated in step S9 to the steering actuator 10 as the final steering control amount δC. Thereby, the steering control is performed so that the host vehicle travels along the reference route at the corrected first forward gazing point P 1 ′.
The above is the steering control process by the controller 17.

すなわち、自車両100の位置を基準に、前後の所定距離の範囲内のノードデータ(X,Y)〜(X,Y)を記憶し、また、各車輪速VFL〜VRR、前後加速度Xg、横加速度Yg及びヨーレートφを読込み、さらに、車速Vcを算出する(ステップS1〜ステップS3)。そして、算出した車速Vcとカーブで許容する横G値Yg_limitとに基づいて通過可能道路半径Rn_limitを算出する(ステップS4)。
続いて、車速Vcに応じて第1前方注視点Pを設定し、その第1前方注視点Pにおける第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 host vehicle 100, and each wheel speed VFL to VRR The acceleration Xg, the lateral acceleration Yg, and the yaw rate φ are read, and the vehicle speed Vc is calculated (steps S1 to S3). Then, a passable road radius Rn_limit is calculated based on the calculated vehicle speed Vc and the lateral G value Yg_limit allowed by the curve (step S4).
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前方注視点P’を得る(ステップS7)。具体的には、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合で(Rn_limit<Rn_road)、かつ前方注視点設定限界点P_limitよりも第1前方注視点Pが自車両から遠方にある場合、補正後第1前方注視点P’を前方注視点設定限界点P_limitに設定する(P’=P_limit)。それ以外の場合、補正後第1前方注視点P’を第1前方注視点Pに設定する(P’=P)。 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前方注視点P’における基準経路との横偏差Yを算出し、算出した横偏差Yに応じた第1操舵量δ1を得て、その第1操舵量δ1を操舵制御量δCとして、操舵アクチュエータ10に出力する(ステップS8〜ステップS10)。
そして、コントローラ17は、所定の時間間隔でこの処理を繰り返して行っており、すなわち、所定の時間間隔で逐次操舵制御量δCを得て、その得た操舵制御量δCを操舵アクチュエータ10に出力している。これにより、補正後第1前方注視点P’において自車両が基準経路に沿って走行することになるように操舵制御される。
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 steering actuator 10 as a steering control amount δC (steps S8 to S10).
The controller 17 repeats this process at a predetermined time interval, that is, obtains the steering control amount δC sequentially at the predetermined time interval, and outputs the obtained steering control amount δC to the steering actuator 10. ing. Thereby, the steering control is performed so that the host vehicle travels along the reference route at the corrected first forward gazing point P 1 ′.

次に第1の実施形態における効果を説明する。
前述したように、補正後第1前方注視点P’における基準経路に沿って走行することになるように操舵制御しており、その補正後第1前方注視点P’は、通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとの比較結果に基づいて得ている(前記ステップS7)。すなわち、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合で(Rn_limit<Rn_road)、かつ前記前方注視点設定限界点P_limitよりも第1前方注視点Pが自車両から遠方にある場合、補正後第1前方注視点P’を前方注視点設定限界点P_limitに設定している。それ以外の場合、補正後第1前方注視点P’を第1前方注視点Pに設定する、すなわち第1前方注視点Pの補正を行わない。具体的には、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合(Rn_limit<Rn_road)であっても、第1前方注視点Pよりも前方注視点設定限界点P_limitが自車両から遠方にある場合、第1前方注視点Pを補正後第1前方注視点P’として、第1前方注視点Pをそのまま用いている。
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前方注視点Pは、車速Vcに応じて決定しており、具体的には車速Vcが高くなるほど遠方になるようにしている。すなわち、第1前方注視点距離D1又は第1前方注視点Pは、従来の手法と同様に車速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前方注視点Pが前方注視点設定限界点P_limitよりも自車両から遠方にある場合で、かつ通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合には、補正後第1前方注視点P’を前方注視点設定限界点P_limitに設定している。
すなわち、図7に示すように、車速Vcに基づけば本来であれば第1前方注視点距離D1に基づいて制御目標となる前方注視点Pが設定され、さらにはその前方注視点P1において基準経路との横偏差Yを算出するところを、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合には、前方注視点Pよりも手前側の前方注視点設定限界点P_limitを制御目標となる前方注視点P’として設定することで、前方注視点P’が前方側に進行するのを抑制して、その前方注視点P’において基準経路との横偏差Yを算出している。そして、この横偏差Yに基づく操舵制御量により操舵制御を行っている。
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.

これにより、カーブに進入する前から横偏差Yが小さく補正されていることから、当該横偏差Yが、自車両が減速してカーブに進入し、その車速に対応した前方注視点が設定され、当該設定された前方注視点に基づいて得られる横偏差Yに近い値に設定されることになる。これにより、カーブ進入前後で、操舵制御量を急変することなくなり、円滑に操舵制御を行うことができる。 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前方注視点という。)Pを設定する。
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 controller 17, forward fixed point for predicting the steering amount of the future (also referred to as a fixation point FF (feed forward), hereinafter referred to as a second forward fixed point.) Setting the P 2.

第2前方注視点Pは前記ステップS5で設定した第1前方注視点Pとは異なる前方注視点として設定される。具体的には、第2前方注視点Pを、図9に示すように、その前方注視点距離(以下、第2前方注視点距離という。)が車速Vcが高くなるほど大きくなるように設定する。そして、第2前方注視点Pを、同一速度において第1前方注視点距離D1よりも第2前方注視点距離D2が大きくなるように、すなわち、第1前方注視点Pよりも自車両から遠方になるように設定する。 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前方注視点Pにおける道路半径(以下、第2前方注視点位置道路半径という。)Rffを算出する。第2前方注視点位置道路半径Rffの算出手順は、基本的には前述の第1の実施形態においてステップS6でした第1前方注視点位置道路半径Rn_roadの算出手順と同様になる。
すなわち、先ず、図10に示すように、第2前方注視点Pから前後方向の所定距離Dにあるノードを前直近ノードP及び後直近ノードPを選定する。
続いて、第2前方注視点Pと前直近ノードPを結ぶ線分Pと、第2前方注視点Pと後直近ノードPとを結ぶ線分Pとがなす角度θ、及び前直近ノードPと後直近ノードPとの距離dを算出する。
Subsequently, in Step S22, the controller 17, the road in the second forward observation point P 2 radius (hereinafter, referred to as a second forward gaze point position road radius.) Is calculated Rff. The procedure for calculating the second forward gazing point position road radius Rff is basically the same as the procedure for calculating the first forward gazing point position road radius Rn_road in step S6 in the first embodiment described above.
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 line segment P 2 P R connecting the front nearest node P F and the second forward fixed point P 2, and the line segment P 2 P F connecting the rear nearest node P F and the second forward fixed point P 2 angle theta, and calculates the distance d between the front nearest node P F and the rear nearest node P R.

ここで、前直近ノードP、第2前方注視点P及び後直近ノードPを通る円弧の中心点Oは、線分Pの中点aを通る垂直2等分線Aと、線分Pの中点bを通る垂直2等分線Bとの交点となる。このようなことから、前記角度θは、線分Pの中点aを通る垂直2等分線Aと線分Pの中点bを通る垂直2等分線Bとがなす∠aObの角度として得られる。
そして、前直近ノードPと中心点Oとがなす線分POと後直近ノードPと中心点Oとがなす線分POとがなす∠POPの角度は、前記∠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 line segment P 2 P F , the intersection of the vertical bisector B passing through the middle point b of the line segment P 2 P R. For this reason, the angle θ is, the vertical bisector B passing through the middle point b of the line segment P 2 P perpendicular bisector passing through the midpoint a of F A and the line segment P 2 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.

以上のような関係から、下記(10)式を用いて、角度θ及び距離dに基づいて第2前方注視点位置道路半径Rffを算出できる。
Rff=d/2×sinθ ・・・(10)
続いてステップS7において、コントローラ17は前方注視点距離を補正する。
前記ステップS5では、前述の第1の実施形態と同様に、第1前方注視点Pも設定している。しかし、このステップS7では、前記ステップS21で設定した第2前方注視点Pだけを補正する。
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 controller 17 corrects the forward gazing distance.
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前方注視点Pの位置を補正した前方注視点(以下、補正後第2前方注視点という。)P’を算出する。より具体的には、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合で(Rn_limit<Rff)、かつ基準経路における通過可能道路半径Rn_limitに対応する前方注視点設定限界点P_limitを仮定し、その前方注視点設定限界点P_limitよりも第2前方注視点距離D2にある第2前方注視点Pが自車両から遠方にある場合、第2前方注視点Pの補正後の値としての補正後第2前方注視点P’を前方注視点設定限界点P_limitに設定する(P’=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前方注視点P’を第2前方注視点Pに設定する(P’=P)。すなわち、それ以外の場合には、第2前方注視点Pの補正を行わない。例えば、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合(Rn_limit<Rff)であっても、第2前方注視点Pよりも前方注視点設定限界点P_limitが自車両から遠方にある場合、補正後第2前方注視点P’を第2前方注視点Pに設定する(P’=P)。 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前方注視点P’における道路半径(以下、補正後第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前方注視点P’に基づいて横偏差Yを算出し、そして第1操舵量δ1を算出する。
なお、前記ステップS7で第2前方注視点Pだけを補正し、第1前方注視点Pを補正していないので、ここで用いる補正後第1前方注視点P’は第1前方注視点Pそのものである。よって、第1前方注視点Pである補正後第1前方注視点P’に基づいて、前述の第1の実施形態と同様に、前記(3)式〜(9)式を用いて、第1操舵量δ1を算出する。
Subsequently, in step S8 and step S9, the controller 17 calculates the lateral deviation Y E based on the corrected first forward gazing point P 1 ′, and calculates the first steering amount δ1.
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 controller 17 calculates the second steering amount δ2 based on the corrected second forward gazing point position road radius Rff ′. Specifically, based on the corrected second forward gazing point position road radius Rff ′ (ρ) and the wheel base L of the vehicle, the second steering amount δ2 is calculated by the following equation (11).
δ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 controller 17 outputs the added value of the first steering amount δ1 and the second steering amount δ2 calculated in step S9 to the steering actuator 10 as the final steering control amount δC (= δ1 + δ2). . The steering control amount δC may be obtained as an average value ((δ1 + δ2) / 2) of the first steering amount δ1 and the second steering amount δ2.
The above is the steering control processing of the controller 17 in the second embodiment.

すなわち、自車両100の位置を基準に、前後の所定距離の範囲内のノードデータ(X,Y)〜(X,Y)を記憶し、また、各車輪速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 host vehicle 100, and each wheel speed VFL to VRR The acceleration Xg, the lateral acceleration Yg, and the yaw rate φ are read, and the vehicle speed Vc is calculated (steps S1 to S3). Then, a passable road radius Rn_limit is calculated based on the calculated vehicle speed Vc and the lateral G value Yg_limit allowed by the curve (step S4).

続いて、車速Vcに応じて第1前方注視点Pを設定する。(ステップS5)。なお、第1前方注視点Pの位置を補正しないことから、その補正時に必要になる第1前方注視点Pにおける第1前方注視点位置道路半径Rn_roadの算出(ステップS6)は行わない。
一方、第2前方注視点Pを設定し、その第2前方注視点Pにおける第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前方注視点Pの位置を補正して、補正後の補正後第2前方注視点P’を得る(ステップS7)。具体的には、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合で(Rn_limit<Rff)、かつ前方注視点設定限界点P_limitよりも第2前方注視点Pが自車両から遠方にある場合、補正後第2前方注視点P’を前方注視点設定限界点P_limitに設定する(P’=P_limit)。それ以外の場合、補正後第2前方注視点P’を第2前方注視点Pに設定する(P’=P)。 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前方注視点P’における基準経路との横偏差Yを算出し、算出した横偏差Yに応じた第1操舵量δ1を算出する。さらに、補正後第2前方注視点P’における補正後第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 steering actuator 10 as the final steering control amount δC (step S10).
The controller 17 repeats this process at a predetermined time interval, that is, obtains the steering control amount δC sequentially at the predetermined time interval, and outputs the obtained steering control amount δC to the steering actuator 10. ing.

次に第2の実施形態における効果を説明する。
前述したように、第2前方注視点Pを第1前方注視点Pより自車両から遠方に設定し、第2前方注視点Pをできるだけ自車両から遠方に位置させ、この第2前方注視点Pを補正した補正後第2前方注視点P’を考慮して自動操舵制御している。ここで、補正後第2前方注視点P’を、通過可能道路半径Rn_limitと第2前方注視点位置道路半径Rffとの比較結果に基づいて得ている(前記ステップS7)。すなわち、通過可能道路半径Rn_limitが第2前方注視点Pにおける第2前方注視点位置道路半径Rff未満の場合で(Rn_limit<Rff)、かつ前記前方注視点設定限界点P_limitよりも第2前方注視点Pが自車両から遠方にある場合、補正後第2前方注視点P’を前方注視点設定限界点P_limitに設定している。それ以外の場合、補正後第2前方注視点P’を第2前方注視点Pに設定する、すなわち、第2前方注視点Pの補正を行わない。具体的には、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合(Rn_limit<Rff)であっても、第2前方注視点Pよりも前方注視点設定限界点P_limitが前方になっている場合、第2前方注視点Pを補正後第2前方注視点P’として、第2前方注視点Pをそのまま用いている。
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に基づいて制御目標となる前方注視点Pが設定されるところを、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rff未満の場合には、前方注視点Pが前方側に進行するのを抑制し、前方注視点Pよりも手前側の前方注視点設定限界点P_limitを制御目標となる前方注視点P’として設定している。
一方、通過可能道路半径Rn_limitが第2前方注視点位置道路半径Rffより大きい場合には、前方注視点Pを補正することなく、その前方注視点Pを基に操舵量又は操舵制御量を決定している。
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前方注視点Pを第1前方注視点Pよりも自車両から遠方に設定することで、第1前方注視点Pよりも遠方の走行路で将来必要になる操舵量を予測するようにしている。これにより、例えば、第1前方注視点P(補正後第1前方注視点P’)が自車両から比較的短い距離に設定された場合でも、道路形状に応じて将来必要な量も加味して操舵量を決定することができる。
さらに、前述したように所定の条件となる場合には、この第2前方注視点P(補正後第2前方注視点P’)を前方注視点設定限界点P_limitにして、第2前方注視点P(補正後第2前方注視点P’)が前方側に進行するのを抑制することで、結果的に、第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前方注視点Pを補正するための処理であったので、これらの処理を省略することで、補正後第1前方注視点P’は、補正されない第1前方注視点Pとなる。
これにより、ステップS8では、第1前方注視点Pに基づいて横偏差Yを算出することになる。
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で算出した横偏差Yを前記ステップS4で算出した通過可能道路半径Rn_limitの経路に基づいて補正する。その補正について、図13を用いて説明する。
前述したように、ノードの集合が基準経路の形状をなすものであるので、ノードにより構成される基準経路が曲線路である場合、各ノードについて道路半径Rを得ることができる。このようなことから、各ノードについて得た道路半径Rのうち、前記ステップS4で算出した通過可能道路半径R_limitと同値になる道路半径Rを特定して、当該道路半径Rを得ているG点(ノード)を特定する。
Then, in step S31 newly provided, the controller 17 is corrected based on the lateral deviation Y E calculated in step S8 in the path of passable roads radius Rn_limit calculated at step S4. The correction will be described with reference to FIG.
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の仮想円を想定し、その想定した仮想円に基づいて、補正後の横偏差(以下、補正後横偏差という。)Y’を算出する。
補正後横偏差Y’の具体的な算出方法を図14を用いて説明する。
なお、前記図13では、基準経路が右カーブとなっている場合を示しており、図14は、基準経路が左カーブとなっている場合を示す。しかし、ここで説明する補正後横偏差Y’の演算は、基準経路のカーブの方向により影響されるものではない。
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.

その演算では、先ず車両のスリップ角θを算出する。具体的には、下記(12)式により、前後加速度Xg及び横加速度Ygに基づいて車両のスリップ角θを算出する。
θ=tan−1(Yg/Xg) ・・・(12)
また、図14に示すように、ヨー角ε及びずれ角ε’を定義する。ヨー角εは、基準座標に対する自車両100のヨー角となる。ずれ角ε’は、補正後第1前方注視点P’を通り自車両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 host vehicle 100 with respect to the reference coordinates. The deviation angle ε T ′ draws a straight line C passing through the corrected first forward gazing point P 1 ′ and perpendicular to the speed vector V of the host vehicle 100, and the straight line C and the path of the virtual circle (hereinafter referred to as a virtual circular path). The deviation angle of the reference path with respect to the reference coordinates at the intersection point Q ′ with.

そして、このように定義した前記ヨー角ε及びずれ角ε’に基づいて、下記(13)式によりヨー角ε’を算出する。
ε’=ε’−ε ・・・(13)
また、図14に示すように、基準経路と自車両100の現在走行位置との横偏差をY、仮想円経路を基準とした車両姿勢に応じた横偏差(以下、仮想円経路基準横偏差という。)Y’、及び補正後第1前方注視点P’までの距離D1’を定義する。そして、横偏差Y、補正後第1前方注視点P’までの距離D1’、ヨー角ε及びスリップ角θに基づいて下記(14)式により仮想円経路基準横偏差Y’を算出する。
’=Y+D1’×tan(ε+θ) ・・・(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 host vehicle 100 is Y U , and the lateral deviation according to the vehicle posture based on the virtual circular route (hereinafter referred to as the virtual circular route reference lateral deviation). YS ′ and the corrected distance D1 ′ to the first forward gazing point P 1 ′ are defined. Then, based on the lateral deviation Y U , the corrected distance D1 ′ to the first forward gazing point P 1 ′, the yaw angle ε R and the slip angle θ S , the virtual circular path reference lateral deviation Y S ′ is obtained by the following equation (14). Is calculated.
Y S ′ = Y U + D 1 ′ × tan (ε R + θ S ) (14)

また、車両が定常円旋回を行っていると仮定する。この仮定により、スリップレートを無視できるので、車両旋回状態から求まる横偏差Yを下記(15)式により算出する。
=D1’×tanβ ・・・(15)
ここで、βは下記(16)式で表される。
β=1/2×sin−1(D1’×ε/Xg) ・・・(16)
そして、下記(17)式に示すように、横偏差Yと横偏差Yとを加算して仮想円経路に対する横偏差(以下、仮想円経路基準横偏差という。)Y’を算出する。
’=Y’+Y ・・・(17)
このように、ステップS31において、仮想円経路を基準として、補正後第1前方注視点P’における仮想円経路基準横偏差Y’を算出する。
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がないような場合には、仮想円経路基準横偏差Y’を、前記ステップS8で算出した横偏差Yに設定してもよい。
続いてステップS9において、コントローラ17は、前記ステップS31で算出した仮想円経路基準横偏差Y’に基づいて、下記(18)式により第1操舵量(以下、仮想円経路基準第1操舵量という。)δ1’を算出する。
δ1’=K1×Y’+K2×(dY’/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 controller 17 calculates the first steering amount (hereinafter referred to as virtual circular path reference first steering amount) by the following equation (18) based on the virtual circular path reference lateral deviation Y E ′ calculated in step S31. ) Δ1 ′ is calculated.
δ1 ′ = K1 × Y E ′ + K2 × (dY E ′ / dt) (18)

ここで、K1,K2は係数である。例えば、K1,K2は、直線走行時の外乱に対して追従誤差が拡大しないように最適な値として、実験により求められることが望ましい。
続いてステップS10において、コントローラ17は、前記ステップS9で算出した仮想円基準第1操舵量δ1’を最終的な操舵制御量δCとして、操舵アクチュエータ10に出力する。これにり、補正後第1前方注視点P’において自車両が仮想円経路に沿って走行することになるように操舵制御される。
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 controller 17 outputs the virtual circle reference first steering amount δ1 ′ calculated in step S9 to the steering actuator 10 as the final steering control amount δC. Thus, the steering control is performed so that the host vehicle travels along the virtual circular route at the corrected first forward gazing point P 1 ′.

以上が第3の実施形態におけるコントローラ17の操舵制御処理になる。
すなわち、自車両100の位置を基準に、前後の所定距離の範囲内のノードデータ(X,Y)〜(X,Y)を記憶し、また、各車輪速VFL〜VRR、前後加速度Xg、横加速度Yg及びヨーレートφを読込み、さらに、車速Vcを算出する(ステップS1〜ステップS3)。そして、算出した車速Vcとカーブで許容する横G値Yg_limitとに基づいて通過可能道路半径Rn_limitを算出する(ステップS4)。
The above is the steering control processing of the controller 17 in the third embodiment.
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 host vehicle 100, and each wheel speed VFL to VRR The acceleration Xg, the lateral acceleration Yg, and the yaw rate φ are read, and the vehicle speed Vc is calculated (steps S1 to S3). Then, a passable road radius Rn_limit is calculated based on the calculated vehicle speed Vc and the lateral G value Yg_limit allowed by the curve (step S4).

続いて、車速Vcに応じて第1前方注視点Pを設定する(ステップS5)。なお、第1前方注視点Pの位置を補正しないことから、その補正時に必要になる第1前方注視点Pにおける第1前方注視点位置道路半径Rn_roadの算出(ステップS6)は行わない。
そして、その補正後第1前方注視点P’(=P)における基準経路との横偏差Yを算出する(ステップS8)。
一方、通過可能道路半径Rn_limitの仮想円経路を設定し、補正後第1前方注視点P’におけるその仮想円経路との仮想円経路基準横偏差Y’を算出する(ステップS31)。そして、その算出した仮想円経路基準横偏差Y’に応じた仮想円経路基準第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前方注視点P’において仮想円経路との仮想円経路基準横偏差Y’を算出して、この仮想円経路基準横偏差Y’に基づいて仮想円経路基準第1操舵量δ1’を決定することで、補正後第1前方注視点P’において仮想円経路に沿って走行することになるように操舵制御している。そして、前述したように、基準経路を構成する各ノードについて通過可能道路半径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前方注視点P’において基準経路を基準に横偏差Yを得るところを、当該補正後第1前方注視点P’において当該基準経路よりも道路半径が大きく設定した仮想円経路を基準にした基準横偏差Y’を得ている。このようにすることで、図13に示すように、横偏差Yよりも小さい基準横偏差Y’に基づいて操舵制御量を算出することができる。 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.

この結果、カーブに進入する前から横偏差Yが小さく補正されて基準横偏差Y’となっていることから、当該基準横偏差Y’が、自車両が減速してカーブに進入し、その車速に対応した前方注視点が設定され、当該設定された前方注視点に基づいて得られる横偏差に近い値に設定されていることになる。これにより、カーブ進入前後で、操舵制御量を急変することなくなり、円滑に操舵制御を行うことができる。 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前方注視点Pが前方注視点設定限界点P_limitよりも自車両から遠方にある場合、補正後第1前方注視点P’を、第1前方注視点Pよりも自車両の手前側にある前方注視点設定限界点P_limitに設定している。この場合、絶対位置で考えた場合、今回演算時の補正後第1前方注視点P’が、前回演算時の補正後第1前方注視点P’よりも自車両手前側に移動する、すなわち補正後第1前方注視点P’が逆戻りしてしまう場合がある。このような逆戻りを防止するような処理を行ってもよい。 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前方注視点P’を前回値P’_oldに代入していき、この前回値P’_oldと今回演算時の補正後第1前方注視点P’とを比較し、今回演算時の補正後第1前方注視点P’が前回値P’_oldよりも自車両に近い位置に存在する場合、今回演算時の補正後第1前方注視点P’を前回値P’_oldに設定する。これにより、補正後第1前方注視点P’が逆戻りしてしまうことを防止する。 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前方注視点P’を設定する場合も同様な処理を行ってもよい。すなわち、前回演算時の補正後第2前方注視点P’を前回値P’_oldに代入していき、この前回値P’_oldと今回演算時の補正後第2前方注視点P’とを比較し、今回演算時の補正後第2前方注視点P’が前回値P’_oldよりも自車両に近い位置に存在する場合、今回演算時の補正後第1前方注視点P’を前回値P’_oldに設定する。これにより、補正後第2前方注視点P’が逆戻りしてしまうことを防止する。 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前方注視点Pの位置を補正しない場合、すなわち第1前方注視点Pの位置を固定した場合を説明した。しかし、これに限定されるものではない。例えば、第1前方注視点Pについても、前述の第1の実施形態のように、通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとの比較結果に応じて補正してもよい。このように補正を行った場合、前方注視点設定限界点P_limitに補正された補正後第1前方注視点P’に基づいて得た第1操舵量δ1と補正後第2前方注視点P’に基づいて得た第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前方注視点Pの位置を補正しない場合、すなわち第1前方注視点Pの位置を固定した場合を説明した。しかし、これに限定されるものではない。例えば、前述の第1の実施形態のように、第1前方注視点Pを通過可能道路半径Rn_limitと第1前方注視点位置道路半径Rn_roadとの比較結果に応じて補正してもよい。このように補正を行った場合、その補正後の第1前方注視点P(補正後第1前方注視点P’)において仮想円経路との仮想円経路基準横偏差Y’を算出することができるようになる。
なお、前述の実施形態の説明において、コントローラ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 controller 17 realizes a first forward gazing point setting unit that sets the first forward gazing point farther from the host vehicle as the host vehicle speed increases. doing.

また、前述したように、車速Vcに基づけば本来であれば第1前方注視点距離D1に基づいて制御目標となる前方注視点P1が設定され、さらにはその前方注視点P1において基準経路との横偏差Yが算出されるところを、通過可能道路半径Rn_limitが第1前方注視点位置道路半径Rn_road未満の場合には、前方注視点が前方側に進行するのを抑制し、前方注視点P1よりも手前側の前方注視点設定限界点P_limitを制御目標となる前方注視点P1’として設定し、その前方注視点P1’において基準経路との横偏差Yを算出している。すなわち、前方注視点P1を補正することで、横偏差Yを補正している。このような処理は、第1前方注視点設定手段が設定した第1前方注視点と基準経路との第1誤差(横偏差Y)を検出する誤差検出手段と、少なくともカーブに進入する手前でカーブ走行路の所定の位置における基準経路との第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 controller 17 realizes a travelable road radius calculation means for calculating the road radius on which the host vehicle can travel, and the process of step S6 of the controller 17 shown in FIG. The road radius detection means for detecting the road radius of the travel path at the first forward gazing point is realized, and the processing of step S7 shown in FIG. 2 of the controller 17 is performed by the first forward gazing point detected by the road radius detection means. The comparison means for comparing the road radius and the road radius that can be traveled by the host vehicle calculated by the travelable road radius calculation means is realized. Further, the processing of step S7 shown in FIG. 2 of the controller 17 is performed when the comparison result of the comparison means is that the road radius on which the host vehicle can travel is less than the road radius at the first forward gazing point. When the first forward gazing point is located farther from the vehicle than the traveling road position having the correct road radius, the error correction unit changes the position of the first forward gazing point to the traveling road position having the road radius that can be traveled. Processing is realized.

本発明の実施形態の概略構成図である。It is a schematic block diagram of embodiment of this invention. 第1の実施形態における操舵制御処理を示すフローチャートである。It is a flowchart which shows the steering control process in 1st Embodiment. 道路地図情報の構成(ノードデータ)を説明した図である。It is a figure explaining the structure (node data) of road map information. 第1前方注視点Pを設定するための特性図である。It is a characteristic diagram for setting the first forward gaze point P 1. 第1前方注視点Pにおける第1前方注視点位置道路半径Rn_roadの算出方法の説明に使用した図である。It is a diagram used for explaining a method of calculating the first headway point position road radius Rn_road at the first forward observation point P 1. 第1前方注視点Pにおける横偏差Yの算出方法の説明に使用した図である。It is a diagram used for explaining a method of calculating the lateral deviation Y E at the first forward observation point P 1. 第1の実施形態における効果の説明に使用した図である。It is the figure used for description of the effect in 1st Embodiment. 第2の実施形態における操舵制御処理を示すフローチャートである。It is a flowchart which shows the steering control process in 2nd Embodiment. 第2前方注視点Pを設定するための特性図である。Is a characteristic diagram for setting the second forward gaze point P 2. 第2前方注視点Pにおける第2前方注視点位置道路半径Rffの算出方法の説明に使用した図である。It is a diagram used for explaining a method of calculating the second headway point position road radius Rff at the second forward observation point P 2. 第2の実施形態における効果の説明に使用した図である。It is the figure used for description of the effect in 2nd Embodiment. 第3の実施形態における操舵制御処理を示すフローチャートである。It is a flowchart which shows the steering control process in 3rd Embodiment. 通過可能道路半径R_limitとなる仮想円経路の設定の説明に使用した図である。It is the figure used for description of the setting of the virtual circular path | route used as the passable road radius R_limit. 補正後第1前方注視点P’における補正後横偏差Y’の算出方法の説明に使用した図である。It is a diagram used for explaining a method of calculating the 'corrected lateral deviation Y E' in first forward observation point P 1 after the correction. 車速に応じて横G値Yg_limitを設定するための特性図である。It is a characteristic view for setting lateral G value Yg_limit according to vehicle speed. 第2前方注視点Pを設定するための他の特性図である。Is another characteristic diagram for setting the second forward gaze point P 2.

符号の説明Explanation of symbols

10 操舵アクチュエータ
11FL〜11RR 車輪速センサ
12 前後加速度センサ
13 横加速度センサ
14 ヨーレートセンサ
15 GPS
16 記憶ユニット
17 コントローラ
DESCRIPTION OF SYMBOLS 10 Steering actuator 11FL-11RR Wheel speed sensor 12 Longitudinal acceleration sensor 13 Lateral acceleration sensor 14 Yaw rate sensor 15 GPS
16 Storage unit 17 Controller

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.
前記誤差補正手段は、前記操舵量算出手段が前回の操舵量の算出に用いた前方注視点の位置に又はその位置よりも自車両から遠方に前方注視点の位置を変更することを特徴とする請求項3記載の車両用自動操舵制御装置。   The error correction means changes the position of the front gazing point to the position of the front gazing point used for the previous calculation of the steering amount or farther from the vehicle than the position. The automatic steering control device for a vehicle according to claim 3. 前記前方注視点よりも自車両から遠方に第2の前方注視点を設定する第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の前方注視点における走行路の道路半径を検出する道路半径検出手段と、自車両が走行可能な道路半径を算出する走行可能道路半径算出手段と、前記道路半径検出手段が検出した前記第2の前方注視点における道路半径と、前記走行可能道路半径算出手段が算出した前記自車両が走行可能な道路半径とを比較する比較手段と、前記比較手段の比較結果が、前記自車両が走行可能な道路半径が前記第2の前方注視点における道路半径未満になっている場合で、かつ前記走行可能な道路半径となる走行路位置よりも自車両から遠方に前記第2の前方注視点が存在する場合、前記走行可能な道路半径となる走行路位置に前記第2の前方注視点の位置を変更する第2前方注視点変更手段とを備えており、
前記操舵量算出手段は、前記第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の前方注視点の位置を変更することを特徴とする請求項6記載の車両用自動操舵制御装置。   The second forward gazing point changing means is a second forward gazing point at the position of the second forward gazing point used by the steering amount calculation means for the previous calculation of the steering amount or farther from the host vehicle than the position. The vehicle automatic steering control device according to claim 6, wherein the position of the vehicle is changed. 自車両が走行可能な道路半径を算出する走行可能道路半径算出手段と、前記走行可能道路半径算出手段が算出した道路半径となる走行路位置を特定し、その特定した位置に接する仮想の曲線経路を設定する仮想経路設定手段とを備えており、
前記誤差補正手段は、前記前方注視点設定手段が設定した前方注視点と前記仮想経路設定手段が設定した仮想の曲線経路との第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.
前記走行可能道路半径算出手段は、所定の自車両の横加速度に基づいて当該自車両が走行可能な道路半径を算出することを特徴とする請求項3乃至8のいずれか一項に記載の車両用自動操舵制御装置。   The vehicle according to any one of claims 3 to 8, wherein the travelable road radius calculation means calculates a road radius on which the host vehicle can travel based on a predetermined lateral acceleration of the host vehicle. Automatic steering control device. 前記自車両の横加速度は、自車両の速度に応じて変化することを特徴とする請求項9記載の車両用自動操舵制御装置。   The automatic steering control device for a vehicle according to claim 9, wherein the lateral acceleration of the host vehicle changes according to the speed of the host vehicle.
JP2003416784A 2003-12-15 2003-12-15 Automatic steering control device for vehicle Expired - Lifetime JP4599835B2 (en)

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 - Lifetime 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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0667725A (en) * 1992-08-19 1994-03-11 Nissan Motor Co Ltd Autonomously running vehicle
JPH06300581A (en) * 1993-04-15 1994-10-28 Fuji Heavy Ind Ltd Control device for tracking vehicle course
JPH06300580A (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

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0667725A (en) * 1992-08-19 1994-03-11 Nissan Motor Co Ltd Autonomously running vehicle
JPH06300581A (en) * 1993-04-15 1994-10-28 Fuji Heavy Ind Ltd Control device for tracking vehicle course
JPH06300580A (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)

* Cited by examiner, † Cited by third party
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
WO2017077807A1 (en) Vehicle travel control device
WO2023139867A1 (en) Vehicle movement control device and vehicle movement control method
JP7193408B2 (en) vehicle controller
JP6419671B2 (en) Vehicle steering apparatus and vehicle steering method
JP2007331580A (en) Vehicle speed control system
KR102378313B1 (en) Control apparatus and method of autonomous vehicle
CN111629943B (en) Driving support device, driving support method, and driving support system
JP2021169291A (en) Drive assist device for vehicle
US20200307612A1 (en) Vehicle control device
JP2008059366A (en) Steering angle determination device, automobile, and steering angle determination method
JP4599835B2 (en) Automatic steering control device for vehicle
US20230137911A1 (en) Vehicle motion control device and vehicle motion control method
JP3933085B2 (en) Automatic steering device for vehicles
JP4622453B2 (en) Self-steering vehicle
JP5045108B2 (en) Driving support device
JP5120300B2 (en) Driving support device, driving support method, and driving support program
JP4403962B2 (en) Automatic steering control device
JP4148022B2 (en) Vehicle steering control device
JP7300068B2 (en) VEHICLE CONTROL DEVICE, VEHICLE CONTROL METHOD, AND VEHICLE CONTROL SYSTEM
WO2023238588A1 (en) Vehicle motion control device, and vehicle motion control method
JP7463264B2 (en) Vehicle motion control device and vehicle motion control method
WO2022190585A1 (en) Vehicle control device, vehicle control method, and vehicle control system

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 Written amendment

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 Written amendment

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