JP2002029437A - Lane follow-up control device for vehicle - Google Patents
Lane follow-up control device for vehicleInfo
- Publication number
- JP2002029437A JP2002029437A JP2000212628A JP2000212628A JP2002029437A JP 2002029437 A JP2002029437 A JP 2002029437A JP 2000212628 A JP2000212628 A JP 2000212628A JP 2000212628 A JP2000212628 A JP 2000212628A JP 2002029437 A JP2002029437 A JP 2002029437A
- Authority
- JP
- Japan
- Prior art keywords
- steering
- vehicle
- value
- friction
- control device
- 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.)
- Pending
Links
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Power Steering Mechanism (AREA)
Abstract
Description
【0001】[0001]
【発明の属する技術分野】本発明は、自動運転中に車線
追従性能を維持しつつドライバの操舵介入を許容させた
車両の車線追従制御装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a lane tracking control device for a vehicle that allows a driver to intervene while maintaining lane tracking performance during automatic driving.
【0002】[0002]
【従来の技術】従来、車両の自動操舵装置としては、例
えば、特開平5−50932号公報に記載のものが知ら
れている。2. Description of the Related Art Conventionally, as an automatic steering device for a vehicle, for example, one disclosed in Japanese Patent Application Laid-Open No. 5-50932 is known.
【0003】この公報には、操舵パターンに沿った操舵
を確保し、障害物との干渉を確実に回避することを目的
とし、障害物との干渉を回避するための操舵を行う車両
の自動操舵装置において、運転者による操舵角を検出す
る操舵角検出手段を設け、自動操舵中に、運転者が所定
以上に操舵するときは、その操舵を規制する規制手段を
備える技術が記載されている。[0003] This publication discloses automatic steering of a vehicle that performs steering to avoid interference with an obstacle, with the object of ensuring steering in accordance with a steering pattern and reliably avoiding interference with an obstacle. A technique is described in which a device is provided with a steering angle detecting means for detecting a steering angle by a driver, and a restricting means for restricting the steering when the driver steers more than a predetermined value during automatic steering.
【0004】[0004]
【発明が解決しようとする課題】しかしながら、このよ
うな従来の自動操舵装置にあっては、目標操舵角に実操
舵角を一致させようと働く操舵サーボ系がフィードバッ
ク制御の中に存在しているため、ドライバの介入がしづ
らいという問題があった。すなわち、車線から車両の相
対位置を算出した後、車両を目標ラインに載せるための
目標操舵角が算出される。次に、操舵サーボ系が目標操
舵角と実操舵角を一致させるように、操舵アクチュエー
タの入力である電流や電圧を制御することになってい
る。操舵サーボ系は車線追従性能を向上させるため、位
相遅れが少ないように設定されるため、フィードバック
係数を大きく設定せざるを得ない。よって、自動操舵中
にドライバが操舵介入しようとしても、ステアリングは
ほとんど動かない状態となり、結果としてドライバが介
入しづらい面を持っていた。However, in such a conventional automatic steering system, a feedback servo system which works to make the actual steering angle coincide with the target steering angle exists in the feedback control. Therefore, there was a problem that it was difficult for the driver to intervene. That is, after calculating the relative position of the vehicle from the lane, the target steering angle for mounting the vehicle on the target line is calculated. Next, the steering servo system controls the current and voltage input to the steering actuator so that the target steering angle matches the actual steering angle. Since the steering servo system is set to have a small phase delay in order to improve lane following performance, a large feedback coefficient must be set. Therefore, even if the driver tries to intervene during the automatic steering, the steering hardly moves, and as a result, the driver has difficulty in intervening.
【0005】この問題を解決するため、操舵サーボ系の
ない制御系を構成することが考えられる。すなわち、操
舵アクチュエータの入力を車線追従制御システムの入力
とし、車両挙動を車線追従制御システムの出力とみなし
た上でフィードバック制御系を構成するものである。し
かしながら、この構成では、車両挙動の変化が生じた
後、位相遅れを持って自車両が目標ラインに戻されると
いう作動が繰り返されることになり、目標ラインへの収
束性の低い車線追従性能を示し、車両が蛇行しやすい弱
点を有している。In order to solve this problem, it is conceivable to construct a control system without a steering servo system. That is, the feedback control system is configured on the assumption that the input of the steering actuator is the input of the lane following control system and the behavior of the vehicle is regarded as the output of the lane following control system. However, in this configuration, after a change in the vehicle behavior occurs, the operation of returning the own vehicle to the target line with a phase delay is repeated, and the lane following performance with low convergence to the target line is exhibited. However, it has a weak point that the vehicle tends to meander.
【0006】本発明は上記課題に着目してなされたもの
で、その目的とするところは、高い車線追従性能を維持
しつつ、ドライバの操舵介入を許容することができる車
両の車線追従制御装置を提供することにある。SUMMARY OF THE INVENTION The present invention has been made in view of the above problems, and an object of the present invention is to provide a vehicle lane following control device capable of permitting driver's steering intervention while maintaining high lane following performance. To provide.
【0007】[0007]
【課題を解決するための手段】上記目的を達成するた
め、請求項1記載の発明では、目標車線に対する自車両
の相対位置を検出する自車両相対位置検出手段と、相対
位置の検出に基づき、自車両を目標車線に誘導するため
の目標操舵角や目標操舵角速度等の操舵目標値を算出す
る操舵目標値算出手段と、実操舵角や実操舵角速度等の
操舵実際値を検出する操舵実際値検出手段と、前輪もし
くは後輪の少なくとも一方を操舵するステアリング機構
と、前記操舵実際値を前記操舵目標値に一致させるフィ
ードバック制御により前記ステアリング機構に設けられ
た操舵アクチュエータへ制御指令を出力する操舵制御手
段とを備えた車両の車線追従制御装置において、前記操
舵制御手段に、ステアリング機構へ入力される外乱トル
クを補償する外乱トルク補償部を設け、かつ、操舵制御
手段のフィードバック係数を、操舵外乱がないとの想定
に基づき設定したことを特徴とする。In order to achieve the above object, according to the first aspect of the present invention, a vehicle relative position detecting means for detecting a relative position of the vehicle relative to a target lane, Steering target value calculating means for calculating a steering target value such as a target steering angle and a target steering angular velocity for guiding the host vehicle to a target lane, and a steering actual value for detecting an actual steering value such as an actual steering angle and an actual steering angular velocity. Detecting means, a steering mechanism for steering at least one of a front wheel and a rear wheel, and steering control for outputting a control command to a steering actuator provided in the steering mechanism by feedback control for matching the actual steering value to the target steering value. Means for controlling the lane following of a vehicle, comprising: Provided click compensator, and a feedback coefficient of the steering control means, and wherein the set based on the assumption that there is no steering disturbance.
【0008】請求項2記載の発明では、請求項1記載の
車両の車線追従制御装置において、前記外乱トルク補償
部を、操舵方向と同じ方向で、大きさが一定の操舵フリ
クション想定値に基づく制御指令を算出する操舵フリク
ション補償部とし、前記操舵制御手段を、システムの入
出力から車両の状態量を推定するオブザーバと、車両の
状態量に基づき補償前のフィードバック制御指令を算出
するレギュレータと、前記操舵フリクション補償部によ
り構成し、操舵フリクションを想定しないで算出された
フィードバック制御指令に、操舵フリクション想定値に
基づく制御指令を加えて制御指令最終値とする手段とし
たことを特徴とする。According to a second aspect of the present invention, in the vehicle lane following control apparatus according to the first aspect, the disturbance torque compensator is controlled based on an assumed steering friction value having a constant magnitude in the same direction as the steering direction. A steering friction compensator for calculating a command, the steering control means comprising: an observer for estimating a state quantity of the vehicle from input / output of the system; a regulator for calculating a feedback control command before compensation based on the state quantity of the vehicle; It is constituted by a steering friction compensator, and is characterized in that a means for adding a control command based on an assumed steering friction value to a feedback control command calculated without assuming the steering friction is used as a control command final value.
【0009】請求項3記載の発明では、請求項2記載の
車両の車線追従制御装置において、前記操舵フリクショ
ン補償部を、車線追従制御による走行中に車両に蛇行が
発生した場合、前記操舵フリクション想定値を大きくす
る補正を行い、補正後の操舵フリクション想定値に基づ
く制御指令を算出する補償部としたことを特徴とする。According to a third aspect of the present invention, in the vehicle lane tracking control device according to the second aspect, the steering friction compensating unit is configured to calculate the steering friction when a meandering occurs in the vehicle during traveling by the lane following control. The compensation unit is configured to perform a correction for increasing the value and to calculate a control command based on the corrected steering friction assumed value.
【0010】請求項4記載の発明では、請求項3記載の
車両の車線追従制御装置において、ヨーレイト検出手段
により検出されるヨーレイトの符号の変化周期が設定値
以上の場合、車両の蛇行と判断する第1蛇行判断手段を
設けたことを特徴とする。According to a fourth aspect of the present invention, in the vehicle lane tracking control device according to the third aspect, if the change period of the sign of the yaw rate detected by the yaw rate detecting means is equal to or greater than a set value, it is determined that the vehicle is meandering. A first meandering determining means is provided.
【0011】請求項5記載の発明では、請求項3記載の
車両の車線追従制御装置において、ヨーレイトの変化に
よって引き起こされる他の物理量の変化を検出した場
合、車両の蛇行と判断する第2蛇行判断手段を設けたこ
とを特徴とする。According to a fifth aspect of the present invention, in the vehicle lane tracking control device according to the third aspect, when a change in another physical quantity caused by a change in the yaw rate is detected, it is determined that the vehicle is meandering. Means are provided.
【0012】請求項6記載の発明では、請求項2記載の
車両の車線追従制御装置において、前記操舵フリクショ
ン補償部を、車線追従制御による走行中に操舵角のハン
チングが発生した場合、前記操舵フリクション想定値を
小さくする補正を行い、補正後の操舵フリクション想定
値に基づく制御指令を算出する補償部としたことを特徴
とする。According to a sixth aspect of the present invention, in the vehicle lane following control apparatus according to the second aspect, the steering friction compensator is configured to control the steering friction when a hunting of a steering angle occurs during traveling by the lane following control. The present invention is characterized in that a compensation unit is provided for performing a correction for reducing the assumed value, and calculating a control command based on the corrected steering friction assumed value.
【0013】請求項7記載の発明では、請求項6記載の
車両の車線追従制御装置において、操舵角速度の絶対値
の時間平均が大きいことをもって操舵角のハンチングと
判断する操舵ハンチング判断手段を設けたことを特徴と
する。According to a seventh aspect of the present invention, in the vehicle lane tracking control device according to the sixth aspect, a steering hunting determining means for determining that the steering angle is hunting when the time average of the absolute value of the steering angular velocity is large is provided. It is characterized by the following.
【0014】請求項8記載の発明では、請求項1記載の
車両の車線追従制御装置において、前記外乱トルク補償
部を、前段のフィードバック制御指令方向と同じ方向
で、大きさが一定の操舵フリクション想定値に基づく制
御指令を算出する操舵フリクション補償部とし、前記操
舵制御手段を、システムの入出力から車両の状態量を推
定するオブザーバと、車両の状態量に基づき補償前のフ
ィードバック制御指令を算出するレギュレータと、前記
操舵フリクション補償部により構成し、操舵フリクショ
ンを想定しないで算出されたフィードバック制御指令
に、操舵フリクション想定値に基づく制御指令を加えて
制御指令最終値とする手段としたことを特徴とする。According to an eighth aspect of the present invention, in the vehicle lane tracking control device according to the first aspect, the disturbance torque compensating unit is configured to assume a steering friction having a constant magnitude in the same direction as a preceding-stage feedback control command direction. A steering friction compensating unit that calculates a control command based on the value, wherein the steering control unit calculates an amount of state of the vehicle from an input / output of the system and an observer that calculates a feedback control command before compensation based on the amount of state of the vehicle. A regulator and the steering friction compensating unit, and a means for adding a control command based on an assumed steering friction value to a feedback control command calculated without assuming steering friction to obtain a control command final value. I do.
【0015】請求項9記載の発明では、請求項1記載の
車両の車線追従制御装置において、前記操舵制御手段
を、システムの入出力から車両の状態量を推定するオブ
ザーバと、車両の状態量に基づきアクチュエータ入力で
ある制御指令最終値を算出するレギュレータにより構成
し、前記オブザーバによりステアリング機構に入力され
る外乱トルクを推定し、前記外乱トルク補償部を、オブ
ザーバにより推定された外乱トルクを打ち消すレギュレ
ータ内のフィードバック項とする手段としたことを特徴
とする。According to a ninth aspect of the present invention, in the vehicle lane following control apparatus according to the first aspect, the steering control means includes an observer for estimating a state quantity of the vehicle from an input / output of a system, and a state quantity of the vehicle. A regulator that calculates a control command final value that is an actuator input based on the regulator, estimates a disturbance torque input to a steering mechanism by the observer, and controls the disturbance torque compensator in a regulator that cancels the disturbance torque estimated by the observer. The feedback means is used as a feedback term.
【0016】請求項10記載の発明では、請求項9記載
の車両の車線追従制御装置において、前記オブザーバか
らの出力の1つである外乱トルク推定値の大きさを制限
するリミッタを、オブザーバとレギュレータとの間に設
けたことを特徴とする。According to a tenth aspect of the present invention, in the vehicle lane following control apparatus according to the ninth aspect, the limiter for limiting the magnitude of the disturbance torque estimated value, which is one of the outputs from the observer, is provided by the observer and the regulator. And between the two.
【0017】[0017]
【発明の作用および効果】請求項1記載の発明にあって
は、自車両相対位置検出手段において、目標車線に対す
る自車両の相対位置が検出され、操舵目標値算出手段に
おいて、相対位置の検出に基づき、自車両を目標車線に
誘導するための目標操舵角や目標操舵角速度等の操舵目
標値が算出され、操舵実際値検出手段において、実操舵
角や実操舵角速度等の操舵実際値が検出され、操舵制御
手段において、操舵実際値を操舵目標値に一致させるフ
ィードバック制御によりステアリング機構に設けられた
操舵アクチュエータへ制御指令が出力される。そして、
この操舵制御手段には、ステアリング機構へ入力される
外乱トルクを補償する外乱トルク補償部が設けられ、か
つ、操舵制御手段のフィードバック係数が、操舵外乱が
ないとの想定に基づき設定される。この請求項1で得ら
れる効果は、車線追従性を維持しつつ、操舵系を軽くす
ることができる点にある。車線追従性を維持することに
関しては、ステアリング機構に入力される外乱トルクを
補償する外乱トルク補償部が設けられているためであ
る。また、ハンドルが軽くなる点であるが、操舵外乱を
補償する制御となっているため、操舵角速度,操舵角等
の操舵サーボ系のフィードバック係数は操舵外乱がない
と想定して設定されたフィードバック係数と同じためで
ある。さらに詳しく説明すると、操舵外乱が大きくなる
ほど、操舵外乱を陽な形でフィードバックすることがな
い制御では、操舵角速度,操舵角等の操舵サーボ系のフ
ィードバック係数を大きく設定せざるを得ない。これが
俗に言うハイゲイン制御で、フィードバック係数(=ゲ
イン)を大きくすることにより、モデル化されない要素
(外乱、プラントのモデル化誤差)を補償するものであ
る。すなわち、操舵外乱がないと想定した場合の設計で
は、フィードバック係数を小さくすることができ、ハン
ドルが軽くなり、ドライバの操舵介入を許容することが
できるのである。According to the first aspect of the present invention, the relative position of the vehicle with respect to the target lane is detected by the vehicle relative position detecting means, and the relative position is detected by the steering target value calculating means. A steering target value such as a target steering angle and a target steering angular velocity for guiding the host vehicle to the target lane is calculated, and the actual steering angle and the actual steering angle such as the actual steering angular velocity are detected by the actual steering angle detection means. In the steering control means, a control command is output to a steering actuator provided in the steering mechanism by feedback control for matching the actual steering value to the steering target value. And
This steering control means is provided with a disturbance torque compensating section for compensating the disturbance torque inputted to the steering mechanism, and the feedback coefficient of the steering control means is set based on the assumption that there is no steering disturbance. The effect obtained by the first aspect is that the steering system can be lightened while maintaining the lane following ability. This is because a disturbance torque compensating unit that compensates for disturbance torque input to the steering mechanism is provided for maintaining the lane following ability. Although the steering wheel becomes lighter, the feedback coefficient of the steering servo system, such as the steering angular velocity and steering angle, is a feedback coefficient set assuming that there is no steering disturbance because the control is performed to compensate for the steering disturbance. Because it is the same as More specifically, in a control in which the steering disturbance is not fed back in an explicit manner as the steering disturbance increases, it is necessary to set a large feedback coefficient of the steering servo system such as the steering angular velocity and the steering angle. This is commonly referred to as high gain control, in which elements that are not modeled (disturbances, plant modeling errors) are compensated by increasing the feedback coefficient (= gain). In other words, in a design assuming that there is no steering disturbance, the feedback coefficient can be reduced, the steering wheel becomes lighter, and steering intervention by the driver can be permitted.
【0018】請求項2記載の発明にあっては、外乱トル
ク補償部が、操舵方向と同じ方向で、大きさが一定の操
舵フリクション想定値に基づく制御指令を算出する操舵
フリクション補償部とされ、操舵制御手段が、システム
の入出力から車両の状態量を推定するオブザーバと、車
両の状態量に基づき補償前のフィードバック制御指令を
算出するレギュレータと、前記操舵フリクション補償部
により構成され、操舵制御手段からは、操舵フリクショ
ンを想定しないで算出されたフィードバック制御指令
に、操舵フリクション想定値に基づく制御指令を加えた
制御指令最終値が操舵アクチュエータに出力される。よ
って、オブザーバとレギュレータとは従来のままで、操
舵フリクション補償部を追加するという簡単な構成の変
更により、車線追従性能を維持しつつ、ドライバの操舵
介入を許容することができる。加えて、操舵フリクショ
ン分をフィードフォワードで補償する制御系の構成とな
り、応答性の高い車線追従性能を得ることができる。In the invention according to claim 2, the disturbance torque compensating unit is a steering friction compensating unit that calculates a control command based on an assumed steering friction value having a constant magnitude in the same direction as the steering direction, A steering control means comprising an observer for estimating a state quantity of the vehicle from input / output of the system, a regulator for calculating a feedback control command before compensation based on the state quantity of the vehicle, and the steering friction compensation unit; Thereafter, the control command final value obtained by adding the control command based on the assumed steering friction value to the feedback control command calculated without assuming the steering friction is output to the steering actuator. Therefore, the observer and the regulator can be used as they are, and a simple configuration change of adding a steering friction compensator can allow the driver to intervene in steering while maintaining the lane following performance. In addition, the control system is configured to compensate for the steering friction in a feed-forward manner, so that it is possible to obtain a highly responsive lane following performance.
【0019】請求項3記載の発明にあっては、操舵フリ
クション補償部において、車線追従制御による走行中に
車両に蛇行が発生した場合、操舵フリクション想定値を
大きくする補正が行われ、補正後の操舵フリクション想
定値に基づく制御指令が算出される補償部とされる。す
なわち、予め設定される操舵フリクション想定値は、大
きすぎると操舵フリクション想定値の実フリクションへ
の収束は早まるものの、安定性が低下する傾向にあるた
め、トレードオフを考えて設定される。つまり、車両の
蛇行は、予め設定された操舵フリクション想定値が小さ
いことが原因で発生すると推定できる。よって、車両に
蛇行が発生した場合、操舵フリクション想定値を大きく
する補正を行うことで、操舵フリクション想定値が実操
舵フリクションに近づき、車両の蛇行が抑えられた車線
追従性能を実現することができる。According to the third aspect of the present invention, in the steering friction compensating section, when the vehicle is meandering during traveling by the lane following control, a correction for increasing the assumed steering friction value is performed. The compensating unit calculates a control command based on the assumed steering friction value. That is, if the assumed steering friction value is set to be too large, the convergence of the assumed steering friction value to the actual friction is accelerated, but the stability tends to be reduced. That is, it can be estimated that the meandering of the vehicle occurs due to a small assumed steering friction value set in advance. Therefore, when a meandering occurs in the vehicle, by performing a correction to increase the assumed steering friction value, the assumed steering friction value approaches the actual steering friction, and the lane following performance in which the meandering of the vehicle is suppressed can be realized. .
【0020】請求項4記載の発明にあっては、第1蛇行
判断手段において、ヨーレイト検出手段により検出され
るヨーレイトの符号の変化周期が設定値以上の場合、車
両の蛇行と判断される。よって、ヨーレイトの符号の変
化という単純な物理量により、確実に操舵フリクション
想定値の補正が必要な車両の蛇行を検知することができ
る。According to the fourth aspect of the present invention, if the change period of the sign of the yaw rate detected by the yaw rate detecting means is equal to or greater than a set value, the first meandering determining means determines that the vehicle is meandering. Therefore, it is possible to reliably detect the meandering of the vehicle that requires correction of the assumed steering friction value by using a simple physical quantity such as a change in the sign of the yaw rate.
【0021】請求項5記載の発明にあっては、第2蛇行
判断手段において、ヨーレイトの変化によって引き起こ
される他の物理量の変化を検出した場合、車両の蛇行と
判断される。よって、例えば、ヨー角、前方注視点横変
位、車両重心点横速度、車両重心点横変位等により、確
実に操舵フリクション想定値の補正が必要な車両の蛇行
を検知することができる。According to the fifth aspect of the invention, when the second meandering determination means detects a change in another physical quantity caused by a change in the yaw rate, it is determined that the vehicle is meandering. Therefore, for example, meandering of the vehicle that requires correction of the assumed steering friction value can be reliably detected based on the yaw angle, the lateral displacement of the forward fixation point, the lateral velocity of the vehicle center of gravity, the lateral displacement of the vehicle center of gravity, and the like.
【0022】請求項6記載の発明にあっては、操舵フリ
クション補償部において、車線追従制御による走行中に
操舵角のハンチングが発生した場合、操舵フリクション
想定値を小さくする補正が行われ、補正後の操舵フリク
ション想定値に基づく制御指令が算出される補償部とさ
れる。すなわち、予め設定される操舵フリクション想定
値が、大きすぎると操舵フリクション想定値の実フリク
ションへの収束は早まるものの、安定性が低下し操舵角
のハンチングが生じる。よって、操舵角のハンチングが
発生した場合、操舵フリクション想定値を小さくする補
正を行うことで、操舵フリクション想定値が実操舵フリ
クションに近づき、操舵角のハンチングが抑えられた車
線追従性能を実現することができる。In the invention according to claim 6, in the steering friction compensating section, when hunting of the steering angle occurs during traveling by the lane following control, a correction is made to reduce the assumed value of the steering friction. Is a compensation unit that calculates a control command based on the assumed steering friction value. That is, if the preset assumed steering friction value is too large, the convergence of the assumed steering friction value to the actual friction is accelerated, but the stability is reduced and hunting of the steering angle occurs. Therefore, when hunting of the steering angle occurs, by performing correction to reduce the assumed value of the steering friction, the assumed value of the steering friction approaches the actual steering friction, and the lane following performance in which the hunting of the steering angle is suppressed is realized. Can be.
【0023】請求項7記載の発明にあっては、操舵ハン
チング判断手段において、操舵角速度の絶対値の時間平
均が大きいことをもって操舵角のハンチングと判断され
る。よって、操舵角速度の絶対値を監視することで、操
舵フリクション想定値の補正が必要な操舵ハンチングを
確実に検知することができる。According to the present invention, the steering hunting judging means judges that the steering angle is hunting when the time average of the absolute value of the steering angular velocity is large. Therefore, by monitoring the absolute value of the steering angular velocity, it is possible to reliably detect steering hunting that requires correction of the assumed steering friction value.
【0024】請求項8記載の発明にあっては、外乱トル
ク補償部が、前段のフィードバック制御指令方向と同じ
方向で、大きさが一定の操舵フリクション想定値に基づ
く制御指令を算出する操舵フリクション補償部とされ、
操舵制御手段が、システムの入出力から車両の状態量を
推定するオブザーバと、車両の状態量に基づき補償前の
フィードバック制御指令を算出するレギュレータと、操
舵フリクション補償部により構成され、操舵制御手段か
らは、操舵フリクションを想定しないで算出されたフィ
ードバック制御指令に、操舵フリクション想定値に基づ
く制御指令を加えた制御指令最終値が操舵アクチュエー
タに出力される。よって、オブザーバとレギュレータと
は従来のままで、操舵フリクション補償部を追加すると
いう簡単な構成の変更により、車線追従性能を維持しつ
つ、ドライバの操舵介入を許容することができる。加え
て、車両が蛇行するような場合、目標車線に戻す方向の
フィードバック制御指令と同方向に補償による制御指令
が加わることで、請求項3記載の発明のように、操舵フ
リクション想定値を大きくする補正を行うことなく、車
両の蛇行が抑えられた車線追従性能を実現することがで
きる。According to the present invention, the disturbance torque compensating section calculates a control command based on an assumed value of the steering friction having a constant magnitude in the same direction as the feedback control command direction of the preceding stage. Department and
The steering control means includes an observer for estimating a state quantity of the vehicle from input and output of the system, a regulator for calculating a feedback control command before compensation based on the state quantity of the vehicle, and a steering friction compensation unit. The control command final value obtained by adding the control command based on the assumed steering friction value to the feedback control command calculated without assuming the steering friction is output to the steering actuator. Therefore, the observer and the regulator can be used as they are, and a simple configuration change of adding a steering friction compensator can allow the driver to intervene in steering while maintaining the lane following performance. In addition, when the vehicle is meandering, a feedback control command in the direction of returning to the target lane and a control command by compensation are added in the same direction, thereby increasing the assumed steering friction value. The lane following performance in which the meandering of the vehicle is suppressed can be realized without performing the correction.
【0025】請求項9記載の発明にあっては、操舵制御
手段が、システムの入出力から車両の状態量を推定する
オブザーバと、車両の状態量に基づきアクチュエータ入
力である制御指令最終値を算出するレギュレータにより
構成される。そして、オブザーバによりステアリング機
構に入力される外乱トルクが推定され、外乱トルク補償
部が、オブザーバにより推定された外乱トルクを打ち消
すレギュレータ内のフィードバック項とされる。この請
求項9記載の発明で得られる効果は、請求項1記載の発
明で得られる効果と同様に、車線追従性を維持しつつ、
操舵系を軽くすることができる点にある。ただし、車線
追従性を維持することに関しては、ステアリング機構に
入力される外乱トルクを打ち消すフィードバック項がレ
ギュレータ内に存在するためである。また、ハンドルが
軽くなる点については、請求項1記載の発明と同様の理
由による。According to the ninth aspect of the present invention, the steering control means calculates an observer for estimating a state quantity of the vehicle from input / output of the system, and calculates a control command final value which is an actuator input based on the state quantity of the vehicle. It is composed of a regulator that operates. Then, the disturbance torque input to the steering mechanism is estimated by the observer, and the disturbance torque compensator is used as a feedback term in the regulator that cancels the disturbance torque estimated by the observer. The effect obtained by the invention of claim 9 is the same as the effect obtained by the invention of claim 1, while maintaining the lane following ability.
The point is that the steering system can be lightened. However, the reason for maintaining the lane following ability is that a feedback term exists in the regulator to cancel the disturbance torque input to the steering mechanism. In addition, the point that the handle becomes lighter is for the same reason as the first aspect of the invention.
【0026】請求項10記載の発明にあっては、オブザ
ーバからの出力の1つである外乱トルク推定値の大きさ
を制限するリミッタが、オブザーバとレギュレータとの
間に設けられる。請求項9記載の発明では、フィードバ
ック係数自体を小さい値に保つことにより軽い操舵系を
実現できた。ただ、フィードバック係数がいくら小さく
ても、ドライバ介入がなされた場合、最終的には外乱補
償項が大きくなってしまい、介入を妨げる方向に作用す
る。これは、ドライバ介入を操舵フリクションと同様に
外乱トルクとして推定してしまうためである。ただし、
操舵フリクションはドライバ介入と異なり、所定値以上
にはならない。よって、オブザーバで外乱トルク推定が
所定値以上となった場合は、ドライバ介入以外にはあり
得ない。そのため、外乱トルク補償にリミッタを持たせ
ることにより、操舵フリクションを補償しつつ、ドライ
バ介入を容易にする制御系を構成することが可能とな
る。According to the present invention, a limiter for limiting the magnitude of the disturbance torque estimated value, which is one of the outputs from the observer, is provided between the observer and the regulator. According to the ninth aspect, a light steering system can be realized by keeping the feedback coefficient itself at a small value. However, no matter how small the feedback coefficient is, if driver intervention is performed, the disturbance compensation term eventually increases, which acts in a direction to hinder the intervention. This is because the driver intervention is estimated as a disturbance torque as in the case of the steering friction. However,
The steering friction does not exceed a predetermined value, unlike driver intervention. Therefore, when the disturbance torque estimation by the observer is equal to or more than the predetermined value, there is no possibility other than the driver's intervention. Therefore, by providing the disturbance torque compensation with a limiter, it is possible to configure a control system that facilitates driver intervention while compensating for steering friction.
【0027】[0027]
【発明の実施の形態】(実施の形態1)DESCRIPTION OF THE PREFERRED EMBODIMENTS (Embodiment 1)
【0028】実施の形態1は請求項1,2に記載の発明
に対応する車両の車線追従制御装置である。The first embodiment is a vehicle lane tracking control device according to the first and second aspects of the present invention.
【0029】まず、車両システムの全体構成を説明する
と、図1は車線追従制御装置が搭載された車両を示す斜
視図、図2は車線追従制御装置を示す斜視図である。1
はステアリングホイールであり、この回転角はコラムシ
ャフト2を介してステアリングギヤ3に伝えられ、図示
しないが、ステアリングギヤ3内のラックを左右動する
ことにより前輪が操舵される(ステアリング機構に相
当)。First, the overall configuration of the vehicle system will be described. FIG. 1 is a perspective view showing a vehicle equipped with a lane following control device, and FIG. 2 is a perspective view showing a lane following control device. 1
Is a steering wheel, the rotation angle of which is transmitted to a steering gear 3 via a column shaft 2, and although not shown, a front wheel is steered by moving a rack in the steering gear 3 right and left (corresponding to a steering mechanism). .
【0030】4は操舵アクチュエータであり、モータ5
と、コラムシャフト2に設けられ自動運転中にONとな
る電磁クラッチ6と、モータ5の回転をコラムシャフト
2に伝えるベルト伝達機構7により構成されている。Reference numeral 4 denotes a steering actuator, and a motor 5
And an electromagnetic clutch 6 provided on the column shaft 2 and turned ON during automatic operation, and a belt transmission mechanism 7 for transmitting the rotation of the motor 5 to the column shaft 2.
【0031】8はコントローラ(操舵制御手段に相当)
であり、コラムシャフト2の回転を検出するロータリエ
ンコーダ9(操舵実際値検出手段に相当)からの舵角信
号、車両の前方道路を撮影するCCDカメラ10からの
影像信号により走行車線を認識する車線認識装置11か
らの信号(例えば、道路曲率、前方注視点横変位等)、
ヨーレイトセンサ12からの信号等を入力し、これらの
信号に基づいて前記モータ5の印加電流を制御する。Reference numeral 8 denotes a controller (corresponding to steering control means)
A lane for recognizing a traveling lane based on a steering angle signal from a rotary encoder 9 for detecting rotation of the column shaft 2 (corresponding to actual steering value detecting means) and an image signal from a CCD camera 10 for photographing a road ahead of the vehicle. Signals from the recognition device 11 (for example, road curvature, forward gazing point lateral displacement, etc.),
Signals and the like from the yaw rate sensor 12 are input, and the current applied to the motor 5 is controlled based on these signals.
【0032】制御部の全体構成を説明すると、図3はコ
ントローラ8を示す制御ブロック図であり、指令電流、
操舵角、道路曲率、前方注視点横変位より、車両の状態
両を推定するオブザーバ81と、車両の状態量に基づき
アクチュエータ指令電流を算出するレギュレータ82
と、指令電流に補正を施す操舵フリクション補償部83
(外乱トルク補償部に相当)から構成されている。FIG. 3 is a control block diagram showing the controller 8, which includes a command current,
An observer 81 for estimating the state of the vehicle based on the steering angle, the curvature of the road, and the lateral displacement of the forward gazing point, and a regulator 82 for calculating an actuator command current based on the state amount of the vehicle
Friction compensation unit 83 for correcting the command current
(Corresponding to a disturbance torque compensator).
【0033】オブザーバ81の構成を説明すると、図4
はオブザーバ81の構成を示す概略図であり、図中A,
B,C,Dは車両重量、ヨー慣性モーメント、車速等、
制御対象の特性から決定される行列、また、Keは観測
ノイズによって決定される行列である。図15に示す式
1は電流i及び道路曲率ρを入力とする状態方程式であ
る。図16に示す式2に出力方程式の一例を示す。式
1,2を、図16に示す式3,4で略記してオブザーバ
構成の中のA,B,C,Dの行列を得る。Keの決定法
はカルマンフィルタの構成法が知られており詳細は省略
する。The structure of the observer 81 will be described.
Is a schematic diagram showing the configuration of the observer 81, in which A,
B, C, D are vehicle weight, yaw moment of inertia, vehicle speed, etc.
A matrix determined from the characteristics of the control target, and Ke is a matrix determined by observation noise. Equation 1 shown in FIG. 15 is a state equation that inputs a current i and a road curvature ρ. Equation 2 shown in FIG. 16 shows an example of the output equation. Expressions 1 and 2 are abbreviated as Expressions 3 and 4 shown in FIG. 16 to obtain a matrix of A, B, C, and D in the observer configuration. As a method of determining Ke, a method of configuring a Kalman filter is known, and details thereof are omitted.
【0034】レギュレータ82の構成を説明すると、レ
ギュレータ82の例を図16の式5に示す。各状態の定
数フィードバックの場合、各定数(式5中のk1〜k
7)の決定法は、例えば、線形2次形式評価関数の最適
制御が知られている。その場合の例を示す。式1が制御
対象を表す式であるが、制御対象の入力に制御量である
電流iの他に道路曲率ρが存在し、通常の最適制御設計
ができる構造ではない。これを克服する方法として、確
率論的最適レギュレータ設計法が知られており、制御量
以外のシステムの入力を白色ノイズで駆動される一次系
で近似し、状態量に組み入れるものである。図17に示
す式6に道路曲率ρの振る舞いを近似する一次式を示
す。式6中のλ及びω分散の決定法を示す。まず、道路
曲率ρの振る舞いを振幅ρ0が一定で周期が不確定な、
ポアソン方形波で近似する。例えば、想定する道路の曲
率平均を振幅ρ0に代入する。道路曲率ρの変化は不確
定であるが、1秒にどの程度零を横切るかどうかで近似
する。その回数をνρとする。このポアソン近似を式6
の近似に戻すと図17の関係式7,8を得る。これによ
りλ及びω分散を決定できる。式6を式1に代入し、図
17の式9を得る。この形は最適制御を適用する形式と
なっている。以後、最適制御設計の詳細に入ってしまう
ため省略する。The structure of the regulator 82 will be described. An example of the regulator 82 is shown in Equation 5 in FIG. In the case of constant feedback of each state, each constant (k1 to k in Equation 5)
For the determination method 7), for example, optimal control of a linear quadratic evaluation function is known. An example in that case is shown. Equation 1 is an equation representing the control target, but the input of the control target has a road curvature ρ in addition to the current i, which is the control amount, and does not have a structure that enables normal optimal control design. As a method for overcoming this, a stochastic optimal regulator design method is known, in which the input of the system other than the controlled variable is approximated by a primary system driven by white noise and incorporated into the state variable. Equation 6 shown in FIG. 17 shows a linear equation that approximates the behavior of the road curvature ρ. 6 shows a method for determining λ and ω dispersion in Equation 6. First, the behavior of the road curvature ρ is expressed as follows:
Approximate by Poisson square wave. For example, the average curvature of the assumed road is substituted for the amplitude ρ0. Although the change in the road curvature ρ is uncertain, it is approximated by how much it crosses zero per second. Let the number of times be νρ. This Poisson approximation is given by Equation 6.
By returning to the approximation, the relational expressions 7 and 8 in FIG. 17 are obtained. This allows the λ and ω dispersion to be determined. By substituting Equation 6 into Equation 1, Equation 9 in FIG. 17 is obtained. This form is a form that applies optimal control. Hereinafter, the details of the optimal control design will be omitted.
【0035】操舵フリクション補償部83の構成につい
て、図5に示す制御フローにより説明する。ステップ5
0では、操舵角速度が操舵方向判定する入力Qとされ
る。ステップ51では、入力Qにより操舵方向を示す符
号Rが算出される。ここで、sign()は、入力Qが正の場
合1を、負の場合は−1を、零の場合は0を出力する。
ステップ52では、モータ印加電流I_totalが、フィー
ドバック分の指令電流値I_fbに、一定の操舵フリクシ
ョン想定値Wに相当する指令電流値R*W/NA*KT
を加えることで算出される。ここで、NAはアクチュエ
ータギヤ比、KTはモータトルク定数である。The configuration of the steering friction compensator 83 will be described with reference to a control flow shown in FIG. Step 5
At 0, the steering angular velocity is the input Q for determining the steering direction. In step 51, the code R indicating the steering direction is calculated from the input Q. Here, sign () outputs 1 when the input Q is positive, outputs -1 when the input Q is negative, and outputs 0 when it is zero.
In step 52, the motor applied current I_total is changed to the command current value I_fb for the feedback and the command current value R * W / NA * KT corresponding to the constant assumed steering friction value W.
Is calculated by adding Here, NA is the actuator gear ratio, and KT is the motor torque constant.
【0036】すなわち、操舵フリクションを想定しない
で計算されたフィードバック分の指令電流値I_fbに、
操舵フリクション相当分の指令電流値R*W/NA*K
Tを加えてモータ印加電流I_totalが算出される。That is, the feedback command current value I_fb calculated without assuming the steering friction is:
Command current value R * W / NA * K corresponding to steering friction
The motor application current I_total is calculated by adding T.
【0037】よって、この実施の形態1では、車線追従
性を維持しつつ、操舵系を軽くすることができるという
効果が得られる。つまり、車線追従性を維持することに
関しては、ステアリング機構に入力される外乱トルクを
補償する操舵フリクション補償部83が設けられ、操舵
外乱を補償する効果が発揮されるためである。また、ハ
ンドルが軽くなる点であるが、操舵外乱を補償する制御
となっているため、操舵角速度,操舵角等の操舵サーボ
系のフィードバック係数は操舵外乱がないと想定して設
定されたフィードバック係数と同じためである。さらに
詳しく説明すると、操舵外乱が大きくなるほど、操舵外
乱を陽な形でフィードバックすることがない制御では、
操舵角速度,操舵角等の操舵サーボ系のフィードバック
係数を大きく設定せざるを得ない。これが俗に言うハイ
ゲイン制御で、フィードバック係数(=ゲイン)を大き
くすることにより、モデル化されない要素(外乱、プラ
ントのモデル化誤差)を補償するものである。すなわ
ち、操舵外乱がないと想定した場合の設計では、フィー
ドバック係数を小さくすることができ、ハンドルが軽く
なり、ドライバの操舵介入を許容することができるので
ある。Therefore, in the first embodiment, an effect is obtained that the steering system can be lightened while maintaining the lane following ability. That is, in order to maintain the lane following ability, the steering friction compensator 83 for compensating the disturbance torque input to the steering mechanism is provided, and the effect of compensating the steering disturbance is exhibited. Although the steering wheel becomes lighter, the feedback coefficient of the steering servo system, such as the steering angular velocity and steering angle, is a feedback coefficient set assuming that there is no steering disturbance because the control is performed to compensate for the steering disturbance. Because it is the same as More specifically, in the control in which the steering disturbance is not fed back in an explicit manner as the steering disturbance increases,
The feedback coefficient of the steering servo system such as the steering angular velocity and the steering angle has to be set large. This is commonly referred to as high gain control, in which elements that are not modeled (disturbances, plant modeling errors) are compensated by increasing the feedback coefficient (= gain). In other words, in a design assuming that there is no steering disturbance, the feedback coefficient can be reduced, the steering wheel becomes lighter, and steering intervention by the driver can be permitted.
【0038】また、実施の形態1では、フィードバック
分の指令電流値I_fbに加える操舵フリクション相当分
の指令電流値R*W/NA*KTの方向を、操舵角速度
の符号により決まる操舵方向と同じ方向としているた
め、操舵フリクション分をフィードフォワードで補償す
る制御系の構成となり、応答性の高い車線追従性能を得
ることができる。In the first embodiment, the direction of the command current value R * W / NA * KT corresponding to the steering friction added to the command current value I_fb for the feedback is set to the same direction as the steering direction determined by the sign of the steering angular velocity. Therefore, the control system is configured to compensate for the steering friction by feedforward, and it is possible to obtain the lane following performance with high responsiveness.
【0039】さらに、コントローラ8が、システムの入
出力から車両の状態量を推定するオブザーバ81と、車
両の状態量に基づき補償前のフィードバック制御指令を
算出するレギュレータ82と、操舵フリクション補償部
83により構成されるため、オブザーバ81とレギュレ
ータ82とは、フィードバック係数を小さくするだけで
従来のままとし、操舵フリクション補償部83を追加す
るという簡単な構成の変更により、車線追従性能を維持
しつつ、ドライバの操舵介入を許容することができる。Further, the controller 8 includes an observer 81 for estimating the state quantity of the vehicle from the input / output of the system, a regulator 82 for calculating a feedback control command before compensation based on the state quantity of the vehicle, and a steering friction compensation unit 83. Therefore, the observer 81 and the regulator 82 can maintain the lane-following performance while maintaining the lane following performance by a simple configuration change in which the observer 81 and the regulator 82 remain unchanged only by reducing the feedback coefficient and the steering friction compensator 83 is added. Steering intervention can be tolerated.
【0040】(実施の形態2)(Embodiment 2)
【0041】請求項3,4,5記載の発明に対応する実
施の形態2について説明する。この実施の形態2は、操
舵フリクション補償部83以外は、実施の形態1と同じ
であるので、操舵フリクション補償部83以外の説明は
省略する。A second embodiment corresponding to the third, fourth, and fifth aspects of the present invention will be described. Since the second embodiment is the same as the first embodiment except for the steering friction compensator 83, the description other than the steering friction compensator 83 will be omitted.
【0042】実施の形態2における操舵フリクション補
償部83の構成について、図6に示す制御フローにより
説明する。ステップ60では、ヨーレイト信号が蛇行を
判定する入力Uとされる。ステップ61では、入力Uに
よりヨー発生方向を示す符号Xが算出される。ここで、
sign()は、入力Uが正の場合1を、負の場合は−1を、
零の場合は0を出力する。また、X(0)の(0)は現在値を
示す。ステップ62では、符号Xが変わるまで増加する
カウンタ値Yが算出される。なお、このカウンタ値Y
は、符号Xが切り替わる時点で零クリアされる。また、
(X(0)==X(1))は、X(0)=X(1)の場合は1、X
(0)≠X(1)の場合は0とされる。ステップ63では、カ
ウンタ値Yの最大値、すなわち、ヨーレイト符号変化の
半周期相当の物理量Zがストアされる。なお、(Y(0)
!=0)は、Y(0) ≠0の場合は1とされる。ステップ
64では、操舵フリクション想定値Wの現在値W(0)と
補正値の現在値C*Z(0)の和が操舵フリクション想定
値W(1)とされる。ここで、Cは補正係数である。ステ
ップ65では、操舵角速度が操舵方向判定する入力Qと
される。ステップ66では、入力Qにより操舵方向を示
す符号Rが算出される。ここで、sign()は、入力Qが正
の場合1を、負の場合は−1を、零の場合は0を出力す
る。ステップ67では、モータ印加電流I_totalが、フ
ィードバック分の指令電流値I_fbに、補正により大き
くされた操舵フリクション想定値W(1)に相当する指令
電流値R*W(1)/NA*KTを加えることで算出され
る。ここで、NAはアクチュエータギヤ比、KTはモー
タトルク定数である。The configuration of the steering friction compensator 83 in the second embodiment will be described with reference to the control flow shown in FIG. In step 60, the yaw rate signal is set as an input U for determining meandering. In step 61, a code X indicating the yaw generation direction is calculated from the input U. here,
sign () is 1 if the input U is positive, -1 if it is negative,
If it is zero, it outputs 0. (0) of X (0) indicates the current value. In step 62, a counter value Y that increases until the sign X changes is calculated. Note that this counter value Y
Is cleared to zero when the code X is switched. Also,
(X (0) == X (1)) is 1 when X (0) = X (1), and X
If (0) ≠ X (1), it is set to 0. In step 63, the maximum value of the counter value Y, that is, the physical quantity Z corresponding to a half cycle of the yaw rate code change is stored. Note that (Y (0)
! = 0) is set to 1 when Y (0) ≠ 0. In step 64, the sum of the current value W (0) of the assumed steering friction value W and the current value C * Z (0) of the correction value is set as the assumed steering friction value W (1). Here, C is a correction coefficient. In step 65, the steering angular velocity is set as an input Q for determining the steering direction. In step 66, the code R indicating the steering direction is calculated from the input Q. Here, sign () outputs 1 when the input Q is positive, outputs -1 when the input Q is negative, and outputs 0 when it is zero. In step 67, the motor applied current I_total adds a command current value R * W (1) / NA * KT corresponding to the assumed steering friction value W (1) increased by the correction to the command current value I_fb for the feedback. It is calculated by: Here, NA is the actuator gear ratio, and KT is the motor torque constant.
【0043】上記制御フローから明らかなように、実施
の形態2では、操舵フリクション想定値Wの補正量は、
ヨーレイトの符号が変わらない時間(半周期に相当)に
相当する物理量Zが大きいほど、大きくなるように補正
される。なお、補正係数Cは、一定値であり符号が正で
ある。As is apparent from the above control flow, in the second embodiment, the correction amount of the assumed steering friction value W is
The correction is made to increase as the physical quantity Z corresponding to the time (corresponding to a half cycle) during which the sign of the yaw rate does not change is increased. Note that the correction coefficient C has a constant value and a positive sign.
【0044】すなわち、予め設定される操舵フリクショ
ン想定値Wは、大きすぎると操舵フリクション想定値の
実フリクションへの収束は早まるものの、安定性が低下
する傾向にあるため、トレードオフを考えて設定され
る。つまり、車両の蛇行は、予め設定された操舵フリク
ション想定値Wが小さいことが原因で発生すると推定で
きる。That is, if the assumed steering friction value W is too large, the convergence of the assumed steering friction value to the actual friction is accelerated, but the stability tends to be reduced. You. That is, it can be estimated that the meandering of the vehicle occurs due to a small assumed steering friction value W set in advance.
【0045】よって、実施の形態2では、車両に蛇行が
発生した場合、操舵フリクション想定値Wを大きくする
補正を行うことで、操舵フリクション想定値W(1)が実
操舵フリクションに近づき、車両の蛇行が抑えられた車
線追従性能を実現することができる。Therefore, in the second embodiment, when meandering occurs in the vehicle, correction is performed to increase the assumed steering friction value W, so that the assumed steering friction value W (1) approaches the actual steering friction, and The lane following performance in which the meandering is suppressed can be realized.
【0046】なお、ヨーレイトセンサ12により検出さ
れるヨーレイト信号の符号の変化周期が設定値以上の場
合、車両の蛇行と判断し、操舵フリクション想定値Wを
大きくする補正を行うようにしても良く、この場合は、
ヨーレイトの符号の変化という単純な物理量により、確
実に操舵フリクション想定値Wの補正が必要な車両の蛇
行を検知することができる。When the change period of the sign of the yaw rate signal detected by the yaw rate sensor 12 is equal to or longer than the set value, it may be determined that the vehicle is meandering, and correction may be performed to increase the assumed steering friction value W. in this case,
A simple physical quantity such as a change in the sign of the yaw rate can reliably detect the meandering of the vehicle that requires correction of the assumed steering friction value W.
【0047】また、ヨーレイトの変化によって引き起こ
される他の物理量の変化を検出した場合、車両の蛇行と
判断し、操舵フリクション想定値Wを大きくする補正を
行うようにしても良い。この場合、例えば、ヨー角、前
方注視点横変位、車両重心点横速度、車両重心点横変位
等により、確実に操舵フリクション想定値Wの補正が必
要な車両の蛇行を検知することができる。Further, when a change in other physical quantity caused by a change in yaw rate is detected, it may be determined that the vehicle is meandering, and a correction may be made to increase the assumed steering friction value W. In this case, for example, the meandering of the vehicle that requires correction of the assumed steering friction value W can be reliably detected based on the yaw angle, the lateral displacement of the gazing point ahead, the lateral velocity of the vehicle center of gravity, the lateral displacement of the vehicle center of gravity, and the like.
【0048】(実施の形態3)(Embodiment 3)
【0049】請求項6,7記載の発明に対応する実施の
形態3について説明する。この実施の形態3は、操舵フ
リクション補償部83以外は、実施の形態1と同じであ
るので、操舵フリクション補償部83以外の説明は省略
する。Embodiment 3 corresponding to the sixth and seventh aspects of the present invention will be described. Since the third embodiment is the same as the first embodiment except for the steering friction compensator 83, the description other than the steering friction compensator 83 is omitted.
【0050】実施の形態3における操舵フリクション補
償部83の構成について、図7に示す制御フローにより
説明する。ステップ70では、操舵角速度がハンチング
を判定する入力Uとされる。ステップ71では、入力U
によりハンチングを判定する操舵角速度絶対値Xが算出
される。ここで、abs()は、入力の絶対値を出力する。
ステップ72では、操舵角速度の絶対値の平均的な大き
さYが算出される。なお、LPF()は、ローパスフィル
タをあらわす。ステップ73では、操舵フリクション想
定値Wの現在値W(0)と補正値C*Yの和が操舵フリク
ション想定値W(1)とされる。ここで、Cは補正係数で
あるが、実施の形態2と異なり、符号はマイナスとな
る。ステップ74では、操舵角速度が操舵方向を判定す
る入力Qとされる。ステップ75では、入力Qにより操
舵方向を示す符号Rが算出される。ステップ76では、
モータ印加電流I_totalが、フィードバック分の指令電
流値I_fbに、補正により小さくされた操舵フリクショ
ン想定値W(1)に相当する指令電流値R*W(1)/NA*
KTを加えることで算出される。ここで、NAはアクチ
ュエータギヤ比、KTはモータトルク定数である。The configuration of the steering friction compensator 83 in the third embodiment will be described with reference to a control flow shown in FIG. In step 70, the steering angular velocity is set as an input U for determining hunting. In step 71, the input U
, The steering angular velocity absolute value X for determining hunting is calculated. Here, abs () outputs the absolute value of the input.
In step 72, the average magnitude Y of the absolute value of the steering angular velocity is calculated. Note that LPF () represents a low-pass filter. In step 73, the sum of the current value W (0) of the assumed steering friction value W and the correction value C * Y is set as the assumed steering friction value W (1). Here, C is a correction coefficient, but unlike Embodiment 2, the sign is minus. In step 74, the steering angular velocity is used as an input Q for determining the steering direction. In step 75, the code R indicating the steering direction is calculated from the input Q. In step 76,
The motor applied current I_total becomes the command current value I_fb for the feedback and the command current value R * W (1) / NA * corresponding to the assumed steering friction value W (1) reduced by the correction.
It is calculated by adding KT. Here, NA is the actuator gear ratio, and KT is the motor torque constant.
【0051】上記制御フローから明らかなように、実施
の形態3では、操舵フリクション想定値Wの補正量は、
操舵角速度の絶対値にローパスフィルタを施し、その値
Yが大きいほど、小さくなるように補正される。As is apparent from the above control flow, in the third embodiment, the correction amount of the assumed steering friction value W is
A low-pass filter is applied to the absolute value of the steering angular velocity, and the absolute value of the steering angular velocity is corrected so as to decrease as the value Y increases.
【0052】すなわち、予め設定される操舵フリクショ
ン想定値Wが、大きすぎると操舵フリクション想定値W
の実フリクションへの収束は早まるものの、安定性が低
下し操舵角のハンチングが生じる。That is, if the preset assumed steering friction value W is too large, the assumed steering friction value W
Although the convergence to the actual friction is accelerated, the stability is reduced and the hunting of the steering angle occurs.
【0053】よって、操舵角のハンチングが発生した場
合、操舵フリクション想定値Wを小さくする補正を行う
ことで、操舵フリクション想定値Wが実操舵フリクショ
ンに近づき、操舵角のハンチングが抑えられた車線追従
性能を実現することができる。Therefore, when hunting of the steering angle occurs, correction is performed to reduce the assumed steering friction value W, so that the assumed steering friction value W approaches the actual steering friction, and the lane following in which the hunting of the steering angle is suppressed is suppressed. Performance can be realized.
【0054】また、操舵角速度の絶対値の時間平均が大
きいことをもって操舵角のハンチングと判断されるた
め、操舵角速度の絶対値を監視することで、操舵フリク
ション想定値Wの補正が必要な操舵ハンチングを確実に
検知することができる。Since the time average of the absolute value of the steering angular velocity is large, it is determined that the steering angle is hunting. Therefore, by monitoring the absolute value of the steering angular velocity, the steering hunting which needs to correct the assumed steering friction value W is required. Can be reliably detected.
【0055】さらに、ローパスフィルタを強めると、突
発的な操舵介入による動き等を検知せず、制御系自身が
発生させるハンチングを効果的に抽出できる。ただし、
強めすぎると操舵フリクション想定値Wの実フリクショ
ンへの収束に時間がかかりすぎることになり、両者のト
レードオフを考慮して設定する。Further, when the low-pass filter is strengthened, hunting generated by the control system itself can be effectively extracted without detecting a movement or the like due to sudden steering intervention. However,
If it is too strong, it takes too much time for the assumed steering friction value W to converge to the actual friction, and the setting is made in consideration of a trade-off between the two.
【0056】(実施の形態4)(Embodiment 4)
【0057】請求項8記載の発明に対応する実施の形態
4について説明する。この実施の形態4は、操舵フリク
ション補償部83以外は、実施の形態1と同じであるの
で、操舵フリクション補償部83以外の説明は省略す
る。A fourth embodiment corresponding to the eighth aspect of the present invention will be described. The fourth embodiment is the same as the first embodiment except for the steering friction compensator 83, and therefore, the description other than the steering friction compensator 83 is omitted.
【0058】操舵フリクション補償部83の構成につい
て、図8に示す制御フローにより説明する。なお、ステ
ップ80を除き、ステップ81及びステップ82は、図
5のステップ51及びステップ52と同様であり説明を
省略する。ステップ80では、フィードバック分の指令
電流値I_fbが補償する操舵方向を判定する入力Qとさ
れる。The configuration of the steering friction compensator 83 will be described with reference to a control flow shown in FIG. Except for step 80, steps 81 and 82 are the same as steps 51 and 52 in FIG. In step 80, the input Q for determining the steering direction to be compensated by the command current value I_fb for the feedback is used.
【0059】すなわち、実施の形態1では操舵方向に一
定の操舵フリクション想定値Wに相当する操舵力を付与
するものであったのに対し、この実施の形態4では、補
償をする前段の指令電流の方向に一定の操舵力を付与す
るようにしている。That is, in the first embodiment, the steering force corresponding to the constant assumed steering friction value W is applied in the steering direction, whereas in the fourth embodiment, the command current at the stage before the compensation is provided. A constant steering force is applied in the direction of.
【0060】よって、実施の形態1と同様の効果得られ
るのに加え、車両が蛇行するような場合、目標車線に戻
す方向のフィードバック分の指令電流値I_fbと同方向
に補償による指令電流値R*W/NA*KTが加わるこ
とで、実施の形態2のように、操舵フリクション想定値
Wを大きくする補正を行うことなく、車両の蛇行が抑え
られた車線追従性能を実現することができる。Therefore, in addition to obtaining the same effects as in the first embodiment, when the vehicle is meandering, the command current value R_fb for the feedback in the direction of returning to the target lane is compensated in the same direction as the command current value R_fb. By adding * W / NA * KT, it is possible to realize lane following performance in which meandering of the vehicle is suppressed without performing correction to increase the assumed steering friction value W as in the second embodiment.
【0061】(実施の形態5)(Embodiment 5)
【0062】請求項8記載の発明に対応する実施の形態
5について説明する。この実施の形態5は、操舵フリク
ション補償部83以外は、実施の形態1と同じであるの
で、操舵フリクション補償部83以外の説明は省略す
る。A fifth embodiment corresponding to the eighth aspect of the present invention will be described. The fifth embodiment is the same as the first embodiment except for the steering friction compensator 83, and therefore, the description other than the steering friction compensator 83 is omitted.
【0063】操舵フリクション補償部83の構成につい
て、図9に示す制御フローにより説明する。なお、ステ
ップ95を除き、ステップ90〜ステップ94及びステ
ップ96,ステップ97は、図6のステップ60〜ステ
ップ64及びステップ66,ステップ67と同様であり
説明を省略する。ステップ95では、フィードバック分
の指令電流値I_fbが補償する操舵方向を判定する入力
Qとされる。The configuration of the steering friction compensator 83 will be described with reference to the control flow shown in FIG. Except for step 95, steps 90 to 94, 96, and 97 are the same as steps 60 to 64, 66, and 67 in FIG. In step 95, the input Q for determining the steering direction to be compensated by the command current value I_fb for the feedback is used.
【0064】すなわち、実施の形態2では操舵方向に一
定の操舵フリクション想定値Wに相当する操舵力を付与
するものであったのに対し、この実施の形態5では、補
償をする前段の指令電流の方向に一定の操舵力を付与す
るようにしている。That is, in the second embodiment, the steering force corresponding to the constant assumed steering friction value W is applied in the steering direction, whereas in the fifth embodiment, the command current at the stage before the compensation is applied. A constant steering force is applied in the direction of.
【0065】よって、実施の形態5では、車両に蛇行が
発生した場合、操舵フリクション想定値Wを大きくする
補正を行うことで、操舵フリクション想定値W(1)が実
操舵フリクションに近づき、車両の蛇行が抑えられた車
線追従性能を実現することができる。さらに、この実施
の形態5では、フィードバック分の指令電流値I_fbと
同方向に補償分の指令電流値を加えるようにしているた
め、実施の形態2よりもさらにロバスト性の高い車線追
従性能を実現することができる。Therefore, in the fifth embodiment, when meandering occurs in the vehicle, correction is performed to increase the assumed steering friction value W, so that the assumed steering friction value W (1) approaches the actual steering friction, and The lane following performance in which the meandering is suppressed can be realized. Furthermore, in the fifth embodiment, since the command current value for the compensation is added in the same direction as the command current value I_fb for the feedback, the lane following performance with higher robustness than in the second embodiment is realized. can do.
【0066】(実施の形態6)(Embodiment 6)
【0067】請求項8記載の発明に対応する実施の形態
6について説明する。この実施の形態5は、操舵フリク
ション補償部83以外は、実施の形態1と同じであるの
で、操舵フリクション補償部83以外の説明は省略す
る。A sixth embodiment corresponding to the eighth aspect of the present invention will be described. The fifth embodiment is the same as the first embodiment except for the steering friction compensator 83, and therefore, the description other than the steering friction compensator 83 is omitted.
【0068】操舵フリクション補償部83の構成につい
て、図10に示す制御フローにより説明する。なお、ス
テップ104を除き、ステップ100〜ステップ103
及びステップ105,ステップ106は、図7のステッ
プ70〜ステップ73及びステップ75,ステップ76
と同様であり説明を省略する。ステップ104では、フ
ィードバック分の指令電流値I_fbが補償する操舵方向
を判定する入力Qとされる。The configuration of the steering friction compensator 83 will be described with reference to a control flow shown in FIG. Note that, except for step 104, steps 100 to 103
And steps 105 and 106 correspond to steps 70 to 73 and steps 75 and 76 in FIG.
The description is omitted. In step 104, the command current value I_fb for the feedback is set as an input Q for determining the steering direction to be compensated.
【0069】すなわち、実施の形態2では操舵方向に一
定の操舵フリクション想定値Wに相当する操舵力を付与
するものであったのに対し、この実施の形態6では、補
償をする前段の指令電流の方向に一定の操舵力を付与す
るようにしている。That is, in the second embodiment, a steering force corresponding to a constant assumed steering friction value W is applied in the steering direction, whereas in the sixth embodiment, a command current in a stage prior to compensation is provided. A constant steering force is applied in the direction of.
【0070】よって、実施の形態6では、操舵角のハン
チングが発生した場合、操舵フリクション想定値Wを小
さくする補正を行うことで、操舵フリクション想定値W
が実操舵フリクションに近づき、操舵角のハンチングが
抑えられた車線追従性能を実現することができる。Therefore, in the sixth embodiment, when hunting of the steering angle occurs, the correction to reduce the assumed steering friction value W is performed, so that the assumed steering friction value W is corrected.
Can approach the actual steering friction, and the lane following performance in which the hunting of the steering angle is suppressed can be realized.
【0071】(実施の形態7)(Embodiment 7)
【0072】請求項9記載の発明に対応する実施の形態
7について説明する。この実施の形態7は、車両システ
ムの全体構成については、図1及び図2に示す実施の形
態1と同様であるが、コントローラ8が、図11に示す
ように、システムの入出力(入力として、アクチュエー
タ指令電流、道路曲率、出力として、前方注視点横変
位、操舵角等が挙げられる。)から内部の状態量(例え
ば、ヨーレイト、ヨー角、横速度、横変位、操舵角速
度、操舵角)を推定するオブザーバ84と、車両の状態
量及び道路曲率に基づきアクチュエータ入力である制御
指令最終値を算出するレギュレータ85により構成され
る。A seventh embodiment according to the ninth aspect of the present invention will be described. In the seventh embodiment, the overall configuration of the vehicle system is the same as that of the first embodiment shown in FIGS. 1 and 2. However, as shown in FIG. , Actuator command current, road curvature, and output include forward fixation point lateral displacement, steering angle, etc.) to internal state quantities (eg, yaw rate, yaw angle, lateral speed, lateral displacement, steering angular velocity, steering angle). And a regulator 85 for calculating a final control command value as an actuator input based on the state of the vehicle and the road curvature.
【0073】オブザーバ84の構成を図4(概略図とし
ては同じ)により説明すると、図中A,B,C,Dはシ
ステム構造(車両重量、ヨー慣性モーメント、車速等、
制御対象の特性等)から決定される行列、また、Keは
観測ノイズによって決定される行列である。以下、操舵
外乱を考慮したABCD及びKeの決定法を示す。図1
8に示す式10は電流i及び道路曲率ρを入力、操舵外
乱Tdを非制御の入力(すなわち、外乱)とする状態方
程式である。図16に示す式2に出力方程式の一例を示
す。この場合、出力は操舵角及び前方注視点横変位であ
る。ただし、図4を見れば明らかなように、オブザーバ
を想定するシステムには外乱が存在しない(式10のT
dが存在しない。)。この問題を克服する方法が外乱オ
ブザーバと呼ばれるもので、外乱を白色ノイズで駆動さ
れる一次系で近似し、状態量に組み入れるものである。
図18の式11に操舵外乱の振る舞いを近似する一次式
を示す。式11中のλ及びωの分散の決定方法を示す。
まず、操舵外乱の振る舞いを振幅Td0が一定で周期が不
確定なポアソン方形波で近似する。例えば、操舵系のフ
リクションの値を振幅Td0に代入する。操舵系のフリク
ションを不確定であるが、1秒にどの程度零を横切るか
で近似する。その回数をνtdとする。このポアソン近似
をしき11の近似に戻すと、式12と式13の関係式を
得る。これによりλ及びωの分散を決定できる。式11
を式10と式2に代入し、図19に示す式14と式15
を得る。式14,15を略記してオブザーバ84の構成
中におけるABCDの行列を得る。次に、Keの決定法
を説明する。これはカルマンフィルタの構成法が知られ
ており、観測ノイズの分散(この場合には前方注視点横
変位のノイズの分散)と、状態量に加わるノイズの分散
(この場合には操舵外乱に加わるノイズωの分散)及び
ABCD行列から決定されるが、詳細は省略する。The structure of the observer 84 will be described with reference to FIG. 4 (schematic diagram is the same). In the figure, A, B, C, and D denote system structures (vehicle weight, yaw moment of inertia, vehicle speed, etc.).
And Ke is a matrix determined by observation noise. Hereinafter, a method of determining ABCD and Ke in consideration of steering disturbance will be described. Figure 1
Equation 10 shown in FIG. 8 is a state equation in which the current i and the road curvature ρ are input, and the steering disturbance Td is an uncontrolled input (that is, disturbance). Equation 2 shown in FIG. 16 shows an example of the output equation. In this case, the outputs are the steering angle and the lateral displacement of the forward fixation point. However, as is clear from FIG. 4, no disturbance exists in the system assuming the observer (T in Expression 10).
d does not exist. ). A method of overcoming this problem is called a disturbance observer, in which the disturbance is approximated by a primary system driven by white noise and incorporated into a state quantity.
Equation 11 in FIG. 18 shows a linear equation that approximates the behavior of the steering disturbance. A method for determining the dispersion of λ and ω in Equation 11 will be described.
First, the behavior of the steering disturbance is approximated by a Poisson square wave having a constant amplitude Td0 and an indefinite period. For example, the value of the friction of the steering system is substituted for the amplitude Td0. Although the friction of the steering system is uncertain, it approximates how much crosses zero per second. The number of times is referred to as vtd. When this Poisson approximation is returned to the approximation of the threshold 11, the relational expression of the expressions 12 and 13 is obtained. This allows the variance of λ and ω to be determined. Equation 11
Into Equations 10 and 2, and Equations 14 and 15 shown in FIG.
Get. Equations 14 and 15 are abbreviated to obtain the ABCD matrix in the configuration of the observer 84. Next, a method for determining Ke will be described. This is known as a method of constructing a Kalman filter. The variance of the observation noise (in this case, the variance of the lateral displacement of the forward fixation point) and the variance of the noise added to the state quantity (in this case, variance) and the ABCD matrix, but details are omitted.
【0074】レギュレータ85の構成を説明すると、レ
ギュレータ85の例を図19の式16に示す。各状態の
定数フィードバックの場合、各定数(式16中のk1〜
k7)の決定法は、例えば、線形2次形式評価関数の最
適制御が知られている。その場合の例を示す。式14が
制御対象を表す式であるが、制御対象の入力に制御量で
ある電流iの他に道路曲率ρが存在し、通常の最適制御
設計ができる構造ではない。これを克服する方法とし
て、確率論的最適レギュレータ設計法が知られており、
制御量以外のシステムの入力を白色ノイズで駆動される
一次系で近似し、状態量に組み入れるものである。図2
0に示す式17に道路曲率ρの振る舞いを近似する一次
式を示す。式17中のλρ及びωρ分散の決定法を示
す。まず、道路曲率ρの振る舞いを振幅ρ0が一定で周
期が不確定な、ポアソン方形波で近似する。例えば、想
定する道路の曲率平均を振幅ρ0に代入する。道路曲率
ρの変化は不確定であるが、1秒にどの程度零を横切る
かどうかで近似する。その回数をνρとする。このポア
ソン近似を式17の近似に戻すと図20の関係式(式1
8,19)を得る。これによりλ ρ及びωρ分散を決定
できる。式17を式14に代入し、図20の式20を得
る。この形は最適制御を適用する形式となっている。以
後、最適制御設計の詳細に入ってしまうため省略する。The configuration of the regulator 85 will be described.
An example of the regulator 85 is shown in Expression 16 in FIG. Of each state
In the case of constant feedback, each constant (k1 to k1 in Equation 16)
The determination method of k7) is, for example, the maximum of the linear quadratic form evaluation function.
Appropriate control is known. An example in that case is shown. Equation 14
This is an expression that represents the controlled object.
There is a road curvature ρ in addition to a certain current i, and normal optimal control
It is not a structure that can be designed. A way to overcome this
Therefore, a stochastic optimal regulator design method is known,
System inputs other than control amount are driven by white noise
It is approximated by a first-order system and incorporated into the state quantity. FIG.
A linear approximation of the behavior of the road curvature ρ to equation 17 shown in FIG.
Here is the formula. Λ in equation 17ρAnd ωρShows how to determine variance
You. First, the behavior of the road curvature ρ is calculated with a constant amplitude ρ0.
Approximate by Poisson square wave with indeterminate period. For example,
The average of the curvature of the road to be determined is substituted for the amplitude ρ0. Road curvature
The change in ρ is uncertain, but how much crosses zero per second
Or approximation. Let the number of times be νρ. This pore
When the Son approximation is returned to the approximation of Expression 17, the relational expression of FIG.
8, 19). This gives λ ρAnd ωρDetermine variance
it can. Expression 17 is substituted into Expression 14, and Expression 20 in FIG. 20 is obtained.
You. This form is a form that applies optimal control. Less than
Later, the details of the optimal control design will be omitted, so the description is omitted.
【0075】コントローラ8の構成について、図12に
示す制御フローにより説明する。ステップ120では、
操舵角θと前方注視点横変位ysとアクチュエータ指令
電流iと道路曲率ρが読み込まれる。ステップ121で
は、オブザーバ84において、上記演算処理法に従って
状態量が演算される。ステップ122では、レギュレー
タ85において、上記演算処理法に従って指令電流が演
算される。ステップ123では、操舵アクチュエータで
あるモータ5に対し指令電流が出力される。The configuration of the controller 8 will be described with reference to the control flow shown in FIG. In step 120,
The steering angle θ, the forward gazing point lateral displacement ys, the actuator command current i, and the road curvature ρ are read. In step 121, the observer 84 calculates a state quantity in accordance with the above-described calculation processing method. In step 122, the command current is calculated in the regulator 85 according to the above-described calculation processing method. In step 123, a command current is output to the motor 5, which is a steering actuator.
【0076】このように、実施の形態7にあっては、オ
ブザーバ84によりステアリング機構に入力される外乱
トルクが推定され、外乱トルク補償部が、オブザーバ8
4により推定された外乱トルクを打ち消すレギュレータ
85内のフィードバック項とされるため、実施の形態1
と同様に、車線追従性を維持しつつ、操舵系を軽くする
ことができる。ただし、車線追従性を維持することに関
しては、ステアリング機構に入力される外乱トルクを打
ち消すフィードバック項がレギュレータ85内に存在す
るためである。また、ハンドルが軽くなる点について
は、実施の形態1の発明と同様の理由による。As described above, in the seventh embodiment, the disturbance torque input to the steering mechanism is estimated by the observer 84, and the disturbance torque compensating unit is provided by the observer 8
4 is used as a feedback term in the regulator 85 for canceling the disturbance torque estimated by the fourth embodiment.
Similarly, the steering system can be made lighter while maintaining the lane following ability. However, regarding maintaining the lane following ability, the feedback term for canceling the disturbance torque input to the steering mechanism exists in the regulator 85. Further, the point that the handle becomes lighter is for the same reason as the invention of the first embodiment.
【0077】(実施の形態8)(Embodiment 8)
【0078】請求項10記載の発明に対応する実施の形
態8について説明する。この実施の形態8は、車両シス
テムの全体構成については、図1及び図2に示す実施の
形態1と同様であるが、コントローラ8が、図13に示
すように、システムの入出力から内部の状態量を推定す
るオブザーバ84と、車両の状態量及び道路曲率に基づ
きアクチュエータ入力である制御指令最終値を算出する
レギュレータ85’と、オブザーバ84とレギュレータ
85’との間に設けられ、オブザーバ84からの出力の
1つである外乱トルク推定値の大きさを制限するリミッ
タ86により構成される。An eighth embodiment corresponding to the tenth aspect of the present invention will be described. In the eighth embodiment, the overall configuration of the vehicle system is the same as that of the first embodiment shown in FIG. 1 and FIG. 2, but the controller 8 performs the internal operation from the input / output of the system as shown in FIG. An observer 84 for estimating a state quantity, a regulator 85 ′ for calculating a control command final value that is an actuator input based on a state quantity of the vehicle and a road curvature, and a regulator 85 ′ provided between the observer 84 and the regulator 85 ′. And a limiter 86 for limiting the magnitude of the disturbance torque estimated value, which is one of the outputs of the above.
【0079】コントローラ8の構成について、図14に
示す制御フローにより説明する。ステップ140では、
操舵角θと前方注視点横変位ysとアクチュエータ指令
電流iと道路曲率ρが読み込まれる。ステップ141で
は、オブザーバ84において、上記演算処理法に従って
状態量が演算される。ステップ142では、リミッタ8
6において、操舵外乱Tdの絶対値がリミッタ値Td0を
超えないように制限される。つまり、Td>Td0または
Td<−Td0の時にはTd=Td0またはTd=−Td0と
される。ステップ143では、レギュレータ85におい
て、上記演算処理法に従って指令電流が演算される。な
お、レギュレータ85’の構成例を、図20の式21に
示す。ステップ144では、操舵アクチュエータである
モータ5に対し指令電流が出力される。The configuration of the controller 8 will be described with reference to the control flow shown in FIG. In step 140,
The steering angle θ, the forward gazing point lateral displacement ys, the actuator command current i, and the road curvature ρ are read. In step 141, the observer 84 calculates a state quantity in accordance with the above-described calculation processing method. In step 142, the limiter 8
In 6, the absolute value of the steering disturbance Td is limited so as not to exceed the limiter value Td0. That is, when Td> Td0 or Td <−Td0, Td = Td0 or Td = −Td0. In step 143, the command current is calculated in the regulator 85 in accordance with the above calculation method. An example of the configuration of the regulator 85 'is shown in Expression 21 in FIG. In step 144, a command current is output to the motor 5, which is a steering actuator.
【0080】このように、実施の形態8にあっては、オ
ブザーバ84によりステアリング機構に入力される外乱
トルクが推定され、外乱トルク補償部が、オブザーバ8
4により推定された外乱トルクを打ち消すレギュレータ
85’内のフィードバック項とされ、オブザーバ84か
らの出力の1つである外乱トルク推定値の大きさを制限
するリミッタ86を、オブザーバ84とレギュレータ8
5’との間に設けたため、実施の形態7と同様に、車線
追従性を維持しつつ、操舵系を軽くすることができる
し、加えて、操舵フリクションを補償しつつ、ドライバ
介入を容易にする制御系を構成することができる。As described above, in the eighth embodiment, the disturbance torque input to the steering mechanism is estimated by the observer 84, and the disturbance torque compensating unit operates by the observer 84.
4, a limiter 86 for limiting the magnitude of the disturbance torque estimated value, which is one of the outputs from the observer 84, is used as a feedback term in the regulator 85 'for canceling the disturbance torque estimated by the observer 84 and the regulator 8
5 ', the steering system can be lightened while maintaining the lane following ability, as in the seventh embodiment. In addition, driver intervention can be easily performed while compensating for steering friction. A control system can be configured.
【0081】すなわち、実施の形態8では、フィードバ
ック係数自体を小さい値に保つことにより、軽い操舵系
を実現できた。ただ、フィードバック係数がいくら小さ
くても、ドライバ介入がなされた場合、最終的には外乱
補償項が大きくなってしまい、介入を妨げる方向に作用
する。これは、ドライバ介入を操舵フリクションと同様
に外乱トルクとして推定してしまうためである。ただ
し、操舵フリクションはドライバ介入と異なり、所定値
以上にはならない。よって、オブザーバ84で外乱トル
ク推定が所定値以上となった場合は、ドライバ介入以外
にはあり得ない。そのため、外乱トルク補償にリミッタ
86を持たせることにより、操舵フリクションを補償し
つつ、ドライバ介入を容易にする制御系を構成すること
が可能となる。That is, in the eighth embodiment, a light steering system can be realized by keeping the feedback coefficient itself at a small value. However, no matter how small the feedback coefficient is, if driver intervention is performed, the disturbance compensation term eventually increases, which acts in a direction to hinder the intervention. This is because the driver intervention is estimated as a disturbance torque as in the case of the steering friction. However, unlike the driver intervention, the steering friction does not exceed a predetermined value. Therefore, when the disturbance torque estimation by the observer 84 becomes equal to or more than the predetermined value, there is no possibility other than the driver's intervention. Therefore, by providing the disturbance torque compensation with the limiter 86, it is possible to configure a control system that facilitates driver intervention while compensating for steering friction.
【0082】(他の実施の形態)(Other Embodiments)
【0083】以上、実施の形態1〜実施の形態8により
本発明を説明してきたが、具体的な構成はこれらの実施
の形態に限られるものではなく、下記の本発明の要旨を
逸脱しないものであれば本発明に含まれる。つまり、フ
ィードバック制御によりステアリング機構に設けられた
操舵アクチュエータへ制御指令を出力する操舵制御手段
に、ステアリング機構へ入力される外乱トルクを補償す
る外乱トルク補償部を設け、かつ、操舵制御手段のフィ
ードバック係数を、操舵外乱がないとの想定に基づき設
定する点を要旨とする。Although the present invention has been described with reference to the first to eighth embodiments, the specific structure is not limited to these embodiments and does not depart from the gist of the present invention described below. If so, it is included in the present invention. That is, the steering control means for outputting a control command to the steering actuator provided in the steering mechanism by the feedback control is provided with a disturbance torque compensator for compensating the disturbance torque inputted to the steering mechanism, and the feedback coefficient of the steering control means is provided. Is set based on the assumption that there is no steering disturbance.
【図1】実施の形態1における車線追従制御装置が適用
された車両を示す斜視図である。FIG. 1 is a perspective view showing a vehicle to which a lane tracking control device according to a first embodiment is applied.
【図2】実施の形態1における車線追従制御が行われる
操舵系を示す斜視図である。FIG. 2 is a perspective view showing a steering system in which lane following control according to the first embodiment is performed.
【図3】実施の形態1のコントローラを示す制御ブロッ
ク図である。FIG. 3 is a control block diagram illustrating a controller according to the first embodiment.
【図4】実施の形態1のオブザーバを示す制御ブロック
図である。FIG. 4 is a control block diagram illustrating an observer according to the first embodiment;
【図5】実施の形態1におけるコントローラの操舵フリ
クション補償部での制御フローを示す図である。FIG. 5 is a diagram showing a control flow in a steering friction compensation unit of the controller according to the first embodiment.
【図6】実施の形態2におけるコントローラの操舵フリ
クション補償部での制御フローを示す図である。FIG. 6 is a diagram showing a control flow in a steering friction compensation unit of a controller according to a second embodiment.
【図7】実施の形態3におけるコントローラの操舵フリ
クション補償部での制御フローを示す図である。FIG. 7 is a diagram showing a control flow in a steering friction compensation unit of a controller according to a third embodiment.
【図8】実施の形態4におけるコントローラの操舵フリ
クション補償部での制御フローを示す図である。FIG. 8 is a diagram illustrating a control flow in a steering friction compensation unit of a controller according to a fourth embodiment.
【図9】実施の形態5におけるコントローラの操舵フリ
クション補償部での制御フローを示す図である。FIG. 9 is a diagram illustrating a control flow in a steering friction compensation unit of a controller according to a fifth embodiment.
【図10】実施の形態6におけるコントローラの操舵フ
リクション補償部での制御フローを示す図である。FIG. 10 is a diagram illustrating a control flow in a steering friction compensation unit of a controller according to a sixth embodiment.
【図11】実施の形態7のコントローラを示す制御ブロ
ック図である。FIG. 11 is a control block diagram illustrating a controller according to a seventh embodiment.
【図12】実施の形態7におけるコントローラでの制御
フローを示す図である。FIG. 12 is a diagram showing a control flow in a controller according to the seventh embodiment.
【図13】実施の形態8のコントローラを示す制御ブロ
ック図である。FIG. 13 is a control block diagram illustrating a controller according to an eighth embodiment.
【図14】実施の形態8におけるコントローラでの制御
フローを示す図である。FIG. 14 is a diagram showing a control flow in a controller according to the eighth embodiment.
【図15】実施の形態1の説明で用いた式1を示す図で
ある。FIG. 15 is a diagram showing Expression 1 used in the description of the first embodiment.
【図16】実施の形態1の説明で用いた式2〜式5を示
す図である。FIG. 16 is a diagram showing Expressions 2 to 5 used in the description of the first embodiment.
【図17】実施の形態1の説明で用いた式6〜式9を示
す図である。FIG. 17 is a diagram showing Expressions 6 to 9 used in the description of the first embodiment.
【図18】実施の形態2の説明で用いた式10〜式13
を示す図である。FIG. 18 shows equations 10 to 13 used in the description of the second embodiment.
FIG.
【図19】実施の形態2の説明で用いた式14〜式16
を示す図である。FIG. 19 is a diagram showing Expressions 14 to 16 used in the description of the second embodiment.
FIG.
【図20】実施の形態2の説明で用いた式17〜式21
を示す図である。FIG. 20 is a diagram illustrating equations 17 to 21 used in the description of the second embodiment.
FIG.
1 ステアリングホイール 2 コラムシャフト 3 ステアリングギヤ 4 操舵アクチュエータ 5 モータ 6 電磁クラッチ 7 ベルト伝達機構 8 コントローラ(操舵制御手段) 9 ロータリエンコーダ9(操舵実際値検出手段) 10 CCDカメラ 11 車線認識装置 12 ヨーレイトセンサ 81 オブザーバ 82 レギュレータ 83 操舵フリクション補償部(外乱トルク補償部) Reference Signs List 1 steering wheel 2 column shaft 3 steering gear 4 steering actuator 5 motor 6 electromagnetic clutch 7 belt transmission mechanism 8 controller (steering control means) 9 rotary encoder 9 (actual steering value detection means) 10 CCD camera 11 lane recognition device 12 yaw rate sensor 81 Observer 82 Regulator 83 Steering friction compensator (disturbance torque compensator)
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.7 識別記号 FI テーマコート゛(参考) B62D 131:00 B62D 131:00 133:00 133:00 137:00 137:00 Fターム(参考) 3D032 CC20 DA03 DA09 DA23 DA29 DA33 DA50 DA64 DA84 DA88 DB01 DB11 DC31 DD02 DD17 EC23 EC34 GG01 3D033 CA12 CA13 CA17 CA19 CA20 CA21 ──────────────────────────────────────────────────続 き Continued on the front page (51) Int.Cl. 7 Identification symbol FI Theme court ゛ (Reference) B62D 131: 00 B62D 131: 00 133: 00 133: 00 137: 00 137: 00 F term (Reference) 3D032 CC20 DA03 DA09 DA23 DA29 DA33 DA50 DA64 DA84 DA88 DB01 DB11 DC31 DD02 DD17 EC23 EC34 GG01 3D033 CA12 CA13 CA17 CA19 CA20 CA21
Claims (10)
出する自車両相対位置検出手段と、 相対位置の検出に基づき、自車両を目標車線に誘導する
ための目標操舵角や目標操舵角速度等の操舵目標値を算
出する操舵目標値算出手段と、 実操舵角や実操舵角速度等の操舵実際値を検出する操舵
実際値検出手段と、 前輪もしくは後輪の少なくとも一方を操舵するステアリ
ング機構と、 前記操舵実際値を前記操舵目標値に一致させるフィード
バック制御により前記ステアリング機構に設けられた操
舵アクチュエータへ制御指令を出力する操舵制御手段と
を備えた車両の車線追従制御装置において、 前記操舵制御手段に、ステアリング機構へ入力される外
乱トルクを補償する外乱トルク補償部を設け、かつ、操
舵制御手段のフィードバック係数を、操舵外乱がないと
の想定に基づき設定したことを特徴とする車両の車線追
従制御装置。1. A vehicle relative position detecting means for detecting a relative position of the vehicle relative to a target lane, and a target steering angle, a target steering angular velocity, and the like for guiding the vehicle to the target lane based on the detection of the relative position. Steering target value calculating means for calculating a steering target value; steering actual value detecting means for detecting a steering actual value such as an actual steering angle or an actual steering angular velocity; a steering mechanism for steering at least one of a front wheel or a rear wheel; A steering control unit that outputs a control command to a steering actuator provided in the steering mechanism by feedback control that matches a steering actual value with the steering target value. Providing a disturbance torque compensator for compensating disturbance torque input to the steering mechanism, and a feedback coefficient of the steering control means, Kajigairan lane keeping control device for a vehicle, characterized in that set on the basis of the assumption that there is no.
において、 前記外乱トルク補償部を、操舵方向と同じ方向で、大き
さが一定の操舵フリクション想定値に基づく制御指令を
算出する操舵フリクション補償部とし、 前記操舵制御手段を、システムの入出力から車両の状態
量を推定するオブザーバと、車両の状態量に基づき補償
前のフィードバック制御指令を算出するレギュレータ
と、前記操舵フリクション補償部により構成し、操舵フ
リクションを想定しないで算出されたフィードバック制
御指令に、操舵フリクション想定値に基づく制御指令を
加えて制御指令最終値とする手段としたことを特徴とす
る車両の車線追従制御装置。2. The steering friction according to claim 1, wherein the disturbance torque compensator calculates a control command based on an assumed steering friction value having a constant magnitude in the same direction as the steering direction. A compensator, wherein the steering control means comprises an observer for estimating a state quantity of the vehicle from input and output of a system, a regulator for calculating a feedback control command before compensation based on the state quantity of the vehicle, and the steering friction compensator. A vehicle lane following control device characterized in that a means for adding a control command based on an assumed steering friction value to a feedback control command calculated without assuming the steering friction to obtain a final control command value.
において、 前記操舵フリクション補償部を、車線追従制御による走
行中に車両に蛇行が発生した場合、前記操舵フリクショ
ン想定値を大きくする補正を行い、補正後の操舵フリク
ション想定値に基づく制御指令を算出する補償部とした
ことを特徴とする車両の車線追従制御装置。3. The vehicle lane following control device according to claim 2, wherein the steering friction compensator is configured to perform a correction to increase the assumed steering friction value when the vehicle is meandering while traveling by the lane following control. A lane following control device for a vehicle, wherein the compensating unit calculates a control command based on an assumed steering friction value after correction.
において、 ヨーレイト検出手段により検出されるヨーレイトの符号
の変化周期が設定値以上の場合、車両の蛇行と判断する
第1蛇行判断手段を設けたことを特徴とする車両の車線
追従制御装置。4. The vehicle lane following control device according to claim 3, wherein the first meandering determining means for determining that the vehicle meanders when the changing period of the sign of the yaw rate detected by the yaw rate detecting means is equal to or greater than a set value. A lane tracking control device for a vehicle, comprising:
において、 ヨーレイトの変化によって引き起こされる他の物理量の
変化を検出した場合、車両の蛇行と判断する第2蛇行判
断手段を設けたことを特徴とする車両の車線追従制御装
置。5. The vehicle lane following control device according to claim 3, further comprising a second meandering determining means for determining that the vehicle meanders when a change in another physical quantity caused by a change in the yaw rate is detected. Characteristic vehicle lane following control device.
において、 前記操舵フリクション補償部を、車線追従制御による走
行中に操舵角のハンチングが発生した場合、前記操舵フ
リクション想定値を小さくする補正を行い、補正後の操
舵フリクション想定値に基づく制御指令を算出する補償
部としたことを特徴とする車両の車線追従制御装置。6. The vehicle lane following control device according to claim 2, wherein the steering friction compensator is configured to reduce the assumed value of the steering friction when hunting of a steering angle occurs during traveling by the lane following control. And a compensating unit that calculates a control command based on the corrected steering friction assumption value after correction.
において、 操舵角速度の絶対値の時間平均が大きいことをもって操
舵角のハンチングと判断する操舵ハンチング判断手段を
設けたことを特徴とする車両の車線追従制御装置。7. The vehicle lane following control device according to claim 6, further comprising a steering hunting determining means for determining that the steering angle is hunting when the time average of the absolute value of the steering angular velocity is large. Lane tracking control device.
において、 前記外乱トルク補償部を、前段のフィードバック制御指
令方向と同じ方向で、大きさが一定の操舵フリクション
想定値に基づく制御指令を算出する操舵フリクション補
償部とし、 前記操舵制御手段を、システムの入出力から車両の状態
量を推定するオブザーバと、車両の状態量に基づき補償
前のフィードバック制御指令を算出するレギュレータ
と、前記操舵フリクション補償部により構成し、操舵フ
リクションを想定しないで算出されたフィードバック制
御指令に、操舵フリクション想定値に基づく制御指令を
加えて制御指令最終値とする手段としたことを特徴とす
る車両の車線追従制御装置。8. The vehicle lane following control device according to claim 1, wherein the disturbance torque compensating unit is configured to transmit a control command based on an assumed steering friction value having a constant magnitude in the same direction as the preceding feedback control command direction. A steering friction compensating unit for calculating the steering control means, an observer for estimating a state quantity of the vehicle from input / output of a system, a regulator for calculating a feedback control command before compensation based on the state quantity of the vehicle, and the steering friction. The lane following control of a vehicle, comprising a compensating unit and a means for adding a control command based on an assumed steering friction value to a feedback control command calculated without assuming steering friction to obtain a final control command value. apparatus.
において、 前記操舵制御手段を、システムの入出力から車両の状態
量を推定するオブザーバと、車両の状態量に基づきアク
チュエータ入力である制御指令最終値を算出するレギュ
レータにより構成し、 前記オブザーバによりステアリング機構に入力される外
乱トルクを推定し、 前記外乱トルク補償部を、オブザーバにより推定された
外乱トルクを打ち消すレギュレータ内のフィードバック
項とする手段としたことを特徴とする車両の車線追従制
御装置。9. The vehicle lane following control device according to claim 1, wherein the steering control means is an observer for estimating a state quantity of the vehicle from input / output of a system, and an actuator input based on the state quantity of the vehicle. A means for calculating a command final value, a means for estimating disturbance torque input to a steering mechanism by the observer, and a means for making the disturbance torque compensator a feedback term in the regulator for canceling the disturbance torque estimated by the observer. A lane-following control device for a vehicle.
置において、 前記オブザーバからの出力の1つである外乱トルク推定
値の大きさを制限するリミッタを、オブザーバとレギュ
レータとの間に設けたことを特徴とする車両の車線追従
制御装置。10. The vehicle lane following control device according to claim 9, wherein a limiter for limiting a magnitude of a disturbance torque estimated value, which is one of outputs from the observer, is provided between the observer and the regulator. A lane following control device for a vehicle.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000212628A JP2002029437A (en) | 2000-07-13 | 2000-07-13 | Lane follow-up control device for vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2000212628A JP2002029437A (en) | 2000-07-13 | 2000-07-13 | Lane follow-up control device for vehicle |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2002029437A true JP2002029437A (en) | 2002-01-29 |
Family
ID=18708524
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2000212628A Pending JP2002029437A (en) | 2000-07-13 | 2000-07-13 | Lane follow-up control device for vehicle |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2002029437A (en) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005125853A (en) * | 2003-10-22 | 2005-05-19 | Aisin Seiki Co Ltd | Lane travel support device for vehicle |
JP2010143397A (en) * | 2008-12-18 | 2010-07-01 | Nissan Motor Co Ltd | Vehicle suspension device, electric motor control method, and actuator control device |
JP2010188854A (en) * | 2009-02-18 | 2010-09-02 | Nissan Motor Co Ltd | Lane maintenance assisting device and lane maintenance assisting method |
US9796410B2 (en) | 2016-01-28 | 2017-10-24 | Denso Corporation | Motor controller |
CN109291991A (en) * | 2018-12-01 | 2019-02-01 | 南京天航智能装备研究院有限公司 | A kind of bi-motor line traffic control composite turning system and its control method |
JP2019182292A (en) * | 2018-04-13 | 2019-10-24 | 三菱電機株式会社 | Vehicle steering control amount determination device, vehicle steering control amount determination method, vehicle steering control device, and vehicle steering control method |
WO2019225289A1 (en) * | 2018-05-21 | 2019-11-28 | 株式会社ジェイテクト | Motor control device |
JP2020144886A (en) * | 2013-03-25 | 2020-09-10 | Case特許株式会社 | vehicle |
-
2000
- 2000-07-13 JP JP2000212628A patent/JP2002029437A/en active Pending
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005125853A (en) * | 2003-10-22 | 2005-05-19 | Aisin Seiki Co Ltd | Lane travel support device for vehicle |
JP2010143397A (en) * | 2008-12-18 | 2010-07-01 | Nissan Motor Co Ltd | Vehicle suspension device, electric motor control method, and actuator control device |
JP2010188854A (en) * | 2009-02-18 | 2010-09-02 | Nissan Motor Co Ltd | Lane maintenance assisting device and lane maintenance assisting method |
JP2020144886A (en) * | 2013-03-25 | 2020-09-10 | Case特許株式会社 | vehicle |
US9796410B2 (en) | 2016-01-28 | 2017-10-24 | Denso Corporation | Motor controller |
JP2019182292A (en) * | 2018-04-13 | 2019-10-24 | 三菱電機株式会社 | Vehicle steering control amount determination device, vehicle steering control amount determination method, vehicle steering control device, and vehicle steering control method |
WO2019225289A1 (en) * | 2018-05-21 | 2019-11-28 | 株式会社ジェイテクト | Motor control device |
CN112154092A (en) * | 2018-05-21 | 2020-12-29 | 株式会社捷太格特 | Motor control device |
JPWO2019225289A1 (en) * | 2018-05-21 | 2021-05-27 | 株式会社ジェイテクト | Motor control device |
JP7194340B2 (en) | 2018-05-21 | 2022-12-22 | 株式会社ジェイテクト | motor controller |
CN112154092B (en) * | 2018-05-21 | 2023-01-17 | 株式会社捷太格特 | Motor control device |
US11685430B2 (en) | 2018-05-21 | 2023-06-27 | Jtekt Corporation | Motor control device |
CN109291991A (en) * | 2018-12-01 | 2019-02-01 | 南京天航智能装备研究院有限公司 | A kind of bi-motor line traffic control composite turning system and its control method |
CN109291991B (en) * | 2018-12-01 | 2023-10-24 | 南京天航智能装备研究院有限公司 | Dual-motor drive-by-wire composite steering system and control method thereof |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6778890B2 (en) | Lane-keeping control with steering torque as a control input to a vehicle steering system | |
US9919733B2 (en) | Electric power steering apparatus | |
US9669866B2 (en) | Steering intention determination device, vehicle control device, steering assist device, and steering assist system | |
US20180304918A1 (en) | Automatic driving system | |
US11305815B2 (en) | Disturbance feedforward control in cascade regulation | |
JP7028115B2 (en) | Vehicle steering support device | |
JP2010188854A (en) | Lane maintenance assisting device and lane maintenance assisting method | |
JP5386873B2 (en) | Vehicle steering apparatus and vehicle steering method | |
Shimakage et al. | Design of lane-keeping control with steering torque input | |
JP5525357B2 (en) | Servo control device | |
JP2002029437A (en) | Lane follow-up control device for vehicle | |
CN110576898B (en) | Motor vehicle steering control system and steering control method | |
JP3785967B2 (en) | Lane tracking control device | |
KR102621533B1 (en) | Apparatus and method for controlling steering system of vehicle | |
JP4134683B2 (en) | Automatic steering device | |
JP2003175853A (en) | Steering controller | |
CN116888025A (en) | Control circuit for motor vehicle | |
CN113311698A (en) | Lane keeping control method, control device and vehicle | |
JP2940371B2 (en) | Auxiliary steering angle control device for vehicles | |
JP3180704B2 (en) | Steering device | |
JPH0725318B2 (en) | Actual steering angle control device for vehicle | |
JP2002029438A (en) | Lane follow-up control device for vehicle | |
JP2003048564A (en) | Vehicular steering control system | |
JP2003026023A (en) | Lane following travel control device | |
CN109774711B (en) | Vehicle transverse control system capable of weight-modulating lane model and method thereof |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20041122 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20050830 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20051116 |