JP2018052270A - Steering control device for vehicle - Google Patents

Steering control device for vehicle Download PDF

Info

Publication number
JP2018052270A
JP2018052270A JP2016189948A JP2016189948A JP2018052270A JP 2018052270 A JP2018052270 A JP 2018052270A JP 2016189948 A JP2016189948 A JP 2016189948A JP 2016189948 A JP2016189948 A JP 2016189948A JP 2018052270 A JP2018052270 A JP 2018052270A
Authority
JP
Japan
Prior art keywords
target
vehicle
rudder angle
steering
steering angle
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
JP2016189948A
Other languages
Japanese (ja)
Other versions
JP6694359B2 (en
Inventor
貴嗣 久保
Takatsugu Kubo
貴嗣 久保
レイエス樹 白久
Reyes Tatsuru Shiroku
レイエス樹 白久
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Subaru Corp
Original Assignee
Subaru Corp
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 Subaru Corp filed Critical Subaru Corp
Priority to JP2016189948A priority Critical patent/JP6694359B2/en
Publication of JP2018052270A publication Critical patent/JP2018052270A/en
Application granted granted Critical
Publication of JP6694359B2 publication Critical patent/JP6694359B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To achieve appropriate traveling along a target course by appropriately determining a running state of a vehicle and bringing an actual steering angle of the vehicle close to a target steering angle accurately and stably.SOLUTION: A target steering angle δt required for an own vehicle to run along a target course is calculated by calculation including a first integration term for executing at least integration processing and steering angle control is executed by calculation including a second integration term for executing at least integration processing so that an actual steering angle δr becomes the target steering angle δt. At this time, when a stopping state of the own vehicle is detected, addition of the first integration term used for calculation of the target steering angle δt is stopped and retained and addition of the second integration term used for steering angle control is stopped and retained. On the other hand, when starting from a stopping state of the own vehicle is detected, the target steering angle δt is set at an actual steering angle δr of the own vehicle at that time, and the second integration term used for steering angle control is reset.SELECTED DRAWING: Figure 4

Description

本発明は、目標コースを設定し、該目標コースに沿って追従走行するように制御する車両の操舵制御装置に関する。   The present invention relates to a steering control device for a vehicle that sets a target course and performs control so as to follow the target course.

近年、車両においては、自動運転やドライバの運転支援の技術として、設定した目標コースに沿って走行するように操舵制御する様々な技術が提案され、実用化されている。例えば、特開2015−20604号公報(以下、特許文献1)では、設定した目標コースに沿って自車両を追従させるレーンキープ制御において、目標舵角と実際の舵角との偏差を算出し、該偏差に比例した比例値を算出し、該偏差を積分した積分値を算出し、該偏差を微分した微分値を算出し、これら比例値と積分値と微分値を加算して電動パワーステアリングモータに対する追従指令を算出する電動パワーステアリングモータ制御装置の技術が開示されている。   2. Description of the Related Art In recent years, various techniques for steering control so as to travel along a set target course have been proposed and put into practical use in vehicles as techniques for automatic driving and driver assistance. For example, in Japanese Patent Laying-Open No. 2015-20604 (hereinafter referred to as Patent Document 1), in lane keeping control in which the host vehicle follows a set target course, a deviation between the target rudder angle and the actual rudder angle is calculated. An electric power steering motor that calculates a proportional value proportional to the deviation, calculates an integral value obtained by integrating the deviation, calculates a differential value obtained by differentiating the deviation, and adds the proportional value, the integral value, and the differential value A technique of an electric power steering motor control device that calculates a follow-up command for the above is disclosed.

特開2015−20604号公報JP2015-20604 A

ところで、上述の特許文献1に開示される電動パワーステアリングモータ制御装置のように、目標値(目標舵角)と実際値(実舵角)との偏差を無くすために、追従指令に偏差の積分項を設けることは一般的に行われる。しかしながら、車両停止時は、タイヤの転舵に対する摩擦等の抵抗が大きいため、目標舵角と実舵角の偏差がゼロに収束しない、もしくは長時間を要するので偏差の積分項が大きくなり、追従指令が過剰に大きくなるという課題がある。また同時に、自車両を目標コースに追従させるために目標コースと自車との位置偏差を積分し、これを目標舵角に加えることが一般的であるが、車両停止時は、車両位置が変化しないため、位置偏差はゼロとならず、積分が増加し続けることによって目標舵角が過剰に大きくなるという課題がある。そしてこのような追従指令、および目標舵角のまま車両が発進すると、操舵制御により転舵が急激に行われ、意図しない操舵がなされてしまう虞がある。   By the way, in order to eliminate the deviation between the target value (target rudder angle) and the actual value (actual rudder angle) as in the electric power steering motor control device disclosed in Patent Document 1 described above, the deviation is integrated into the follow-up command. The provision of terms is generally done. However, when the vehicle is stopped, the resistance of the tire to the steering, such as friction, is large, so the deviation between the target rudder angle and the actual rudder angle does not converge to zero, or it takes a long time, so the integral term of the deviation becomes large and follows There is a problem that the directive becomes excessively large. At the same time, in order to make the host vehicle follow the target course, it is common to integrate the position deviation between the target course and the host vehicle and add this to the target rudder angle, but the vehicle position changes when the vehicle stops. Therefore, the position deviation does not become zero, and there is a problem that the target rudder angle becomes excessively large as the integration continues to increase. When the vehicle starts with such a follow-up command and the target rudder angle, the steering is abruptly steered and unintended steering may be performed.

本発明は上記事情に鑑みてなされたもので、車両の運転状態を適切に判断し、車両の実舵角を目標舵角に精度良く、安定して近づけて目標コースに沿って適切に走行することが可能な車両の操舵制御装置を提供することを目的としている。   The present invention has been made in view of the above circumstances, and appropriately determines the driving state of the vehicle, accurately and stably approaches the target rudder angle of the vehicle to the target rudder angle, and travels appropriately along the target course. An object of the present invention is to provide a steering control device for a vehicle that can be used.

本発明の車両の操舵制御装置の一態様は、自車両の前方環境情報と走行情報に基づいて目標コースを設定し、自車両が前記目標コースに沿って走行するのに必要な目標舵角を少なくとも積分処理を行う第1の積分項を含む演算により算出する目標舵角算出手段と、自車両の実際の舵角が前記目標舵角になるように少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する舵角制御手段とを備えた車両の操舵制御装置であって、自車両の停止状態を検出した際、前記目標舵角算出手段は、前記目標舵角の算出に用いる前記第1の積分項の加算を停止し保持すると共に、前記舵角制御手段は、前記舵角制御に用いる前記第2の積分項の加算を停止し保持する。また、本発明の車両の操舵制御装置の他の一態様は、自車両の前方環境情報と走行情報に基づいて目標コースを設定し、自車両が前記目標コースに沿って走行するのに必要な目標舵角を少なくとも積分処理を行う第1の積分項を含む演算により算出する目標舵角算出手段と、自車両の実際の舵角が前記目標舵角になるように少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する舵角制御手段とを備えた車両の操舵制御装置であって、自車両の停止状態からの発進を検出した際、前記目標舵角算出手段は、前記目標舵角を、そのときの自車両の実際の舵角に設定すると共に、前記舵角制御手段は、前記舵角制御に用いる前記第2の積分項をリセットする。更に、本発明の車両の操舵制御装置の他の異なる一態様は、自車両の前方環境情報と走行情報に基づいて目標コースを設定し、自車両が前記目標コースに沿って走行するのに必要な目標舵角を少なくとも積分処理を行う第1の積分項を含む演算により算出する目標舵角算出手段と、自車両の実際の舵角が前記目標舵角になるように少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する舵角制御手段とを備えた車両の操舵制御装置であって、自車両の停止状態を検出した際、前記目標舵角算出手段は、前記目標舵角の算出に用いる前記第1の積分項の加算を停止し保持すると共に、前記舵角制御手段は、前記舵角制御に用いる前記第2の積分項の加算を停止し保持する一方、自車両の停止状態からの発進を検出した際、前記目標舵角算出手段は、前記目標舵角を、そのときの自車両の実際の舵角に設定すると共に、前記舵角制御手段は、前記舵角制御に用いる前記第2の積分項をリセットする。   One aspect of the steering control device for a vehicle according to the present invention sets a target course based on forward environment information and travel information of the host vehicle, and sets a target steering angle required for the host vehicle to travel along the target course. A target rudder angle calculating means for calculating by calculation including at least a first integral term for performing integration processing; and a second integral term for performing at least integration processing so that the actual rudder angle of the host vehicle becomes the target rudder angle. A steering control device for a vehicle comprising a steering angle control means for controlling the steering angle by a calculation including the target steering angle calculation means used to calculate the target steering angle when a stop state of the host vehicle is detected. The addition of the first integral term is stopped and held, and the steering angle control means stops and holds the addition of the second integral term used for the steering angle control. Another aspect of the vehicle steering control device according to the present invention is required to set a target course based on the front environment information and travel information of the host vehicle and to travel along the target course. A target rudder angle calculating means for calculating a target rudder angle by a calculation including at least a first integral term for performing an integration process; and a second for performing at least an integration process so that the actual rudder angle of the host vehicle becomes the target rudder angle. A steering angle control means for controlling the steering angle by a calculation including an integral term of the vehicle, and when the vehicle starts from a stop state, the target steering angle calculation means The target rudder angle is set to the actual rudder angle of the host vehicle at that time, and the rudder angle control means resets the second integral term used for the rudder angle control. Furthermore, another different aspect of the steering control device for a vehicle according to the present invention is required for setting a target course based on the front environment information and the traveling information of the host vehicle, and for the host vehicle to travel along the target course. A target rudder angle calculating means for calculating a correct target rudder angle by a calculation including at least a first integral term for performing an integration process; A steering angle control means for controlling the steering angle by a calculation including an integral term of 2 when the stop state of the host vehicle is detected. While the addition of the first integral term used for calculating the angle is stopped and held, the steering angle control means stops and holds the addition of the second integral term used for the steering angle control. When a start from a stop state is detected, Steering angle calculating means, the target steering angle, and sets the actual steering angle of the vehicle at that time, the steering angle control unit resets the second integral term used for the steering angle control.

本発明による車両の操舵制御装置によれば、車両の運転状態を適切に判断し、車両の実舵角を目標舵角に精度良く、安定して近づけて目標コースに沿って適切に走行することが可能となる。   According to the vehicle steering control device of the present invention, it is possible to appropriately determine the driving state of the vehicle, and to appropriately travel along the target course by bringing the actual steering angle of the vehicle close to the target steering angle accurately and stably. Is possible.

本発明の実施の一形態に係る、車両の操舵系の構成説明図である。1 is a configuration explanatory diagram of a vehicle steering system according to an embodiment of the present invention. FIG. 本発明の実施の一形態に係る、操舵制御部の機能ブロック図である。It is a functional block diagram of a steering control part concerning one embodiment of the present invention. 本発明の実施の一形態に係る、車両状態判定処理プログラムのフローチャートである。It is a flowchart of the vehicle state determination processing program based on one Embodiment of this invention. 本発明の実施の一形態に係る、目標舵角制御ルーチンのフローチャートである。It is a flowchart of the target rudder angle control routine based on one Embodiment of this invention. 本発明の実施の一形態に係る、車線の各曲率成分の説明図である。It is explanatory drawing of each curvature component of the lane based on one Embodiment of this invention. 本発明の実施の一形態に係る、自車両の推定される車両軌跡と目標コースの車幅方向における位置のズレ量の説明図である。It is explanatory drawing of the deviation | shift amount of the position in the vehicle width direction of the estimated vehicle locus | trajectory of the own vehicle and a target course based on one Embodiment of this invention. 本発明の実施の一形態に係る、目標コースに対するヨー角の説明図である。It is explanatory drawing of the yaw angle with respect to the target course based on one Embodiment of this invention.

以下、図面に基づいて本発明の実施の形態を説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

図1において、符号1は操舵角をドライバ入力と独立して設定自在な電動パワーステアリング装置を示し、この電動パワーステアリング装置1は、ステアリング軸2が、図示しない車体フレームにステアリングコラム3を介して回動自在に支持されており、その一端が運転席側へ延出され、他端がエンジンルーム側へ延出されている。ステアリング軸2の運転席側端部には、ステアリングホイール4が固設され、また、エンジンルーム側へ延出する端部には、ピニオン軸5が連設されている。   In FIG. 1, reference numeral 1 denotes an electric power steering device in which a steering angle can be set independently of a driver input. In the electric power steering device 1, a steering shaft 2 is connected to a vehicle body frame (not shown) via a steering column 3. It is rotatably supported, and one end thereof extends to the driver's seat side and the other end extends to the engine room side. A steering wheel 4 is fixed to an end portion of the steering shaft 2 on the driver's seat side, and a pinion shaft 5 is connected to an end portion extending to the engine room side.

エンジンルームには、車幅方向へ延出するステアリングギヤボックス6が配設されており、このステアリングギヤボックス6にラック軸7が往復移動自在に挿通支持されている。このラック軸7に形成されたラック(図示せず)に、ピニオン軸5に形成されたピニオンが噛合されて、ラックアンドピニオン式のステアリングギヤ機構が形成されている。   A steering gear box 6 extending in the vehicle width direction is disposed in the engine room, and a rack shaft 7 is inserted into and supported by the steering gear box 6 so as to be reciprocally movable. A rack (not shown) formed on the rack shaft 7 is engaged with a pinion formed on the pinion shaft 5 to form a rack and pinion type steering gear mechanism.

また、ラック軸7の左右両端はステアリングギヤボックス6の端部から各々突出されており、その端部に、タイロッド8を介してフロントナックル9が連設されている。このフロントナックル9は、操舵輪としての左右輪10L,10Rを回動自在に支持すると共に、車体フレームに転舵自在に支持されている。従って、ステアリングホイール4を操作し、ステアリング軸2、ピニオン軸5を回転させると、このピニオン軸5の回転によりラック軸7が左右方向へ移動し、その移動によりフロントナックル9がキングピン軸(図示せず)を中心に回動して、左右輪10L,10Rが左右方向へ転舵される。   The left and right ends of the rack shaft 7 protrude from the end of the steering gear box 6, and a front knuckle 9 is connected to the end via a tie rod 8. The front knuckle 9 rotatably supports left and right wheels 10L and 10R as steering wheels and is supported by a vehicle body frame so as to be steerable. Accordingly, when the steering wheel 4 is operated and the steering shaft 2 and the pinion shaft 5 are rotated, the rack shaft 7 is moved in the left-right direction by the rotation of the pinion shaft 5, and the front knuckle 9 is moved by the movement to the kingpin shaft (not shown). And the left and right wheels 10L, 10R are steered in the left-right direction.

また、ピニオン軸5にアシスト伝達機構11を介して、電動パワーステアリングモータ(電動モータ)12が連設されており、この電動モータ12にてステアリングホイール4に加える操舵トルクのアシスト、及び、設定された目標舵角δtとなるような操舵トルク(指示トルク)の付加が行われる。電動モータ12は、後述する操舵制御部20から制御量(制御トルク)Tpがモータ駆動部21に出力されてモータ駆動部21により駆動される。   Further, an electric power steering motor (electric motor) 12 is connected to the pinion shaft 5 via an assist transmission mechanism 11, and assists and sets the steering torque applied to the steering wheel 4 by the electric motor 12. The steering torque (indicated torque) is added so as to achieve the target steering angle δt. The electric motor 12 is driven by the motor drive unit 21 by outputting a control amount (control torque) Tp from a steering control unit 20 described later to the motor drive unit 21.

操舵制御部20には、車両の前方環境を認識して前方環境情報を取得する前方環境認識装置31、車速Vを検出する車速センサ32、操舵角(実舵角)δrを検出する操舵角センサ33等が接続されている。   The steering control unit 20 includes a front environment recognition device 31 that recognizes the front environment of the vehicle and acquires front environment information, a vehicle speed sensor 32 that detects the vehicle speed V, and a steering angle sensor that detects the steering angle (actual steering angle) δr. 33 etc. are connected.

前方環境認識装置31は、例えば、車室内の天井前方に一定の間隔をもって取り付けられ、車外の対象を異なる視点からステレオ撮像する1組のカメラと、このカメラからの画像データを処理する画像処理装置とから構成されている。   The front environment recognition device 31 is, for example, attached to the front of the ceiling in a vehicle interior at a constant interval, and a pair of cameras that take a stereo image of an object outside the vehicle from different viewpoints, and an image processing device that processes image data from this camera It consists of and.

前方環境認識装置31のステレオ画像処理装置における、カメラからの画像データの処理は、例えば以下のように行われる。まず、カメラで撮像した自車両の進行方向の1組のステレオ画像対に対し、対応する位置のずれ量から距離情報を求め、距離画像を生成する。   The processing of image data from the camera in the stereo image processing device of the forward environment recognition device 31 is performed as follows, for example. First, distance information is obtained from a pair of stereo image pairs taken in the traveling direction of the host vehicle captured by the camera from a corresponding positional shift amount to generate a distance image.

白線等の車線区画線のデータの認識では、車線区画線は道路面と比較して高輝度であるという知得に基づき、道路の幅方向の輝度変化を評価して、画像平面における左右の車線区画線の位置を画像平面上で特定する。この車線区画線の実空間上の位置(x,y,z)は、画像平面上の位置(i,j)とこの位置に関して算出された視差とに基づいて、すなわち、距離情報に基づいて、周知の座標変換式より算出される。自車両の位置を基準に設定された実空間の座標系は、本実施の形態では、例えば、図6に示すように、カメラの中央真下の道路面を原点として、車幅方向をx軸、車高方向をy軸、車長方向(距離方向)をz軸とする。このとき、x−z平面(y=0)は、道路が平坦な場合、道路面と一致する。道路モデルは、道路上の自車両の走行レーンを距離方向に複数区間に分割し、各区間における左右の車線区画線を所定に近似して連結することによって表現される。尚、本実施の形態では、走行路の形状を1組のカメラからの画像を基に認識する例で説明したが、他に、単眼カメラ、カラーカメラからの画像情報を基に求めるものであっても良い。   In recognition of lane markings such as white lines, the left and right lanes on the image plane are evaluated based on the knowledge that the lane markings are brighter than the road surface. The position of the lane marking is specified on the image plane. The position (x, y, z) of the lane marking in the real space is based on the position (i, j) on the image plane and the parallax calculated with respect to this position, that is, based on the distance information. It is calculated from a known coordinate conversion formula. In the present embodiment, the coordinate system of the real space set based on the position of the host vehicle is, for example, as shown in FIG. 6, with the road surface directly below the center of the camera as the origin, the vehicle width direction as the x axis, The vehicle height direction is the y-axis, and the vehicle length direction (distance direction) is the z-axis. At this time, the xz plane (y = 0) coincides with the road surface when the road is flat. The road model is expressed by dividing the traveling lane of the host vehicle on the road into a plurality of sections in the distance direction and connecting the left and right lane markings in each section to a predetermined approximation. In the present embodiment, the example of recognizing the shape of the travel path based on images from a set of cameras has been described. However, the shape is obtained based on image information from a monocular camera and a color camera. May be.

そして、操舵制御部20は、上述の各入力信号に基づき、自車両の前方環境情報と走行情報に基づいて目標コースを設定し、自車両が目標コースに沿って走行するのに必要な目標舵角δtを少なくとも積分処理を行う第1の積分項を含む演算により算出して、実舵角δrが目標舵角δtになるように少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する。この際、自車両の停止状態を検出した際は、目標舵角δtの算出に用いる第1の積分項の加算を停止し保持すると共に、舵角制御に用いる第2の積分項の加算を停止し保持する一方、自車両の停止状態からの発進を検出した際には、目標舵角δtを、そのときの自車両の実舵角δrに設定すると共に、舵角制御に用いる第2の積分項をリセットする。   Then, the steering control unit 20 sets a target course based on the front environment information and the travel information of the host vehicle based on each input signal described above, and the target rudder necessary for the host vehicle to travel along the target course. The angle δt is calculated by calculation including at least a first integral term that performs integration processing, and the steering angle is calculated by calculation including at least a second integration term that performs integration processing so that the actual steering angle δr becomes the target steering angle δt. Control. At this time, when the stop state of the host vehicle is detected, the addition of the first integral term used for calculating the target steering angle δt is stopped and held, and the addition of the second integral term used for the steering angle control is stopped. On the other hand, when starting from the stop state of the host vehicle is detected, the target rudder angle δt is set to the actual rudder angle δr of the host vehicle at that time, and the second integration used for the rudder angle control Reset the term.

このため、操舵制御部20は、図2に示すように、車両状態判定部20aと目標舵角制御部20bとから構成され、更に、この目標舵角制御部20bは、目標舵角算出部20mと舵角制御部20nとから主要に構成されている。   Therefore, as shown in FIG. 2, the steering control unit 20 includes a vehicle state determination unit 20a and a target rudder angle control unit 20b. The target rudder angle control unit 20b further includes a target rudder angle calculation unit 20m. And the rudder angle control unit 20n.

車両状態判定部20aは、車速センサ32から車速Vが入力される。そして、車速V、及び、この車速Vから算出される前後加速度の値等から、車両の運転状態が停止状態か、停止からの発進状態か、その他の状態かを判定する。   The vehicle state determination unit 20 a receives the vehicle speed V from the vehicle speed sensor 32. Then, from the vehicle speed V and the longitudinal acceleration value calculated from the vehicle speed V, it is determined whether the driving state of the vehicle is a stop state, a start state after the stop, or another state.

具体的には、図3のフローチャートに示すように、まず、ステップ(以下、「S」と略称)101で、車速Vが0の場合には、車両は停止状態と判定し、S102に進み、車両状態判定フラグFLを1(FL=1)に設定する。   Specifically, as shown in the flowchart of FIG. 3, first, in step (hereinafter abbreviated as “S”) 101, when the vehicle speed V is 0, the vehicle is determined to be stopped, and the process proceeds to S <b> 102. The vehicle state determination flag FL is set to 1 (FL = 1).

また、S101の判定の結果、車両は停止状態ではないと判定されるとS103に進み、例えば、車速Vが予め設定しておいた閾値以下で、かつ、前後加速度が予め設定しておいた閾値以上であり、車両は停止からの発進状態か否か判定する。尚、このS103の車両の発進判定には、他に、アクセル開度が閾値以上であることや、ブレーキスイッチがOFFとなっていること等を判定の条件として加えても良い。   If it is determined as a result of the determination in S101 that the vehicle is not in a stopped state, the process proceeds to S103. For example, the vehicle speed V is equal to or lower than a preset threshold and the longitudinal acceleration is set in advance. Thus, it is determined whether or not the vehicle is in a starting state from a stop. In addition, in the vehicle start determination in S103, it may be added as a determination condition that the accelerator opening is equal to or greater than a threshold value, the brake switch is OFF, or the like.

S103の判定の結果、車両は停止からの発進状態と判定されるとS104に進み、車両状態判定フラグFLを2(FL=2)に設定する。   As a result of the determination in S103, if it is determined that the vehicle is in the start state from the stop, the process proceeds to S104, and the vehicle state determination flag FL is set to 2 (FL = 2).

また、S103の判定の結果、車両は停止からの発進状態ではないと判定されると、S105に進み、車両状態判定フラグFLを0(FL=0)に設定する。   On the other hand, if it is determined in S103 that the vehicle is not in the starting state from the stop, the process proceeds to S105, and the vehicle state determination flag FL is set to 0 (FL = 0).

こうして、S102、S104、或いは、S105で車両状態判定フラグFLを設定した後は、S106に進み、車両状態判定フラグFLを、目標舵角制御部20bの目標舵角算出部20mと舵角制御部20nに出力してルーチンを抜ける。   Thus, after the vehicle state determination flag FL is set in S102, S104, or S105, the process proceeds to S106, and the vehicle state determination flag FL is set to the target rudder angle calculation unit 20m and the rudder angle control unit of the target rudder angle control unit 20b. Output to 20n and exit the routine.

目標舵角制御部20bの目標舵角算出部20mは、前方環境認識装置31から車両の前方環境情報が入力され、車速センサ32から車速が入力され、操舵角センサ33から実舵角δrが入力され、車両状態判定部20aから車両状態を示す車両状態判定フラグFLが入力される。   The target rudder angle calculation unit 20m of the target rudder angle control unit 20b receives the front environment information of the vehicle from the front environment recognition device 31, the vehicle speed from the vehicle speed sensor 32, and the actual steering angle δr from the steering angle sensor 33. The vehicle state determination flag FL indicating the vehicle state is input from the vehicle state determination unit 20a.

目標舵角算出部20mは、自車両の前方環境情報と走行情報に基づいて目標コース(本実施の形態では車線中央)を設定し、自車両が目標コースに沿って走行するのに必要な目標舵角δtを少なくとも積分処理を行う第1の積分項を含む演算により算出する。   The target rudder angle calculation unit 20m sets a target course (the center of the lane in the present embodiment) based on the front environment information and the travel information of the host vehicle, and the target necessary for the host vehicle to travel along the target course. The steering angle δt is calculated by a calculation including at least a first integral term for performing an integration process.

具体的には、目標舵角算出部20mは、車両状態が停止状態でもなく発進状態でもない場合(FL=0の場合)には、目標舵角δtを、例えば、以下(1)式により算出する。本実施形態では、この(1)式により算出される目標舵角δtを第1の目標舵角とする。   Specifically, the target rudder angle calculation unit 20m calculates the target rudder angle δt by, for example, the following formula (1) when the vehicle state is neither the stop state nor the start state (when FL = 0). To do. In the present embodiment, the target rudder angle δt calculated by the equation (1) is set as the first target rudder angle.

δt=(Gθff・κ)+(Gθfb・Δx)
+(Gθ1i・∫(Δx)dt)
+(Gθfby・(θtl+θtr)/2)
+(Gθ1d・d((θtl+θtr)/2)/dt)
…(1)
ここで、上述の(1)式における「(Gθff・κ)」の演算項において、κは、例えば、以下の(2)式で示すような、前方環境情報を基に算出するカーブ曲率を示す。
δt = (Gθff · κ) + (Gθfb · Δx)
+ (Gθ1i · ∫ (Δx) dt)
+ (Gθfby · (θtl + θtr) / 2)
+ (Gθ1d · d ((θtl + θtr) / 2) / dt)
... (1)
Here, in the calculation term “(Gθff · κ)” in the above equation (1), κ indicates a curve curvature calculated based on the forward environment information, as shown by the following equation (2), for example. .

κ=(κl+κr)/2 …(2)
この(2)式において、κlは左車線区画線による曲率成分であり、κrは右車線区画線による曲率成分である。これら、左右の車線区画線の曲率成分κl,κrは、具体的には、図5に示すような、左右の車線区画線のそれぞれを構成する点に関して、二次の最小自乗法によって計算された二次項の係数を用いることによって定められる。例えば、x=A・z+B・z+Cの二次式で車線区画線を近似した場合、2・Aの値が曲率成分として用いられる。尚、これら車線区画線の曲率成分κl、κrは、それぞれの車線区画線の曲率そのものでも良い。また、「(Gθff・κ)」の演算項におけるGθffは、予め実験・演算等により設定しておいたフィードフォワードゲインを示す。
κ = (κl + κr) / 2 (2)
In equation (2), κl is a curvature component due to the left lane marking, and κr is a curvature component due to the right lane marking. Specifically, the curvature components κl and κr of the left and right lane markings are calculated by the second-order least square method with respect to the points constituting the left and right lane markings as shown in FIG. It is determined by using the coefficient of the quadratic term. For example, when a lane marking is approximated by a quadratic expression of x = A · z 2 + B · z + C, a value of 2 · A is used as a curvature component. The curvature components κl and κr of these lane markings may be the curvatures of the respective lane markings themselves. Further, Gθff in the calculation term of “(Gθff · κ)” indicates a feed forward gain set in advance by experiment / calculation or the like.

また、上述の(1)式における「(Gθfb・Δx)」の演算項において、Gθfbは、予め実験・演算等により設定しておいたフィードバックゲインであり、Δxは、図6に示すように、以下の(3)式により算出される。   Further, in the calculation term of “(Gθfb · Δx)” in the above equation (1), Gθfb is a feedback gain set in advance by experiment / calculation or the like, and Δx is as shown in FIG. It is calculated by the following equation (3).

Δx=(xl+xr)/2−xv …(3)
この(3)式において、xvは車両の前方注視点(位置)(0,zv)のz座標における推定車両軌跡のx座標であり、前方注視点(0,zv)の前方注視距離(z座標)であるzvは、本実施の形態では、zv=tc・Vで算出される。ここで、tcは予め設定しておいた予見時間であり、例えば、1.2secに設定されている。
Δx = (xl + xr) / 2−xv (3)
In this equation (3), xv is the x coordinate of the estimated vehicle trajectory in the z coordinate of the forward gaze point (position) (0, zv) of the vehicle, and the forward gaze distance (z coordinate) of the front gaze point (0, zv). Zv is calculated by zv = tc · V in the present embodiment. Here, tc is a preset preview time, and is set to 1.2 sec, for example.

従って、xvは、車両の走行状態に基づいて車両の諸元や車両固有のスタビリティファクタAs等を用いる場合には、例えば、以下の(4)式で算出することができる。
xv=(1/2)・(1/(1+As・V))・(δr/Lw)
・(tc・V) …(4)
ここで、Lwはホイールベースである。また、(3)式における、xlは前方注視点(0,zv)のz座標における左車線区画線のx座標であり、xrは前方注視点(0,zv)のz座標における右車線区画線のx座標である。
Therefore, xv can be calculated by, for example, the following equation (4) when using vehicle specifications, vehicle-specific stability factor As, or the like based on the running state of the vehicle.
xv = (1/2) · (1 / (1 + As · V 2 )) · (δr / Lw)
・ (Tc ・ V) 2 (4)
Here, Lw is a wheel base. In the equation (3), xl is the x coordinate of the left lane line in the z coordinate of the forward gazing point (0, zv), and xr is the right lane line in the z coordinate of the forward gazing point (0, zv). X coordinate.

尚、上述のxvは、車速Vやヨーレートγを用いて、以下の(5)式で算出することもでき、或いは、画像情報を基に、以下の(6)式で算出することもできる。
xv=(1/2)・(γ/V)・(V・tc) …(5)
xv=(1/2)・κ・(V・tc) …(6)
尚、tcをゼロに設定した場合、Δxはxiと同値になる。この場合はΔxを、例えば画像情報で得られる車線区画線の各点に対して、二次の最小二乗法によって計算された、定数項(すなわち、車線区画線を、x=A・z+B・z+Cの式で近似した際のCの値)から算出しても良い。
The above xv can be calculated by the following equation (5) using the vehicle speed V and the yaw rate γ, or can be calculated by the following equation (6) based on the image information.
xv = (1/2) · (γ / V) · (V · tc) 2 (5)
xv = (1/2) · κ · (V · tc) 2 (6)
When tc is set to zero, Δx is the same value as xi. In this case, Δx is a constant term (that is, the lane line is calculated as x = A · z 2 + B, for example, calculated by a second-order least square method for each point of the lane line obtained from the image information. -You may calculate from the value of C at the time of approximating with the formula of z + C.

更に、上述の(1)式における「(Gθ1i・∫(Δx)dt)」の演算項において、Gθ1iは、予め実験、計算等により設定しておいたゲインであり、「∫(Δx)dt」は、自車両の推定される車両軌跡と前記目標コースの車幅方向における位置のズレ量(すなわち、Δx)の積分項(第1の積分項)で、例えば、走行路のカントや横風等の外乱に起因する目標舵角の設定誤差を補償するための演算項となっている。   Further, in the calculation term “(Gθ1i · ∫ (Δx) dt)” in the above equation (1), Gθ1i is a gain set in advance by experiment, calculation, etc., and “∫ (Δx) dt”. Is an integral term (first integral term) of the amount of deviation (ie, Δx) between the estimated vehicle trajectory of the host vehicle and the position of the target course in the vehicle width direction (ie, the first integral term). This is a calculation term for compensating for a setting error of the target rudder angle caused by disturbance.

また、上述の(1)式における「(Gθfby・(θtl+θtr)/2)」の演算項は、車両のヨー角を目標コースに沿ったヨー角にフィードバック制御する演算項であり、Gθfbyは、予め実験・演算等により設定しておいたゲインで、θtlは前方環境認識装置31からの画像情報による左車線区画線に対する自車両の傾き、θtrは前方環境認識装置31からの画像情報による右車線区画線に対する自車両の傾きである(図7参照)。尚、これら、θtl、θtrは、例えば、画像情報で得られる車線区画線の各点に対して、二次の最小二乗法によって計算された、一次項の係数(すなわち、車線区画線を、x=A・z+B・z+Cの式で近似した際のBの値)から算出しても良い。 In addition, the calculation term “(Gθfby · (θtl + θtr) / 2)” in the above equation (1) is a calculation term that feedback-controls the yaw angle of the vehicle to the yaw angle along the target course. The gain set by experiment / calculation, etc., θtl is the inclination of the vehicle with respect to the left lane lane according to the image information from the forward environment recognition device 31, and θtr is the right lane zone according to the image information from the forward environment recognition device 31. This is the inclination of the vehicle with respect to the line (see FIG. 7). These θtl and θtr are, for example, the coefficients of the primary term calculated by the second least square method for each point of the lane line obtained from the image information (i.e., x = A · z 2 + B · z + C) (B value when approximated by the equation)

更に、上述の(1)式における「(Gθ1d・d((θtl+θtr)/2)/dt)」の演算項は、Gθ1dは予め実験・演算等により設定しておいたゲインで、車両のヨー角を目標コースに沿ったヨー角にフィードバック制御するにあたり、車両のヨー角を目標コースの方向に収束させる制御性を向上させるための微分演算項である。   Further, the calculation term of “(Gθ1d · d ((θtl + θtr) / 2) / dt)” in the above-described equation (1) is that Gθ1d is a gain set in advance through experiments and calculations, and the yaw angle of the vehicle Is a differential operation term for improving the controllability for converging the yaw angle of the vehicle in the direction of the target course in feedback control to the yaw angle along the target course.

また、目標舵角算出部20mは、車両状態が停止状態の場合(FL=1の場合)には、目標舵角δtを、例えば、前述の(1)式における第1の積分項、すなわち、「(Gθ1i・∫(Δx)dt)」の第1の積分項の加算を停止し保持して目標舵角δtを算出する。本実施形態では、この第1の積分項の加算を停止し保持して算出される目標舵角δtを第2の目標舵角とする。   Further, the target rudder angle calculation unit 20m calculates the target rudder angle δt, for example, the first integral term in the above-described equation (1), that is, when the vehicle state is the stop state (when FL = 1), that is, The addition of the first integral term of “(Gθ1i · ∫ (Δx) dt)” is stopped and held to calculate the target steering angle δt. In the present embodiment, the target steering angle δt calculated by stopping and holding the addition of the first integral term is set as the second target steering angle.

更に、目標舵角算出部20mは、車両状態が停止からの発進状態の場合(FL=2の場合)には、目標舵角δtを、そのときの自車両の実舵角δrに設定する(δt=δr)。本実施形態では、車両状態が停止からの発進状態の場合に設定される目標舵角δtを第3の目標舵角とする。   Further, the target rudder angle calculation unit 20m sets the target rudder angle δt to the actual rudder angle δr of the host vehicle at that time when the vehicle state is a start state from a stop (in the case of FL = 2) ( δt = δr). In the present embodiment, the target rudder angle δt set when the vehicle state is the start state from the stop is set as the third target rudder angle.

こうして、目標舵角算出部20mで設定される目標舵角δtは、舵角制御部20nに出力される。このように、目標舵角算出部20mは、目標舵角算出手段として設けられている。   Thus, the target rudder angle δt set by the target rudder angle calculation unit 20m is output to the rudder angle control unit 20n. Thus, the target rudder angle calculation unit 20m is provided as target rudder angle calculation means.

舵角制御部20nは、操舵角センサ33から実舵角δrが入力され、車両状態判定部20aから車両状態を示す車両状態判定フラグFLが入力され、目標舵角算出部20mから目標舵角δtが入力される。そして、実舵角δrが目標舵角δtになるように(目標舵角δtと実舵角δrとの偏差が0になるように)、少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する(本実施の形態では、所謂、公知のPID制御を採用する)。   The steering angle control unit 20n receives the actual steering angle δr from the steering angle sensor 33, the vehicle state determination flag FL indicating the vehicle state from the vehicle state determination unit 20a, and the target steering angle δt from the target steering angle calculation unit 20m. Is entered. Then, by an operation including at least a second integral term for performing an integration process so that the actual rudder angle δr becomes the target rudder angle δt (so that the deviation between the target rudder angle δt and the actual rudder angle δr becomes 0). Steering angle control is performed (in this embodiment, so-called known PID control is adopted).

具体的には、舵角制御部20nは、車両状態が停止状態でもなく発進状態でもない場合(FL=0の場合)には、例えば、以下の(7)式により、制御量(制御トルク)Tpを算出してモータ駆動部21に出力する。本実施形態では、この(7)式により制御量(制御トルク)Tpを算出・出力する舵角制御を第1の舵角制御とする。   Specifically, the steering angle control unit 20n, when the vehicle state is neither the stop state nor the start state (in the case of FL = 0), for example, the control amount (control torque) by the following equation (7). Tp is calculated and output to the motor drive unit 21. In the present embodiment, the steering angle control that calculates and outputs the control amount (control torque) Tp by the equation (7) is defined as the first steering angle control.

Tp=G2p・(δt−δr)+G2i・∫(δt−δr)dt
+G2d・d(δt−δr)/dt …(7)
ここで、G2p、G2i、G2dは、予め実験、計算等により設定しておいた、比例ゲイン、積分ゲイン、微分ゲインを示す。
Tp = G2p · (δt−δr) + G2i · ∫ (δt−δr) dt
+ G2d · d (δt−δr) / dt (7)
Here, G2p, G2i, and G2d indicate a proportional gain, an integral gain, and a differential gain that are set in advance by experiments, calculations, and the like.

この(7)式における「G2i・∫(δt−δr)dt」の演算項が、第2の積分項である。   The arithmetic term “G2i · ∫ (δt−δr) dt” in the equation (7) is the second integral term.

また、舵角制御部20nは、車両状態が停止状態の場合(FL=1の場合)には、制御量(制御トルク)Tpを、例えば、前述の(7)式における第2の積分項、すなわち、「G2i・∫(δt−δr)dt」の第2の積分項の加算を停止し保持して算出する。本実施形態では、この第2の積分項の加算を停止し保持して算出する舵角制御を第2の舵角制御とする。   In addition, when the vehicle state is the stop state (when FL = 1), the steering angle control unit 20n sets the control amount (control torque) Tp to, for example, the second integral term in the above-described equation (7), That is, the calculation is performed by stopping and holding the addition of the second integral term of “G2i · ∫ (δt−δr) dt”. In the present embodiment, the steering angle control calculated by stopping and holding the addition of the second integral term is referred to as second steering angle control.

更に、舵角制御部20nは、車両状態が停止からの発進状態の場合(FL=2の場合)には、制御量(制御トルク)Tpを、前述の(7)式における第2の積分項、すなわち、「G2i・∫(δt−δr)dt」をリセット(=0)して算出する。本実施形態では、この第2の積分項の加算をリセットして算出する舵角制御を第3の舵角制御とする。   Furthermore, when the vehicle state is a start state from a stop (in the case of FL = 2), the rudder angle control unit 20n sets the control amount (control torque) Tp to the second integral term in the above equation (7). That is, “G2i · ∫ (δt−δr) dt” is reset (= 0) and calculated. In the present embodiment, the steering angle control calculated by resetting the addition of the second integral term is referred to as a third steering angle control.

こうして、舵角制御部20nで算出された制御量(制御トルク)Tpは、モータ駆動部21に出力される。このように、舵角制御部20nは、舵角制御手段として設けられている。   Thus, the control amount (control torque) Tp calculated by the rudder angle control unit 20n is output to the motor drive unit 21. Thus, the steering angle control unit 20n is provided as a steering angle control means.

次に、目標舵角制御部20bで実行される目標舵角制御を図4のフローチャートで説明する。   Next, the target rudder angle control executed by the target rudder angle control unit 20b will be described with reference to the flowchart of FIG.

まず、S201で、車両状態判定部20aから判定した車両状態を示す車両状態判定フラグFLの結果を読み込む。   First, in S201, the result of the vehicle state determination flag FL indicating the vehicle state determined from the vehicle state determination unit 20a is read.

次いで、S202に進み、車両状態判定フラグFLが0(FL=0)で、車両状態が停止状態でもなく、かつ、発進状態でもないか判定する。   Next, the process proceeds to S202, in which it is determined whether the vehicle state determination flag FL is 0 (FL = 0) and the vehicle state is neither a stop state nor a start state.

この判定の結果、FL=0の場合は、S203に進み、目標舵角算出部20mは、前述の(1)式による第1の目標舵角を目標舵角δtとして算出する。   As a result of the determination, if FL = 0, the process proceeds to S203, and the target rudder angle calculation unit 20m calculates the first target rudder angle according to the above equation (1) as the target rudder angle δt.

次いで、S204に進み、舵角制御部20nは、前述の(7)式による第1の舵角制御を実行して制御量(制御トルク)Tpを算出する。   Next, in S204, the steering angle control unit 20n calculates the control amount (control torque) Tp by executing the first steering angle control according to the aforementioned equation (7).

また、前述のS202で、FL=0ではないと判定された場合は、S205に進み、FL=1で車両状態が停止状態か否か判定する。   If it is determined in S202 that FL = 0 is not satisfied, the process proceeds to S205, and it is determined whether FL = 1 and the vehicle state is a stop state.

この判定の結果、FL=1の場合は、S206に進み、目標舵角算出部20mは、前述の(1)式における第1の積分項、すなわち、「(Gθ1i・∫(Δx)dt)」の第1の積分項の加算を停止し保持して算出した第2の目標舵角を目標舵角δtとする。   As a result of the determination, if FL = 1, the process proceeds to S206, and the target rudder angle calculation unit 20m determines the first integral term in the above-described equation (1), that is, “(Gθ1i · ∫ (Δx) dt)”. The second target rudder angle calculated by stopping and holding the addition of the first integral term is set as a target rudder angle δt.

次いで、S207に進み、舵角制御部20nは、前述の(7)式における第2の積分項、すなわち、「G2i・∫(δt−δr)dt」の第2の積分項の加算を停止し保持して第2の舵角制御を実行して制御量(制御トルク)Tpを算出する。   Next, in S207, the steering angle control unit 20n stops the addition of the second integral term in the above-described equation (7), that is, the second integral term of “G2i · ∫ (δt−δr) dt”. The control amount (control torque) Tp is calculated by holding and executing the second steering angle control.

更に、前述のS205で、FL=1ではないと判定された場合は、FL=2、すなわち、車両状態が停止からの発進状態の場合であるのでS208に進み、目標舵角算出部20mは、そのときの自車両の実舵角δrを目標舵角δtとして算出する(第3の目標舵角を目標舵角δtとする)。   Further, if it is determined in the above-described S205 that FL = 1 is not satisfied, FL = 2, that is, the vehicle state is a start state from a stop, so the process proceeds to S208, and the target rudder angle calculation unit 20m The actual steering angle δr of the host vehicle at that time is calculated as the target steering angle δt (the third target steering angle is set as the target steering angle δt).

次いで、S209に進み、舵角制御部20nは、前述の(7)式における第2の積分項、すなわち、「G2i・∫(δt−δr)dt」をリセットする第3の舵角制御を実行して制御量(制御トルク)Tpを算出する。   Next, in S209, the steering angle control unit 20n executes the third steering angle control for resetting the second integral term in the above-described equation (7), that is, “G2i · ∫ (δt−δr) dt”. Thus, a control amount (control torque) Tp is calculated.

そして、S204、S207、S209の何れかで制御量(制御トルク)Tpを算出した後は、S210に進み、該制御量(制御トルク)Tpをモータ駆動部21に出力してルーチンを抜ける。   After calculating the control amount (control torque) Tp in any one of S204, S207, and S209, the process proceeds to S210, and the control amount (control torque) Tp is output to the motor drive unit 21 to exit the routine.

このように本実施の形態によれば、自車両の前方環境情報と走行情報に基づいて目標コースを設定し、自車両が目標コースに沿って走行するのに必要な目標舵角δtを少なくとも積分処理を行う第1の積分項を含む演算により算出して、実舵角δrが目標舵角δtになるように少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する。この際、自車両の停止状態を検出した際は、目標舵角δtの算出に用いる第1の積分項の加算を停止し保持すると共に、舵角制御に用いる第2の積分項の加算を停止し保持する一方、自車両の停止状態からの発進を検出した際には、目標舵角δtを、そのときの自車両の実舵角δrに設定すると共に、舵角制御に用いる第2の積分項をリセットする。このため、積分処理が走行状況(停止状態、停止からの発進状態に)によって、適切に処理されるので、制御に用いる積分処理の誤差や誤動作によりステアリングホイールが不自然に動作することが防止でき、車両の実舵角を目標舵角に精度良く、自然な制御で安定して近づけて目標コースに沿って適切に走行することが可能となる。   As described above, according to the present embodiment, the target course is set based on the forward environment information and the travel information of the host vehicle, and at least the target steering angle δt necessary for the host vehicle to travel along the target course is integrated. The steering angle is calculated by a calculation including a first integral term for performing the processing, and the steering angle is controlled by a calculation including at least a second integral term for performing the integral processing so that the actual steering angle δr becomes the target steering angle δt. At this time, when the stop state of the host vehicle is detected, the addition of the first integral term used for calculating the target steering angle δt is stopped and held, and the addition of the second integral term used for the steering angle control is stopped. On the other hand, when starting from the stop state of the host vehicle is detected, the target rudder angle δt is set to the actual rudder angle δr of the host vehicle at that time, and the second integration used for the rudder angle control Reset the term. For this reason, since the integration process is appropriately processed depending on the driving situation (stop state, start state from stop), it is possible to prevent the steering wheel from operating unnaturally due to an error or malfunction of the integration process used for control. Thus, the vehicle can appropriately travel along the target course by bringing the actual steering angle of the vehicle close to the target steering angle with high accuracy and with natural control stably.

尚、本発明の実施の形態では、カメラからの画像データに基づき車線に沿って走行する目標コースを設定し、この目標コースに追従制御する場合を例に説明したが、ナビゲーションシステム、地図情報、自車位置情報に基づき車線に沿って走行する目標コースを設定し、この目標コースに追従制御する場合であっても本発明が適用できることは言うまでもない。また、カメラからの画像情報、レーザレーダ、ミリ波レーダ、ソナー等で先行車を認識し、認識した先行車に追従する進路を目標コースとして設定し、この目標コースに追従制御する場合であっても本発明は適用できる。更に、カメラ、ナビゲーションシステム、地図情報、自車位置情報により自車両の走行車線を認識し、認識した走行車線からの逸脱を防止する進路を目標コースとして設定し、この目標コースに追従制御する場合であっても本発明は適用できる。   In the embodiment of the present invention, a case has been described in which a target course that travels along a lane based on image data from a camera is set and follow-up control is performed as an example. However, a navigation system, map information, Needless to say, the present invention can be applied to a case where a target course that travels along a lane is set based on the vehicle position information and the follow-up control is performed on the target course. In addition, when a preceding vehicle is recognized by image information from a camera, laser radar, millimeter wave radar, sonar, etc., a course that follows the recognized preceding vehicle is set as a target course, and tracking control is performed on this target course. The present invention is also applicable. In addition, when the travel lane of the host vehicle is recognized based on the camera, navigation system, map information, and host vehicle position information, a course that prevents a deviation from the recognized travel lane is set as a target course, and tracking control is performed on the target course. Even so, the present invention is applicable.

1 電動パワーステアリング装置
2 ステアリング軸
4 ステアリングホイール
5 ピニオン軸
10L、10R 車輪
12 電動モータ
20 操舵制御部
20a 車両状態判定部
20b 目標舵角制御部
20m 目標舵角算出部(目標舵角算出手段)
20n 舵角制御部(舵角制御手段)
21 モータ駆動部
31 前方環境認識装置
32 車速センサ
33 操舵角センサ
DESCRIPTION OF SYMBOLS 1 Electric power steering apparatus 2 Steering shaft 4 Steering wheel 5 Pinion shaft 10L, 10R Wheel 12 Electric motor 20 Steering control part 20a Vehicle state determination part 20b Target rudder angle control part 20m Target rudder angle calculation part (target rudder angle calculation means)
20n rudder angle control unit (steering angle control means)
21 Motor drive unit 31 Front environment recognition device 32 Vehicle speed sensor 33 Steering angle sensor

Claims (5)

自車両の前方環境情報と走行情報に基づいて目標コースを設定し、自車両が前記目標コースに沿って走行するのに必要な目標舵角を少なくとも積分処理を行う第1の積分項を含む演算により算出する目標舵角算出手段と、
自車両の実際の舵角が前記目標舵角になるように少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する舵角制御手段とを備えた車両の操舵制御装置であって、
自車両の停止状態を検出した際、前記目標舵角算出手段は、前記目標舵角の算出に用いる前記第1の積分項の加算を停止し保持すると共に、前記舵角制御手段は、前記舵角制御に用いる前記第2の積分項の加算を停止し保持することを特徴とする車両の操舵制御装置。
A calculation including a first integration term that sets a target course based on the front environment information and travel information of the host vehicle, and at least integrates a target rudder angle required for the host vehicle to travel along the target course. Target rudder angle calculating means for calculating by
A steering control device for a vehicle, comprising steering angle control means for controlling the steering angle by a calculation including at least a second integral term for performing integration processing so that an actual steering angle of the host vehicle becomes the target steering angle. ,
When the stop state of the host vehicle is detected, the target rudder angle calculating means stops and holds the addition of the first integral term used for calculating the target rudder angle, and the rudder angle control means A vehicle steering control device characterized in that the addition of the second integral term used for angle control is stopped and held.
自車両の前方環境情報と走行情報に基づいて目標コースを設定し、自車両が前記目標コースに沿って走行するのに必要な目標舵角を少なくとも積分処理を行う第1の積分項を含む演算により算出する目標舵角算出手段と、
自車両の実際の舵角が前記目標舵角になるように少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する舵角制御手段とを備えた車両の操舵制御装置であって、
自車両の停止状態からの発進を検出した際、前記目標舵角算出手段は、前記目標舵角を、そのときの自車両の実際の舵角に設定すると共に、前記舵角制御手段は、前記舵角制御に用いる前記第2の積分項をリセットすることを特徴とする車両の操舵制御装置。
A calculation including a first integration term that sets a target course based on the front environment information and travel information of the host vehicle, and at least integrates a target rudder angle required for the host vehicle to travel along the target course. Target rudder angle calculating means for calculating by
A steering control device for a vehicle, comprising steering angle control means for controlling the steering angle by a calculation including at least a second integral term for performing integration processing so that an actual steering angle of the host vehicle becomes the target steering angle. ,
When detecting the start from the stop state of the host vehicle, the target rudder angle calculation means sets the target rudder angle to the actual rudder angle of the host vehicle at that time, and the rudder angle control means A vehicle steering control device, wherein the second integral term used for steering angle control is reset.
自車両の前方環境情報と走行情報に基づいて目標コースを設定し、自車両が前記目標コースに沿って走行するのに必要な目標舵角を少なくとも積分処理を行う第1の積分項を含む演算により算出する目標舵角算出手段と、
自車両の実際の舵角が前記目標舵角になるように少なくとも積分処理を行う第2の積分項を含む演算により舵角制御する舵角制御手段とを備えた車両の操舵制御装置であって、
自車両の停止状態を検出した際、前記目標舵角算出手段は、前記目標舵角の算出に用いる前記第1の積分項の加算を停止し保持すると共に、前記舵角制御手段は、前記舵角制御に用いる前記第2の積分項の加算を停止し保持する一方、
自車両の停止状態からの発進を検出した際、前記目標舵角算出手段は、前記目標舵角を、そのときの自車両の実際の舵角に設定すると共に、前記舵角制御手段は、前記舵角制御に用いる前記第2の積分項をリセットすることを特徴とする車両の操舵制御装置。
A calculation including a first integration term that sets a target course based on the front environment information and travel information of the host vehicle, and at least integrates a target rudder angle required for the host vehicle to travel along the target course. A target rudder angle calculating means for calculating by
A steering control device for a vehicle, comprising steering angle control means for controlling the steering angle by a calculation including at least a second integral term for performing integration processing so that an actual steering angle of the host vehicle becomes the target steering angle. ,
When the stop state of the host vehicle is detected, the target rudder angle calculating means stops and holds the addition of the first integral term used for calculating the target rudder angle, and the rudder angle control means While stopping and holding the addition of the second integral term used for angle control,
When detecting the start from the stop state of the host vehicle, the target rudder angle calculation means sets the target rudder angle to the actual rudder angle of the host vehicle at that time, and the rudder angle control means A vehicle steering control device, wherein the second integral term used for steering angle control is reset.
前記目標舵角の算出に用いる前記第1の積分項は、自車両の推定される車両軌跡と前記目標コースの車幅方向における位置のズレ量の積分項であることを特徴とする請求項1乃至請求項3の何れか一つに記載の車両の操舵制御装置。   The first integral term used for calculating the target rudder angle is an integral term of an amount of deviation between a vehicle trajectory estimated by the host vehicle and a position of the target course in the vehicle width direction. The vehicle steering control device according to any one of claims 3 to 4. 前記舵角制御に用いる前記第2の積分項は、前記目標舵角と前記実際の舵角の偏差の積分項であることを特徴とする請求項1乃至請求項4の何れか一つに記載の車両の操舵制御装置。   The said 2nd integral term used for the said rudder angle control is an integral term of the deviation of the said target rudder angle and the said actual rudder angle, The claim 1 characterized by the above-mentioned. Vehicle steering control device.
JP2016189948A 2016-09-28 2016-09-28 Vehicle steering control device Active JP6694359B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016189948A JP6694359B2 (en) 2016-09-28 2016-09-28 Vehicle steering control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016189948A JP6694359B2 (en) 2016-09-28 2016-09-28 Vehicle steering control device

Publications (2)

Publication Number Publication Date
JP2018052270A true JP2018052270A (en) 2018-04-05
JP6694359B2 JP6694359B2 (en) 2020-05-13

Family

ID=61833782

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016189948A Active JP6694359B2 (en) 2016-09-28 2016-09-28 Vehicle steering control device

Country Status (1)

Country Link
JP (1) JP6694359B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021115975A (en) * 2020-01-27 2021-08-10 トヨタ自動車株式会社 Vehicle control system

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002079953A (en) * 2000-09-06 2002-03-19 Nissan Motor Co Ltd Lane following control device
JP2002319100A (en) * 2001-04-20 2002-10-31 Honda Motor Co Ltd Device for estimating locus of vehicle, and travel safety device for vehicle using the same
JP2008049747A (en) * 2006-08-22 2008-03-06 Toyota Motor Corp Steering support device
JP2015020604A (en) * 2013-07-19 2015-02-02 株式会社デンソー Motor control device
JP2015093522A (en) * 2013-11-08 2015-05-18 トヨタ自動車株式会社 Vehicle control apparatus

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002079953A (en) * 2000-09-06 2002-03-19 Nissan Motor Co Ltd Lane following control device
JP2002319100A (en) * 2001-04-20 2002-10-31 Honda Motor Co Ltd Device for estimating locus of vehicle, and travel safety device for vehicle using the same
JP2008049747A (en) * 2006-08-22 2008-03-06 Toyota Motor Corp Steering support device
JP2015020604A (en) * 2013-07-19 2015-02-02 株式会社デンソー Motor control device
JP2015093522A (en) * 2013-11-08 2015-05-18 トヨタ自動車株式会社 Vehicle control apparatus

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021115975A (en) * 2020-01-27 2021-08-10 トヨタ自動車株式会社 Vehicle control system
US11577781B2 (en) 2020-01-27 2023-02-14 Toyota Jidosha Kabushiki Kaisha Vehicle control system
JP7272291B2 (en) 2020-01-27 2023-05-12 トヨタ自動車株式会社 vehicle control system

Also Published As

Publication number Publication date
JP6694359B2 (en) 2020-05-13

Similar Documents

Publication Publication Date Title
JP6573643B2 (en) Vehicle travel control device
JP5988308B2 (en) Vehicle lane keeping control device
JP5802241B2 (en) Vehicle driving support control device
JP6489135B2 (en) Vehicle driving support device
JP6082415B2 (en) Vehicle travel control device
JP5920990B2 (en) Vehicle lane keeping control device
JP6055528B1 (en) Vehicle steering control device
JP5936281B2 (en) Vehicle lane departure prevention control device
JP5853552B2 (en) Vehicle travel control device
JP6611275B2 (en) Vehicle lane departure prevention control device
JP6106012B2 (en) Steering control device
US10000209B2 (en) Vehicle steering control apparatus
JP6185805B2 (en) Vehicle lane keeping control device
JP6497806B2 (en) Vehicle lane departure prevention control device
JP5389360B2 (en) Lane tracking control device and lane tracking control method
JP6082319B2 (en) Vehicle lane keeping control device
JP6317972B2 (en) Vehicle lane departure prevention control device
JP2018052271A (en) Steering control device for vehicle
JP6694359B2 (en) Vehicle steering control device
JP6338417B2 (en) Vehicle lane departure prevention control device
JP2017061265A (en) Travel control device for vehicle
JP6663771B2 (en) Automatic steering device
JP5655919B2 (en) Lane departure prevention device
JP6535490B2 (en) Vehicle lane departure prevention control device
JP6985917B2 (en) Vehicle lane departure prevention control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190614

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20190614

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

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200327

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200417

R150 Certificate of patent or registration of utility model

Ref document number: 6694359

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250