JP2002308129A - Lane follow-up running control device - Google Patents

Lane follow-up running control device

Info

Publication number
JP2002308129A
JP2002308129A JP2001112119A JP2001112119A JP2002308129A JP 2002308129 A JP2002308129 A JP 2002308129A JP 2001112119 A JP2001112119 A JP 2001112119A JP 2001112119 A JP2001112119 A JP 2001112119A JP 2002308129 A JP2002308129 A JP 2002308129A
Authority
JP
Japan
Prior art keywords
supply current
lane
steering torque
traveling
limit value
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
JP2001112119A
Other languages
Japanese (ja)
Other versions
JP3709806B2 (en
Inventor
Masayasu Shimakage
正康 島影
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2001112119A priority Critical patent/JP3709806B2/en
Publication of JP2002308129A publication Critical patent/JP2002308129A/en
Application granted granted Critical
Publication of JP3709806B2 publication Critical patent/JP3709806B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

PROBLEM TO BE SOLVED: To restrain and check a sudden change of steering torque in the case of fail during turning. SOLUTION: A radius of curvature ρ of a running lane is obtained from image information on the front of own vehicle imaged by a camera, and in a turning circuit where the radius of curvature ρis a designated value or less, a supply current limit value iL to a motor generating steering assist torque is set to a small designated value, and the motor supply current iM is made asymptotic to the set value. Although a driver has to give steering torque him/ herself to compensate for short steering torque, a sudden change of steering torque in fail can be restrained and prevented. The radius of curvature of the running lane can be calculated from the lateral acceleration, whereby when the camera is lost, the control is conducted by using the estimated radius of curvature.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、走行車線を検出
し、これに追従して走行する車線追従走行制御装置に関
するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a lane-following traveling control device that detects a traveling lane and travels following the detected lane.

【0002】[0002]

【従来の技術】従来の車線追従走行制御装置としては、
例えば特開平7−104850号公報に記載されたもの
が知られている。この従来例では、ビデオ・カメラ等で
道路上の白線等の車線マークを検出し、信号プロセッサ
で車線マークに対する車両の側方位置を推定し、さらに
車両の向きを検出し、これらに基づいて操舵角要求を演
算し、この操舵角要求と操舵角検出値との偏差に制御ゲ
インを乗算してからリミッタで制限され、さらに旋回率
制限されて操舵機構に結合された電動モータに供給する
ことにより、電動モータで制御トルクを発生する一方、
運転者からの操舵トルクを補助するかあるいはこれに対
抗するトルク入力を操舵機構に与え、運転者が印加した
操舵トルクが予め定めたトルク閾値を越えるときに電動
モータによるトルク入力を打ち消すようにした車両用運
転者補助システムが記載されている。
2. Description of the Related Art Conventional lane-following traveling control devices include:
For example, one described in JP-A-7-104850 is known. In this conventional example, a lane mark such as a white line on a road is detected by a video camera or the like, a side position of the vehicle with respect to the lane mark is estimated by a signal processor, the direction of the vehicle is detected, and steering is performed based on these. By calculating the angle request and multiplying the deviation between the steering angle request and the detected steering angle value by the control gain, the difference is limited by the limiter, and further, the turning rate is limited and supplied to the electric motor coupled to the steering mechanism. , While generating control torque with an electric motor,
The steering mechanism is provided with a torque input that assists or opposes the steering torque from the driver, and cancels the torque input by the electric motor when the steering torque applied by the driver exceeds a predetermined torque threshold. A driver assistance system for a vehicle is described.

【0003】[0003]

【発明が解決しようとする課題】ところで、前記従来の
車線追従走行制御装置において、システムにフェイルが
発生すると、操舵アシストトルクを発生していたモータ
への供給電流が停止されるため、操舵トルクが大きく変
化する恐れがある。そこで、車両に発生する横加速度を
検出し、その横加速度が大きいときには、操舵アシスト
トルクを発生するモータへの供給電流を小さく制限する
ことが考えられる。
In the above-described conventional lane-following traveling control device, when a failure occurs in the system, the supply current to the motor that generated the steering assist torque is stopped. There is a risk of significant change. Therefore, it is conceivable to detect the lateral acceleration generated in the vehicle and, when the lateral acceleration is large, restrict the current supplied to the motor that generates the steering assist torque to a small value.

【0004】しかしながら、横加速度は、必ずしも旋回
走行中にのみ発生するものではなく、例えば横風や路面
の轍等によっても発生するため、或る程度大きな横加速
度に対しても操舵アシストトルクが発生するようにモー
タへの供給電流の制限値は大きく設定されている。その
ため、旋回走行中にモータに供給される供給電流は、実
質的に最大値又は最大値近傍となり、フェイル時の操舵
トルクの急変は避けられないという実状がある。
However, the lateral acceleration is not necessarily generated only during turning, but is also generated due to, for example, a cross wind or a rut on a road surface. Therefore, a steering assist torque is generated even for a certain large lateral acceleration. As described above, the limit value of the supply current to the motor is set to be large. Therefore, the supply current supplied to the motor during the turning travel substantially reaches the maximum value or near the maximum value, and a sudden change in the steering torque at the time of failure is inevitable.

【0005】本発明は、これらの諸問題を解決すべく開
発されたものであり、旋回走行中のフェイル時に操舵ト
ルクが急変しない車線追従走行制御装置を提供すること
を目的とするものである。
The present invention has been developed to solve these problems, and an object of the present invention is to provide a lane-following traveling control device in which the steering torque does not change suddenly during a failure during turning.

【0006】[0006]

【課題を解決するための手段】上記目的を達成するため
に、本発明のうち請求項1に係る車線追従走行制御装置
は、操舵角を検出する操舵角検出手段と、自車両の前方
の道路画像を検出する画像情報検出手段と、前記画像情
報検出手段で検出された自車両前方の道路画像から、少
なくとも走行車線の曲率半径を含む走行車線情報を検出
する走行車線情報検出手段と、供給電流に応じた操舵ト
ルクを発生させる操舵トルク発生手段と、走行車線に追
従するために必要な操舵トルクを前記操舵トルク発生手
段で発生させる供給電流を出力する操舵トルク制御手段
とを備え、前記操舵トルク制御手段は、少なくとも前記
走行車線情報検出手段で検出された走行車線情報及び前
記操舵角検出手段で検出された操舵角に基づいて、前記
走行車線に追従するために必要な操舵トルクを前記操舵
トルク発生手段で発生させる供給電流を算出する供給電
流算出手段と、前記走行車線情報検出手段で検出された
走行車線の曲率半径に基づいて前記操舵トルク発生手段
への供給電流の制限値を設定する供給電流制限値設定手
段とを備えたことを特徴とするものである。
In order to achieve the above object, according to the present invention, there is provided a lane-following traveling control device, comprising: a steering angle detecting means for detecting a steering angle; Image information detecting means for detecting an image; traveling lane information detecting means for detecting traveling lane information including at least the radius of curvature of the traveling lane from a road image ahead of the vehicle detected by the image information detecting means; Steering torque generating means for generating a steering torque according to the steering torque, and steering torque control means for outputting a supply current for generating a steering torque required to follow a traveling lane by the steering torque generating means, the steering torque The control means follows the travel lane based on at least the travel lane information detected by the travel lane information detection means and the steering angle detected by the steering angle detection means. Supply current calculation means for calculating a supply current for generating the steering torque required for the steering torque generation means, and the steering torque generation means based on the radius of curvature of the traveling lane detected by the traveling lane information detection means. And a supply current limit value setting means for setting the supply current limit value.

【0007】また、本発明のうち請求項2に係る車線追
従走行制御装置は、前記請求項1の発明において、前記
供給電流制限値設定手段は、前記走行車線情報検出手段
で検出された走行車線の曲率半径が小さいとき、供給電
流の制限値を小さく設定することを特徴とするものであ
る。また、本発明のうち請求項3に係る車線追従走行制
御装置は、前記請求項2の発明において、前記操舵トル
ク制御手段は、前記供給電流算出手段で算出された供給
電流を、前記供給電流制限値設定手段で設定された供給
電流の制限値に次第に近づけて前記操舵トルク発生手段
への供給電流とする供給電流漸近手段を備え、当該供給
電流漸近手段は、供給電流を減少するときの変化率と当
該供給電流を増大するときの変化率とを個別の調整可能
とし、且つ供給電流を減少するときの変化率を増大する
ときの変化率よりも大きく設定することを特徴とするも
のである。
According to a second aspect of the present invention, there is provided a lane-following traveling control device according to the first aspect, wherein the supply current limit value setting means includes a traveling lane detected by the traveling lane information detecting means. When the radius of curvature is small, the limit value of the supply current is set small. According to a third aspect of the present invention, there is provided a lane-following traveling control device according to the second aspect, wherein the steering torque control means restricts the supply current calculated by the supply current calculation means to the supply current limit. Supply current asymptotic means for gradually increasing the supply current to the steering torque generating means by gradually approaching the supply current limit value set by the value setting means, wherein the supply current asymptotic means changes the supply current when decreasing the supply current. And the rate of change when the supply current is increased can be individually adjusted, and the rate of change when the supply current is decreased is set to be larger than the rate of change when the supply current is increased.

【0008】また、本発明のうち請求項4に係る車線追
従走行制御装置は、前記請求項3の発明において、自車
両の走行速度を検出する車速検出手段を備え、前記供給
電流漸近手段は、前記車速検出手段で検出された自車両
の走行速度が大きいとき、供給電流を減少するとき及び
増加するときの変化率を大きくすることを特徴とするも
のである。
According to a fourth aspect of the present invention, a lane-following traveling control device according to the third aspect of the present invention further comprises a vehicle speed detecting means for detecting a traveling speed of the own vehicle, and the supply current asymptotic means comprises: When the traveling speed of the own vehicle detected by the vehicle speed detecting means is high, when the supply current is reduced and when the supply current is increased, the rate of change is increased.

【0009】また、本発明のうち請求項5に係る車線追
従走行制御装置は、前記請求項1乃至4の発明におい
て、前記供給電流制限値設定手段は、前記走行車線情報
検出手段が走行車線を検出できなくなったときに前記供
給電流の制限値を保持することを特徴とするものであ
る。また、本発明のうち請求項6に係る車線追従走行制
御装置は、前記請求項1乃至5の発明において、自車両
に発生する横加速度を検出する横加速度検出手段を備え
ると共に、前記操舵トルク制御手段は、少なくとも前記
横加速度検出手段で検出された横加速度から走行車線の
曲率半径を算出する曲率半径算出手段を備え、前記供給
電流制限値設定手段は、前記走行車線情報検出手段が走
行車線を検出できなくなったときに前記曲率半径算出手
段で算出された走行車線の曲率半径に基づいて供給電流
の制限値を設定することを特徴とするものである。
According to a fifth aspect of the present invention, there is provided a lane-following traveling control device according to any one of the first to fourth inventions, wherein the supply current limit value setting means is arranged so that the traveling lane information detecting means determines the traveling lane. When the detection becomes impossible, the supply current limit value is held. According to a sixth aspect of the present invention, there is provided a lane-following traveling control device according to the first to fifth aspects, further comprising a lateral acceleration detecting means for detecting a lateral acceleration generated in the own vehicle, and controlling the steering torque control. The means includes a radius of curvature calculating means for calculating a radius of curvature of a traveling lane from at least the lateral acceleration detected by the lateral acceleration detecting means, and the supply current limit value setting means includes a step in which the traveling lane information detecting means determines a traveling lane. When the detection becomes impossible, a limit value of the supply current is set based on the curvature radius of the traveling lane calculated by the curvature radius calculation means.

【0010】また、本発明のうち請求項7に係る車線追
従走行制御装置は、前記請求項6の発明において、前記
曲率半径算出手段は、前記走行車線情報検出手段が走行
車線を検出しているときに、前記横加速度検出手段で検
出された横加速度から算出した走行車線の曲率半径と検
出された走行車線の曲率半径との誤差を算出することを
特徴とするものである。
According to a seventh aspect of the present invention, there is provided a lane-following traveling control device according to the sixth aspect of the present invention, wherein the curvature radius calculating means is configured such that the traveling lane information detecting means detects a traveling lane. An error between the curvature radius of the travel lane calculated from the lateral acceleration detected by the lateral acceleration detection means and the curvature radius of the travel lane detected is calculated.

【0011】また、本発明のうち請求項8に係る車線追
従走行制御装置は、前記請求項6又は7の発明におい
て、自車両の走行速度を検出する車速検出手段を備える
と共に、前記曲率半径算出手段は、前記横加速度検出手
段で検出された横加速度をローパスフィルタ処理するロ
ーパスフィルタを備えると共に、前記車速検出手段で検
出された自車両の走行速度が小さいほど、前記ローパス
フィルタのカットオフ周波数を小さく設定することを特
徴とするものである。
The lane-following traveling control device according to claim 8 of the present invention is the vehicle according to claim 6 or 7, further comprising a vehicle speed detecting means for detecting a traveling speed of the host vehicle, and calculating the curvature radius. The means includes a low-pass filter that performs a low-pass filter process on the lateral acceleration detected by the lateral acceleration detection means, and the cutoff frequency of the low-pass filter decreases as the traveling speed of the vehicle detected by the vehicle speed detection means decreases. It is characterized in that it is set small.

【0012】また、本発明のうち請求項9に係る車線追
従走行制御装置は、前記請求項1乃至8の発明におい
て、前記走行車線情報検出手段は、自車両の走行車線に
対する横変位を検出する横変位検出手段を備えると共
に、前記操舵トルク制御手段は、前記横変位検出手段で
検出された自車両の走行車線に対する横変位が所定値以
上となったときに走行車線追従走行が逸脱したと判定す
る逸脱判定手段を備え、当該逸脱判定手段は、前記供給
電流制限値設定手段が小さな制限値を設定し、操舵トル
ク発生手段への供給電流が小さく制限されているとき
に、前記走行車線追従走行の逸脱を判定する横変位の所
定値を小さく設定することを特徴とするものである。
According to a ninth aspect of the present invention, there is provided a lane-following traveling control device according to the first to eighth aspects, wherein the traveling lane information detecting means detects a lateral displacement of the own vehicle with respect to the traveling lane. A lateral displacement detecting means is provided, and the steering torque control means determines that the traveling lane-following traveling has deviated when the lateral displacement of the own vehicle with respect to the traveling lane detected by the lateral displacement detecting means becomes a predetermined value or more. A deviation determining unit that performs the traveling lane-following traveling when the supply current limit value setting unit sets a small limit value and the supply current to the steering torque generating unit is limited to a small value. The predetermined value of the lateral displacement for judging the deviation from is set to a small value.

【0013】また、本発明のうち請求項10に係る車線
追従走行制御装置は、前記請求項1乃至9の発明におい
て、前記操舵トルク制御手段は、前記供給電流制限値設
定手段が小さな制限値を設定し、操舵トルク発生手段へ
の供給電流が小さく制限されているときに、操舵トルク
の変動を与える操舵トルク変動付加手段を備えることを
特徴とするものである。
According to a tenth aspect of the present invention, there is provided a lane-following traveling control apparatus according to the first to ninth aspects, wherein the steering torque control means sets the supply current limit value setting means to a small limit value. When the current supplied to the steering torque generating means is limited to a small value, a steering torque fluctuation adding means for changing the steering torque is provided.

【0014】[0014]

【発明の効果】而して、本発明のうち請求項1に係る車
線追従走行制御装置によれば、検出された走行車線情報
及び操舵角に基づいて、走行車線に追従するために必要
な操舵トルクを発生させる供給電流を算出すると共に、
検出された走行車線の曲率半径に基づいて供給電流の制
限値を設定する構成としたため、本来、操舵トルクの大
きい曲率半径の小さい走行車線で供給電流の制限値を小
さくすれば、フェイル時の操舵トルクの急変を抑制防止
することができる。
According to the lane-following travel control device according to the first aspect of the present invention, the steering required for following the travel lane based on the detected travel lane information and the steering angle. Calculate the supply current that generates the torque,
Since the configuration is such that the supply current limit value is set based on the detected radius of curvature of the traveling lane, if the supply current limit value is originally reduced in a traveling lane with a large steering torque and a small radius of curvature, steering during a failure A sudden change in torque can be suppressed and prevented.

【0015】また、本発明のうち請求項2に係る車線追
従走行制御装置によれば、検出された走行車線の曲率半
径が小さいとき、供給電流の制限値を小さく設定する構
成としたため、フェイル時の操舵トルクの急変を抑制防
止することができる。また、本発明のうち請求項3に係
る車線追従走行制御装置によれば、算出された供給電流
を制限値に次第に近づけると共に、供給電流を減少する
ときの変化率と当該供給電流を増大するときの変化率と
を個別の調整可能とし、且つ供給電流を減少するときの
変化率を増大するときの変化率よりも大きく設定する構
成としたため、曲率半径の小さい走行車線への進入時に
供給電流を速やかに減少してフェイル時の操舵トルクの
急変に備えることができると共に、旋回が交互に繰り返
される走行車線での操舵トルクの変動を抑制防止するこ
とができる。
According to the lane-following traveling control apparatus of the present invention, when the radius of curvature of the detected lane is small, the limit value of the supply current is set to be small. Sudden change in the steering torque of the vehicle can be prevented. According to the lane-following traveling control device according to claim 3 of the present invention, the calculated supply current gradually approaches the limit value, and the rate of change when the supply current decreases and the supply current increases. And the rate of change are individually adjustable, and the rate of change when the supply current is decreased is set to be larger than the rate of change when the supply current is increased. It is possible to rapidly reduce the steering torque and prepare for a sudden change in the steering torque at the time of a failure, and it is possible to prevent or suppress the fluctuation of the steering torque in the traveling lane where the turning is repeated alternately.

【0016】また、本発明のうち請求項4に係る車線追
従走行制御装置によれば、検出された自車両の走行速度
が大きいとき、供給電流を減少するとき及び増加すると
きの変化率を大きくする構成としたため、供給電流の変
化に要する距離を一定又はほぼ一定にすることが可能と
なり、これにより一定の場所では、自車両の走行速度に
関わらず、一定の位置で供給電流の値を同等又はほぼ同
等とすることができる。
Further, according to the lane-following traveling control device of the present invention, when the detected traveling speed of the own vehicle is high, when the supply current is decreased and when the supplied current is increased, the rate of change is increased. This makes it possible to keep the distance required for the change of the supply current constant or almost constant, so that in a certain place, the supply current value is equal at a certain position regardless of the running speed of the host vehicle. Or it can be made substantially equivalent.

【0017】また、本発明のうち請求項5に係る車線追
従走行制御装置によれば、走行車線を検出できなくなっ
たときに供給電流の制限値を保持する構成としたため、
走行車線を再び検出したときの操舵トルクの変動を抑制
防止することができる。また、本発明のうち請求項6に
係る車線追従走行制御装置によれば、検出された横加速
度から走行車線の曲率半径を算出すると共に、走行車線
を検出できなくなったときには算出された走行車線の曲
率半径に基づいて供給電流の制限値を設定する構成とし
たため、走行車線を検出できないときもフェイル時の操
舵トルクの急変を抑制防止することが可能となる。
Further, according to the lane-following traveling control device of the present invention, when the traveling lane cannot be detected, the supply current limit value is held.
Variations in steering torque when the traveling lane is detected again can be prevented. According to the lane-following travel control device according to claim 6 of the present invention, the curvature radius of the travel lane is calculated from the detected lateral acceleration, and the travel lane calculated when the travel lane cannot be detected. Because the supply current limit value is set based on the radius of curvature, it is possible to prevent a sudden change in the steering torque at the time of a failure even when the traveling lane cannot be detected.

【0018】また、本発明のうち請求項7に係る車線追
従走行制御装置によれば、走行車線を検出しているとき
に、検出された横加速度から算出した走行車線の曲率半
径と検出された走行車線の曲率半径との誤差を算出する
構成としたため、走行車線を検出できなくなったときの
走行車線の曲率半径をより正確に算出することが可能と
なり、走行車線を検出できないときのフェイル時の操舵
トルクの急変をより一層確実に抑制防止することができ
る。
According to the lane-following travel control device of the present invention, when the travel lane is detected, the curvature radius of the travel lane calculated from the detected lateral acceleration is detected. Because it is configured to calculate the error from the radius of curvature of the traveling lane, it is possible to more accurately calculate the radius of curvature of the traveling lane when the traveling lane can no longer be detected, and it is possible to calculate the failure radius when the traveling lane cannot be detected. A sudden change in the steering torque can be more reliably suppressed and prevented.

【0019】また、本発明のうち請求項8に係る車線追
従走行制御装置によれば、検出された横加速度をローパ
スフィルタ処理するローパスフィルタを備えると共に、
検出された自車両の走行速度が小さいほど、ローパスフ
ィルタのカットオフ周波数を小さく設定する構成とした
ため、運転者による操舵の自由度が高い低速走行時によ
り低周波側の横加速度を抽出し、その横加速度に基づい
て走行車線の曲率半径の算出精度を高めることができ
る。
Further, according to the lane-following traveling control device of the present invention, a low-pass filter for low-pass filtering the detected lateral acceleration is provided.
Since the cutoff frequency of the low-pass filter is set to be smaller as the detected traveling speed of the host vehicle is lower, the lateral acceleration on the low frequency side is extracted during low-speed traveling when the degree of freedom of steering by the driver is high. The calculation accuracy of the radius of curvature of the traveling lane can be improved based on the lateral acceleration.

【0020】また、本発明のうち請求項9に係る車線追
従走行制御装置によれば、検出された自車両の走行車線
に対する横変位が所定値以上となったときに走行車線追
従走行が逸脱したと判定すると共に、供給電流に対して
小さな制限値が設定され、供給電流が小さく制限されて
いるときに、走行車線追従走行の逸脱を判定する横変位
の所定値を小さく設定する構成としたため、操舵トルク
が不足して走行車線追従走行が逸脱することを運転者に
早期に認識させることができ、これにより運転者による
積極的な操舵トルクを期待することができる。
According to the lane-following traveling control device of the ninth aspect of the present invention, the traveling lane-following traveling deviates when the detected lateral displacement of the host vehicle with respect to the traveling lane becomes a predetermined value or more. And a small limit value is set for the supply current, and when the supply current is limited to a small value, the predetermined value of the lateral displacement for determining the deviation of the traveling lane following travel is set to be small. It is possible to make the driver recognize early that the steering lane departs due to the lack of the steering torque, and thus the driver can expect a positive steering torque.

【0021】また、本発明のうち請求項10に係る車線
追従走行制御装置によれば、供給電流に対して小さな制
限値が設定され、供給電流が小さく制限されているとき
に、操舵トルクの変動を与える構成としたため、運転者
は操舵トルクが不足していることを早期に認識すること
ができ、これにより運転者による積極的な操舵トルクを
期待することができる。
According to the lane-following traveling control device of the present invention, when the supply current is set to a small limit value and the supply current is limited to a small value, the fluctuation of the steering torque can be reduced. Is provided, the driver can recognize at an early stage that the steering torque is insufficient, so that a positive steering torque by the driver can be expected.

【0022】[0022]

【発明の実施の形態】以下、本発明の実施の形態を図面
を伴って説明する。図1は、本発明の第1の実施形態を
示す概略構成図であり、図1bにおいて、1FL,1F
Rは前輪、1RL及び1RRは後輪を示し、前輪1F
L,1FRには一般的なラックアンドピニオン式の操舵
機構が配設されている。この操舵機構は、前輪1FL,
1FRの操舵軸(タイロッド)に接続されるラック2
と、これに噛合するピニオン3と、このピニオン3をス
テアリングホイール4に与えられる操舵トルクで回転さ
せるステアリングシャフト5とを備えている。
Embodiments of the present invention will be described below with reference to the drawings. FIG. 1 is a schematic configuration diagram showing a first embodiment of the present invention. In FIG. 1B, 1FL, 1F
R indicates a front wheel, 1RL and 1RR indicate a rear wheel, and a front wheel 1F.
The L, 1FR is provided with a general rack and pinion type steering mechanism. This steering mechanism includes front wheels 1FL,
Rack 2 connected to 1FR steering shaft (tie rod)
And a pinion 3 that meshes with the pinion 3 and a steering shaft 5 that rotates the pinion 3 with a steering torque given to the steering wheel 4.

【0023】また、ステアリングシャフト5におけるピ
ニオン3の上部には、前輪1FL,1FRを自動操舵す
るための操舵アクチュエータを構成する自動操舵機構1
3が配設されている。この自動操舵機構13は、ステア
リングシャフト5と同軸に取付けられたドリブンギヤ1
4と、これに噛合するドライブギヤ15と、このドライ
ブギヤ15を回転駆動する自動操舵用モータ16とから
構成されている。なお、自動操舵モータ16とドライブ
ギヤ15との間にはクラッチ機構17が介装されてお
り、自動操舵制御時にのみクラッチ機構17が締結さ
れ、そうでないときにはクラッチ機構17が非締結状態
となって自動操舵モータ16の回転力がステアリングシ
ャフト5に入力されないようにしている。
An automatic steering mechanism 1 which constitutes a steering actuator for automatically steering the front wheels 1FL, 1FR is provided above the pinion 3 in the steering shaft 5.
3 are provided. The automatic steering mechanism 13 includes a driven gear 1 mounted coaxially with the steering shaft 5.
4, a drive gear 15 meshing with the drive gear 4, and an automatic steering motor 16 for driving the drive gear 15 to rotate. Note that a clutch mechanism 17 is interposed between the automatic steering motor 16 and the drive gear 15, and the clutch mechanism 17 is engaged only during automatic steering control. Otherwise, the clutch mechanism 17 is in an unengaged state. The rotation force of the automatic steering motor 16 is prevented from being input to the steering shaft 5.

【0024】また、車両には種々のセンサ類が取付けら
れている。図中、21は舵角センサであって、ステアリ
ングシャフト5の回転角から操舵角θを検出してコント
ロールユニット10に出力する。また、図示しない自動
変速機の出力側に車速センサ22が取付けられ、この車
速センサ22で検出された車速検出値Vもコントロール
ユニット10に出力される。さらに、車両には車両に発
生する横加速度を検出する横加速度検出手段としての横
加速度センサ23が取付けられ、この横加速度センサ2
3で検出された横加速度GY もコントロールユニット1
0に出力される。ここで、操舵角センサ21から出力さ
れる操舵角θは、図2に示すように、右操舵時に正値、
左操舵時に負値となるように設定され、横加速度センサ
23から出力される横加速度GY は、図2に示すよう
に、左旋回時に正値、右旋回時に負値となるように設定
されている。
Various sensors are mounted on the vehicle. In the figure, reference numeral 21 denotes a steering angle sensor which detects a steering angle θ from the rotation angle of the steering shaft 5 and outputs the detected steering angle θ to the control unit 10. A vehicle speed sensor 22 is attached to the output side of an automatic transmission (not shown), and a vehicle speed detection value V detected by the vehicle speed sensor 22 is also output to the control unit 10. Further, the vehicle is provided with a lateral acceleration sensor 23 as a lateral acceleration detecting means for detecting a lateral acceleration generated in the vehicle.
The lateral acceleration G Y detected in 3 is also the control unit 1
Output to 0. Here, the steering angle θ output from the steering angle sensor 21 is a positive value during right steering, as shown in FIG.
Is set to be a negative value when the leftward steering, lateral acceleration G Y output from the lateral acceleration sensor 23, as shown in FIG. 2, set to be a negative value positive value, when the right turning during left turning Have been.

【0025】さらに、車室内のインナーミラーステー等
の固定部には、図1aに示すように、CCDカメラ等の
単眼カメラ25が設置され、車両前方状況を撮像し、撮
像した画像データをカメラコントローラ26に出力す
る。このカメラコントローラ26は、例えば特開平11
−102499号公報に記載されているように、単眼カ
メラ25の画像データを二値化等の処理により自車両近
傍の白線を検出すると共に、所定の車両前方注視点での
走行車線に対する自車両の相対横変位y、車両の白線の
接線に対するヨー角Φ、走行車線前方の曲率半径ρを算
出し、これらをコントロールユニット10に出力する。
なお、走行車線に対する自車両の相対横変位とは、例え
ば走行車線の中央に対して自車両が如何ほど横方向にず
れているかを表すものとする。
Further, as shown in FIG. 1A, a monocular camera 25 such as a CCD camera is installed on a fixed portion such as an inner mirror stay in the vehicle compartment, and captures a situation in front of the vehicle. 26. This camera controller 26 is, for example, disclosed in
As described in JP-A-102499, a white line near the own vehicle is detected by a process such as binarization of the image data of the monocular camera 25, and the own vehicle with respect to the running lane at a predetermined vehicle forward fixation point is detected. The relative lateral displacement y, the yaw angle Φ with respect to the tangent to the white line of the vehicle, and the radius of curvature ρ ahead of the traveling lane are calculated and output to the control unit 10.
It should be noted that the relative lateral displacement of the host vehicle with respect to the traveling lane indicates, for example, how the host vehicle deviates in the lateral direction with respect to the center of the traveling lane.

【0026】コントロールユニット10は、図示しない
マイクロコンピュータ等の離散化されたディジタルシス
テムで構成され、入力されたヨー角Φ、相対横偏位y、
道路曲率ρに基づいてカーブを通過する際に最適な目標
操舵角θ* を算出し、操舵角センサ21で検出した実操
舵角θを目標操舵角θ* に一致させるように自動操舵用
モータ16に対する供給電流iM を算出し、この供給電
流iM を電流制限処理してからパルス幅変調してパルス
電流に変換して自動操舵用モータ16に出力することに
より、自動操舵用モータ16をデューティ制御する。
The control unit 10 is constituted by a discretized digital system such as a microcomputer (not shown), and receives the input yaw angle Φ, relative lateral displacement y,
An optimum target steering angle θ * is calculated when the vehicle passes through a curve based on the road curvature ρ, and the automatic steering motor 16 is adjusted so that the actual steering angle θ detected by the steering angle sensor 21 matches the target steering angle θ *. It calculates a supply current i M for, by outputting the supply current i M from the current limiting process to a pulse width modulation automatic steering motor 16 is converted into a pulse current, duty automatic steering motor 16 Control.

【0027】次に、上記実施形態の動作をコントロール
ユニット10で実行する操舵制御処理手順を表す図3の
フローチャートを伴って説明する。この操舵制御処理
は、所定サンプリング時間(例えば10msec. )毎のタ
イマ割込処理として実行され、先ず、ステップS1で、
前記カメラコントローラ26で走行車線、具体的には白
線を見失った(ロストした)、つまり検出できなくなっ
たか否かを判定し、走行車線をロストした場合にはステ
ップS2に移行し、そうでない場合にはステップS3に
移行する。
Next, the operation of the above embodiment will be described with reference to the flowchart of FIG. This steering control process is executed as a timer interrupt process for each predetermined sampling time (for example, 10 msec.). First, in step S1,
The camera controller 26 determines whether or not the traveling lane, specifically, the white lane, has been lost (lost), that is, has not been detected. If the traveling lane has been lost, the process proceeds to step S2. Shifts to step S3.

【0028】前記ステップS3では、前記操舵角センサ
21で検出した実操舵角θ、横加速度センサ23で検出
した横加速度GY 、車速センサ18で検出した車速検出
値V並びにカメラコントローラ26で検出したヨー角
Φ、相対横偏位y及び走行車線曲率半径ρを読込んでか
らステップS4に移行する。前記ステップS4では、前
記ステップS3で読込まれたヨー角Φ、相対横変位y及
び走行車線曲率半径ρをもとに、下記1式に従って、今
回の目標操舵角θ*(n) を算出し、今回目標操舵角記憶
領域に記憶されている前回の目標操舵角θ*(n-1) を前
回目標操舵角記憶領域に更新記憶すると共に、今回の目
標操舵角θ*(n) を今回目標操舵角記憶領域に更新記憶
してからステップS5に移行する。
In step S3, the actual steering angle θ detected by the steering angle sensor 21, the lateral acceleration G Y detected by the lateral acceleration sensor 23, the detected vehicle speed V detected by the vehicle speed sensor 18, and the detected by the camera controller 26. After reading the yaw angle Φ, the relative lateral deviation y and the travel lane curvature radius ρ, the process proceeds to step S4. In the step S4, based on the yaw angle Φ, the relative lateral displacement y and the running lane curvature radius ρ read in the step S3, a current target steering angle θ * (n) is calculated according to the following equation: The previous target steering angle θ * (n-1) stored in the current target steering angle storage area is updated and stored in the previous target steering angle storage area, and the current target steering angle θ * (n) is stored in the current target steering angle storage area. After the update storage in the corner storage area, the process proceeds to step S5.

【0029】 θ* =Ka・Φ+Kb・y+Kc/ρ ……… (1) ここで、Ka,Kb,Kcは、車速に応じて変動する制
御ゲインであり、目標操舵角θ* は右方向の操舵時に正
値、左方向の操舵時には負値となる。前記ステップS5
では、下記2式に従って、実操舵角θを目標操舵角θ*
に一致させるPID制御により、自動操舵用モータ16
に対する基準モータ供給電流iM0を算出し、これを基準
モータ供給電流記憶領域に更新記憶してからステップS
6に移行する。
Θ * = Ka · Φ + Kb · y + Kc / ρ (1) where Ka, Kb, and Kc are control gains that vary according to the vehicle speed, and the target steering angle θ * is steering in the right direction. At times, the value is a positive value, and when steering in the left direction, the value is a negative value. Step S5
Then, according to the following two equations, the actual steering angle θ is changed to the target steering angle θ *.
The automatic steering motor 16
Is calculated and stored in the reference motor supply current storage area after updating the reference motor supply current i M0.
Move to 6.

【0030】 iM0=Kvi(Kp+Ki/s+Kd・s)・(θ* −θ) ………… (2) ここで、Kviは電圧値を電流値に変換するための制御
ゲイン、Kpは比例ゲイン、Kiは積分ゲイン、Kdは
微分ゲイン、sはラプラス演算子である。この2式で基
準モータ供給電流iM0を算出する理由は、図4に示すよ
うに、減算器31で、目標操舵角θ* から実操舵角θを
減算して両者の差Δθを算出し、これを演算器32に供
給して、PID制御演算を行って目標モータ制御電圧V
*を算出し、この目標モータ制御電圧V* を電圧電流変
換器33に供給して、目標モータ制御電圧V* に制御ゲ
インKviを乗算してモータ供給電流iM を算出し、こ
れを自動操舵用モータ16に供給するフィードバック制
御系を構成した場合を考え、これと等価な演算を行うよ
うにしたものである。
I M0 = Kvi (Kp + Ki / s + Kd · s) · (θ * −θ) (2) where Kvi is a control gain for converting a voltage value to a current value, and Kp is a proportional gain. , Ki are integral gains, Kd is a differential gain, and s is a Laplace operator. The reason for calculating the reference motor supply current i M0 by these two equations is that, as shown in FIG. 4, the subtractor 31 subtracts the actual steering angle θ from the target steering angle θ * to calculate the difference Δθ between them. This is supplied to a computing unit 32 to perform a PID control calculation to obtain a target motor control voltage V
* , The target motor control voltage V * is supplied to the voltage-current converter 33, and the target motor control voltage V * is multiplied by the control gain Kvi to calculate the motor supply current i M , which is automatically steered. Considering the case where a feedback control system for supplying to the motor 16 is configured, an operation equivalent to this is performed.

【0031】前記ステップS6では、前記ステップS3
で読込んだ走行車線曲率半径ρに基づいて、図5の制御
マップに従って、モータ供給電流制限値iL を設定して
からステップS7に移行する。この図5の制御マップ
は、例えば走行車線の曲率半径として1000m程度に
設定された所定値ρ1 と1100m程度に設定された所
定値ρ2 とでヒステリシスを持たせ、走行車線曲率半径
ρが小さくなるときには所定値ρ1 以上の領域で供給電
流制限値iL を比較的大きな所定値iHi一定とし、所定
値ρ1 未満の領域で供給電流制限値iL を比較的小さな
所定値iLo一定とする。逆に走行車線曲率半径ρが大き
くなるときには所定値ρ2 以上の領域で供給電流制限値
L を比較的大きな所定値iHi一定とし、所定値ρ2
満の領域で供給電流制限値iL を比較的小さな所定値i
Lo一定とする。
In step S6, step S3
Based on the travel lane curvature radius ρ read in step (1), the motor supply current limit value i L is set according to the control map shown in FIG. 5, and the process proceeds to step S7. Control map of FIG. 5, for example, set to 1 and 1100m about the predetermined value [rho set to about 1000m as the radius of curvature of the traffic lane with a predetermined value [rho 2 a hysteresis, lane curvature radius [rho small relatively large and a predetermined value i Hi constant, relatively small predetermined value i Lo constant supply current limit i L at a predetermined value [rho 1 below region a supply current limit i L at a predetermined value [rho 1 or more regions when made And When the reverse to the traveling lane curvature radius [rho increases the supply current limit i L relatively great predetermined value i Hi constant at a predetermined value [rho 2 or more regions, the supply current limit i L at a predetermined value [rho 2 below regions Is a relatively small predetermined value i
Lo is fixed.

【0032】前記ステップS7では、前記ステップS6
で設定されたモータ供給電流制限値iL が前記比較的小
さな所定値iLoであるか否かを判定し、当該モータ供給
電流制限値iL が所定値iLoである場合にはステップS
8に移行し、そうでない場合にはステップS9に移行す
る。前記ステップS8では、前回のサンプリング時刻に
設定したモータ供給電流i M から前記ステップS6で設
定したモータ供給電流制限値iL を減じた値の絶対値|
M −iL |が予め設定された比較的小さい所定値Δi
0 以下であるか否かを判定し、前回のモータ供給電流i
M からモータ供給電流制限値iL を減じた値の絶対値|
M −iL |が所定値Δi0 以下である場合にはステッ
プS11に移行し、そうでない場合にはステップS10
に移行する。
At the step S7, at the step S6
Motor supply current limit value i set byLIs relatively small
The predetermined value iLoIs determined, and the motor supply
Current limit value iLIs a predetermined value iLoIf step S
8; otherwise, proceed to step S9.
You. In step S8, the last sampling time
Set motor supply current i MFrom step S6
Set motor supply current limit value iLAbsolute value of the value after subtracting |
iM−iLIs a relatively small predetermined value Δi
0It is determined whether the current is less than or equal to
MFrom the motor supply current limit value iLAbsolute value of the value after subtracting |
iM−iL| Is the predetermined value Δi0Step if
The process moves to step S11, otherwise, step S10
Move to

【0033】前記ステップS9では、前記ステップS5
で算出した基準モータ供給電流iM0から前回のサンプリ
ング時刻に設定したモータ供給電流iM を減じた値の絶
対値|iM0−iM |が前記予め設定された比較的小さい
所定値Δi0 以下であるか否かを判定し、基準モータ供
給電流iM0から前回のモータ供給電流iM を減じた値の
絶対値|iM0−iM |が所定値Δi0 以下である場合に
は前記ステップS11に移行し、そうでない場合には前
記ステップS10に移行する。
At step S9, at step S5
The absolute value | i M0 −i M | of the value obtained by subtracting the motor supply current i M set at the previous sampling time from the reference motor supply current i M0 calculated in the above is equal to or less than the relatively small predetermined value Δi 0. step if is less than a predetermined value .DELTA.i 0 | determines whether a, the absolute value of the reference motor current supplied from the i M0 previous motor supply current i a value obtained by subtracting the M | i M0 -i M The process proceeds to S11, and if not, the process proceeds to step S10.

【0034】前記ステップS10では、前回のサンプリ
ング時刻に設定されたモータ供給電流iM を傾き一定で
前記モータ供給電流制限値iL に漸近させ、それを新た
なモータ供給電流iM の指令値としてから前記ステップ
S11に移行する。一方、前記ステップS2では、モー
タ供給電流iM 及びモータ供給電流制限値iL を前回の
値に保持してから前記ステップS11に移行する。
In step S10, the motor supply current i M set at the previous sampling time is gradually approached to the motor supply current limit value i L with a constant gradient, and this is set as a new motor supply current i M command value. Then, the process proceeds to step S11. On the other hand, in step S2, the motor supply current i M and the motor supply current limit value i L are held at the previous values, and then the process proceeds to step S11.

【0035】前記ステップS11では、設定されたモー
タ供給電流iM を指令値としてモータ16に出力してか
らメインプログラムに復帰する。図6は、前記図3の演
算処理によるモータ供給電流のタイミングチャートであ
る。なお、図中の走行車線情報は、“1”で走行車線検
出を、“0”で走行車線非検出を示す。
In step S11, the set motor supply current i M is output to the motor 16 as a command value, and then the process returns to the main program. FIG. 6 is a timing chart of the motor supply current by the calculation processing of FIG. It should be noted that the traveling lane information in the drawing indicates “1” to indicate traveling lane detection and “0” to indicate no traveling lane detection.

【0036】ここでは、曲率半径ρが前記比較的小さい
所定値ρ1 以上の走行車線を走行している状態から、時
刻t01以後、当該所定値ρ1 以下の曲率半径の走行車線
を走行し、その後、時刻t05以後、前記比較的大きい所
定値ρ2 以上の曲率半径の走行車線に移行する。また、
前記時刻t01から時刻t05までの間には、時刻t03から
時刻t04まで、前記時刻t05以後では、時刻t06から時
刻t07まで、カメラ25による走行車線を見失ってい
る。
[0036] Here, running from the state of curvature radius [rho is traveling the relatively small predetermined value [rho 1 or more driving lane, the time t 01 after, the predetermined value [rho 1 following the radius of curvature of the traffic lane , then the time t 05 after, proceeds to the larger predetermined value [rho 2 or more the radius of curvature of the traffic lane. Also,
Until time t 05 from the time t 01 is, from the time t 03 to time t 04, and in the time t 05 after, from the time t 06 to time t 07, have lost sight of the driving lane by the camera 25.

【0037】このタイミングチャートでは、前記時刻t
01まで、モータ供給電流制限値iLは比較的大きな所定
値iHiであり、時刻t01から時刻t05まで比較的小さな
所定値iLoであり、時刻t05以後、再び所定値iHiであ
る。この比較的大きな所定値iHiは、凡そ必要な操舵ア
シストトルクの全領域をカバーできる程度の大きな電流
値であり、逆に比較的小さな所定値iLoは、フェイルが
発生して供給電流が停止されても操舵トルクが急変しな
い程度の小さな電流値である。
In this timing chart, the time t
To 01, the motor supply current limit i L is a relatively large predetermined value i Hi, a relatively small predetermined value i Lo from time t 01 to time t 05, the time t 05 after again at a predetermined value i Hi is there. The relatively large predetermined value i Hi is a large current value that can cover almost the entire region of the necessary steering assist torque, and the relatively small predetermined value i Lo is conversely a failure occurs and the supply current stops. The current value is small enough that the steering torque does not suddenly change even if it is performed.

【0038】そのため、時刻t01までは、前記図3の演
算処理のステップS5で走行車線の曲率半径ρに応じて
算出された基準モータ供給電流iM0がそのままモータ供
給電流iM として出力される。一方、時刻t01でモータ
供給電流制限値iL が比較的小さな所定値iLoに切り替
えられるため、当該時刻t01以後、図3の演算処理のス
テップS7からステップS8を経てステップS10に移
行するフローが繰り返され、その結果、モータ供給電流
M は傾き一定で制限値iL (=iLo)に漸近されてゆ
き、時刻t02で制限値iL に一致又はほぼ一致すると、
図3の演算処理のステップS8からステップS11に移
行するフローに切り替えられるため、それ以後、モータ
供給電流iM は比較的小さな所定値iLoからなる制限値
L に保持される。その後、前記時刻t03から時刻t04
まで走行車線を見失うが、その場合には前記図3の演算
処理のステップS1からステップS2に移行し、それま
でのモータ供給電流iM 及びモータ供給電流制限値iL
を保持するため、その間もモータ供給電流iM は制限値
L (=iLo)に保持される。
[0038] Therefore, until the time t 01, the reference motor supply current i M0 calculated according to the radius of curvature ρ of the traffic lane at step S5 in processing of FIG. 3 is output as a motor supply current i M intact . Meanwhile, since the motor supply current limit i L is switched to a relatively small predetermined value i Lo at time t 01, the time t 01 after, the process proceeds to step S10 through step S8 from step S7 of the arithmetic processing of Fig. 3 The flow is repeated, and as a result, the motor supply current i M gradually approaches the limit value i L (= i Lo ) with a constant slope, and when the motor supply current i M matches or almost matches the limit value i L at time t 02 ,
Since the flow is switched from step S8 to step S11 in the calculation processing in FIG. 3, the motor supply current i M is thereafter kept at the limit value i L including the relatively small predetermined value i Lo . Thereafter, from time t 03 to time t 04
However, in this case, the process shifts from step S1 to step S2 of the calculation processing in FIG. 3 and the motor supply current i M and the motor supply current limit value i L up to that point.
, The motor supply current i M is also kept at the limit value i L (= i Lo ).

【0039】このようにモータ供給電流iM が比較的小
さな制限値iL (=iLo)に保持されるということは、
操舵アシストトルクは不足している。そのため、運転者
は自らステアリングホイールを操舵しなければならない
が、逆にフェイルが発生しても操舵トルクは急変しな
い。そして、前記時刻t05で走行車線曲率半径ρが所定
値ρ2 以上となってからはモータ供給電流制限値iL
比較的大きな所定値iHiに切り替えられるので、当該時
刻t05以後、図3の演算処理のステップS7からステッ
プ9を経てステップS10に移行するフローが繰り返さ
れ、その結果、モータ供給電流iM は傾き一定で制限値
L (=iHi)に向けて漸近されてゆく。しかし、その
間、時刻t06から時刻t07まで走行車線を見失うため、
時刻t06のモータ供給電流iM が時刻t07まで保持され
る。勿論、その間もモータ供給電流制限値iL は比較的
大きな所定値iHiに保持され続ける。その後、時刻t07
で走行車線を再び検出したらモータ供給電流iM は傾き
一定で制限値iL (=iHi)に向けて漸近される。やが
て、増加されるモータ供給電流iM が前記図3の演算処
理のステップS5で算出される基準モータ供給電流iM0
に一致又はほぼ一致すると、図3の演算処理のステップ
S9からステップS11に移行するフローに切り替えら
れるため、それ以後、前記走行車線の曲率半径ρに応じ
て算出された基準モータ供給電流iM0がそのままモータ
供給電流iM として出力される。
The fact that the motor supply current i M is held at the relatively small limit value i L (= i Lo ) means that
The steering assist torque is insufficient. Therefore, the driver has to steer the steering wheel by himself, but the steering torque does not change suddenly even if a failure occurs. Since the time t 05 in lane curvature radius [rho motor supply current limit i L from becoming a predetermined value [rho 2 or is switched to a relatively large predetermined value i Hi, the time t 05 after, Figure The flow from step S7 of step 3 to step S10 via step 9 is repeated, and as a result, the motor supply current i M approaches the limit value i L (= i Hi ) with a constant slope. . However, during which time, in order to lose sight of the driving lane from the time t 06 to time t 07,
The motor supply current i M at time t 06 is held until time t 07 . Of course, during that time, the motor supply current limit value i L is kept at the relatively large predetermined value i Hi . Then, at time t 07
When the traveling lane is detected again, the motor supply current i M is asymptotic toward the limit value i L (= i Hi ) with a constant slope. Eventually, the increased motor supply current i M is used as the reference motor supply current i M0 calculated in step S5 of the calculation processing in FIG.
When it is almost or almost the same, the flow is switched to the flow that shifts from step S9 to step S11 in the calculation processing in FIG. 3, and thereafter, the reference motor supply current i M0 calculated according to the radius of curvature ρ of the traveling lane becomes smaller. It is output as it is as the motor supply current i M.

【0040】このように、本実施形態の車線追従走行制
御装置では、検出された走行車線の曲率半径ρが所定値
ρ1 又は所定値ρ2 より小さいとき、モータ供給電流制
限値iL を比較的小さな所定値iLoに設定する構成とし
たため、フェイル時の操舵トルクの急変を抑制防止する
ことができる。また、本実施形態の車線追従走行制御装
置によれば、走行車線を検出できなくなったときにモー
タ供給電流制限値iL を保持する構成としたため、走行
車線を再び検出したときの操舵トルクの変動を抑制防止
することができる。
As described above, in the lane-following traveling control device of this embodiment, when the detected curvature radius ρ of the traveling lane is smaller than the predetermined value ρ 1 or the predetermined value ρ 2 , the motor supply current limit value i L is compared. Since the predetermined value i Lo is set to a very small value, it is possible to prevent a sudden change in the steering torque at the time of a failure. Further, according to the lane following distance control device of this embodiment, since a configuration for holding the motor supply current limit i L when it becomes impossible to detect the traffic lane, the variation of the steering torque when the driving lane is detected again Can be suppressed.

【0041】以上より、前記操舵角センサ21及び図3
の演算処理のステップS3が本発明の操舵角検出手段を
構成し、以下同様に、前記単眼カメラ25が画像情報検
出手段を構成し、前記カメラコントローラ26及び図3
の演算処理のステップS3が走行車線情報検出手段を構
成し、前記モータ16が操舵トルク発生手段を構成し、
図3の演算処理全体及び前記コントロールユニット10
が操舵トルク制御手段を構成し、図3の演算処理のステ
ップS4及びステップS5が供給電流算出手段を構成
し、図3の演算処理のステップS6が供給電流制限値設
定手段を構成している。
As described above, the steering angle sensor 21 and FIG.
3 constitutes a steering angle detecting means of the present invention. Similarly, the monocular camera 25 constitutes an image information detecting means, and the camera controller 26 and FIG.
Step S3 of the arithmetic processing of the above constitutes the traveling lane information detecting means, the motor 16 constitutes the steering torque generating means,
3 and the control unit 10
Constitute the steering torque control means, steps S4 and S5 of the calculation processing of FIG. 3 constitute supply current calculation means, and step S6 of the computation processing of FIG. 3 constitute supply current limit value setting means.

【0042】次に、本発明の車線追従走行制御装置の第
2実施形態について説明する。この実施形態の車両構成
は、前記第1実施形態の図1のものと同様であり、前記
コントロールユニット10で行われる演算処理が前記第
1実施形態の図3のものから図7のものに変更されてい
る。この図7の演算処理も、前記第1実施形態と同様
に、所定サンプリング時間ΔT毎にタイマ割込によって
行われ、まずステップS21で、前記カメラコントロー
ラ26で走行車線、具体的には白線を見失った(ロスト
した)、つまり検出できなくなったか否かを判定し、走
行車線をロストした場合にはステップS22に移行し、
そうでない場合にはステップS23に移行する。
Next, a description will be given of a second embodiment of the lane-following traveling control device according to the present invention. The vehicle configuration of this embodiment is the same as that of FIG. 1 of the first embodiment, and the arithmetic processing performed by the control unit 10 is changed from that of FIG. 3 of the first embodiment to that of FIG. Have been. 7 is also performed by a timer interrupt every predetermined sampling time ΔT, as in the first embodiment. First, in step S21, the camera controller 26 loses track of the traveling lane, specifically, the white lane. Is determined (ie, lost), that is, whether or not detection is no longer possible. If the traveling lane has been lost, the process proceeds to step S22,
If not, the process proceeds to step S23.

【0043】前記ステップS23では、前記操舵角セン
サ21で検出した実操舵角θ、横加速度センサ23で検
出した横加速度GY 、車速センサ18で検出した車速検
出値V並びにカメラコントローラ26で検出したヨー角
Φ、相対横偏位y及び走行車線曲率半径ρを読込んでか
らステップS24に移行する。前記ステップS24で
は、図8の制御マップから車速V、走行車線曲率半径ρ
に応じたローパスフィルタのカットオフ周波数FC-OFF
を設定してからステップS25に移行する。この図8の
制御マップは、車速Vを横軸に、ローパスフィルタのカ
ットオフ周波数FC-OFF を縦軸にとり、走行車線曲率半
径ρをパラメータとし、車速Vが大きいほど、また走行
車線曲率半径ρが小さいほど、ローパスフィルタのカッ
トオフ周波数FC-OFF が小さくなるように構成されてい
る。
In step S23, the actual steering angle θ detected by the steering angle sensor 21, the lateral acceleration G Y detected by the lateral acceleration sensor 23, the detected vehicle speed V detected by the vehicle speed sensor 18, and the detected by the camera controller 26. After reading the yaw angle Φ, the relative lateral deviation y and the travel lane curvature radius ρ, the process proceeds to step S24. In step S24, the vehicle speed V and the travel lane curvature radius ρ are obtained from the control map of FIG.
Cut-off frequency F C-OFF of low-pass filter according to
Is set, and the process proceeds to step S25. The control map shown in FIG. 8 has the horizontal axis representing the vehicle speed V, the vertical axis representing the cutoff frequency F C-OFF of the low-pass filter, and the traveling lane curvature radius ρ as a parameter. As the vehicle speed V increases, the traveling lane curvature radius increases. The lower the value of ρ, the lower the cutoff frequency F C-OFF of the low - pass filter.

【0044】前記ステップS25では、前記ステップS
23で読込んだ横加速度GY に対して、前記ステップS
24で設定したカットオフ周波数FC-OFF でローパスフ
ィルタ処理を施してからステップS26に移行する。こ
のローパスフィルタ処理は、横風や轍、修正舵等による
ノイズ成分を除去するものである。前記ステップS26
では、前記ローパスフィルタ処理済み横加速度GY-LPF
及び前記ステップS23で読込んだ車速Vから下記3式
に従って推定曲率半径ρ^を算出してからステップS2
7に移行する。
In the step S25, the step S
The lateral acceleration G Y read in 23, wherein the step S
After performing the low - pass filter processing at the cutoff frequency F C-OFF set in 24, the process proceeds to step S26. This low-pass filter processing removes noise components due to crosswinds, ruts, modified steering, and the like. Step S26
Now, the low-pass filtered lateral acceleration G Y-LPF
From the vehicle speed V read in step S23 and the estimated radius of curvature ρS in accordance with the following three equations, and then proceeds to step S2.
Move to 7.

【0045】 ρ^=k・V2 /GY-LPF ……… (3) なお、式中の補正係数kは、検出した走行車線の曲率半
径ρと算出した推定曲率半径ρ^とをメモりし、最小二
乗法によって求める。前記ステップS27では、前記ス
テップS23で読込んだ走行車線曲率半径ρから前記ス
テップS26で算出した推定曲率半径ρ^を減じて曲率
半径誤差Δρを算出してからステップS28に移行す
る。
Ρ ^ = k · V 2 / G Y-LPF (3) Note that the correction coefficient k in the equation is a record of the detected radius of curvature ρ of the traveling lane and the calculated estimated radius of curvature ρ ^. It is determined by the least squares method. In step S27, the radius of curvature error Δρ is calculated by subtracting the estimated radius of curvature ρ ^ calculated in step S26 from the radius of curvature ρ of the traveling lane read in step S23, and then the process proceeds to step S28.

【0046】前記ステップS28では、前記第1実施形
態と同様に、前記ステップS23で読込まれたヨー角
Φ、相対横変位y及び走行車線曲率半径ρをもとに、前
記1式に従って、今回の目標操舵角θ* (n) を算出し、
今回目標操舵角記憶領域に記憶されている前回の目標操
舵角θ* (n-1) を前回目標操舵角記憶領域に更新記憶す
ると共に、今回の目標操舵角θ* (n) を今回目標操舵角
記憶領域に更新記憶してからステップS29に移行す
る。
In the step S28, similarly to the first embodiment, the present yaw angle Φ, the relative lateral displacement y and the travel lane curvature radius ρ read in the step S23 are used in accordance with the above equation (1). Calculate the target steering angle θ * (n),
The previous target steering angle θ * (n-1) stored in the current target steering angle storage area is updated and stored in the previous target steering angle storage area, and the current target steering angle θ * (n) is stored in the current target steering angle storage area. After the update storage in the corner storage area, the process proceeds to step S29.

【0047】前記ステップS29では、前記第1実施形
態と同様に、前記2式に従って、実操舵角θを目標操舵
角θ* に一致させるPID制御により、自動操舵用モー
タ16に対する基準モータ供給電流iM0を算出し、これ
を基準モータ供給電流記憶領域に更新記憶してからステ
ップS30に移行する。前記ステップS30では、前記
第1実施形態と同様に、前記ステップS23で読込んだ
走行車線曲率半径ρに基づいて、前記図5の制御マップ
に従って、モータ供給電流制限値iL を設定してからス
テップS31に移行する。
In step S29, similarly to the first embodiment, the reference motor supply current i to the automatic steering motor 16 is obtained by PID control according to the above equation (2) so that the actual steering angle θ matches the target steering angle θ *. M0 is calculated, updated and stored in the reference motor supply current storage area, and then the process proceeds to step S30. In step S30, as in the first embodiment, based on the traveling lane curvature radius ρ read in step S23, the motor supply current limit value i L is set according to the control map of FIG. Move to step S31.

【0048】一方、前記ステップS22では、前記操舵
角センサ21で検出した実操舵角θ、横加速度センサ2
3で検出した横加速度GX 、車速センサ18で検出した
車速検出値Vを読込んでからステップS32に移行す
る。前記ステップS32では、前記図8の制御マップか
ら車速V、前回サンプリング時刻に読込んだ走行車線曲
率半径ρ或いは前回サンプリング時刻に算出した推定曲
率半径ρ^に応じたローパスフィルタのカットオフ周波
数FC-OFF を設定してからステップS33に移行する。
In step S22, the actual steering angle θ detected by the steering angle sensor 21 and the lateral acceleration sensor 2
After the lateral acceleration G X detected in step 3 and the vehicle speed detection value V detected by the vehicle speed sensor 18 are read, the process proceeds to step S32. In step S32, the cutoff frequency F C of the low-pass filter according to the vehicle speed V, the traveling lane curvature radius ρ read at the previous sampling time, or the estimated curvature radius ρ ^ calculated at the previous sampling time, from the control map of FIG. After setting -OFF , the process proceeds to step S33.

【0049】前記ステップS33では、前記ステップS
22で読込んだ横加速度GY に対して、前記ステップS
32で設定したカットオフ周波数FC-OFF でローパスフ
ィルタ処理を施してからステップS34に移行する。前
記ステップS34では、前記ローパスフィルタ処理済み
横加速度GY-LPF 及び前記ステップS22で読込んだ車
速Vから下記4式に従って推定曲率半径ρ^を算出して
からステップS35に移行する。
At the step S33, at the step S33
The lateral acceleration G Y read in 22, wherein the step S
After performing the low - pass filter processing at the cutoff frequency F C-OFF set in S32, the process proceeds to step S34. In step S34, an estimated radius of curvature ρ ^ is calculated from the low-pass-filtered lateral acceleration G Y-LPF and the vehicle speed V read in step S22 according to the following equation (4), and then the process proceeds to step S35.

【0050】 ρ^=k・V2 /GY-LPF +Δρ ……… (4) 前記ステップS35では、前回サンプリング時刻に算出
された若しくは前回サンプリング時刻に保持されている
前記基準モータ供給電流iM0を保持してからステップS
36に移行する。前記ステップS36では、前記ステッ
プS34で算出した推定曲率半径ρ^に基づいて、前記
図5の制御マップに従って、モータ供給電流制限値iL
を設定してから前記ステップS31に移行する。
Ρ ^ = kV 2 / G Y-LPF + Δρ (4) In step S35, the reference motor supply current i M0 calculated at the previous sampling time or held at the previous sampling time. And then step S
Move to 36. In the step S36, based on the calculated estimated radius of curvature [rho ^ in step S34, according to the control map of FIG. 5, the motor supply current limit i L
Is set, and then the flow shifts to the step S31.

【0051】前記ステップS31では、前記ステップS
30又はステップS36で設定されたモータ供給電流制
限値iL が前記比較的小さい所定値iLoであるか否かを
判定し、当該モータ供給電流制限値iL が所定値iLo
ある場合にはステップS37に移行し、そうでない場合
にはステップS38に移行する。前記ステップS38で
は、図9aの制御マップに基づいて、車速Vに応じたモ
ータ供給電流変化率Hiを設定してからステップS39
に移行する。この制御マップは、車速Vが大きいほどモ
ータ供給電流変化率Hiがリニアに大きくなるように構
成されている。なお、モータ供給電流変化率Hiの傾き
は比較的小さい。
At the step S31, at the step S31
It is determined whether or not the motor supply current limit value i L set in step 30 or step S36 is the relatively small predetermined value i Lo . If the motor supply current limit value i L is the predetermined value i Lo , Shifts to step S37, and if not, shifts to step S38. In the step S38, the motor supply current change rate Hi corresponding to the vehicle speed V is set based on the control map of FIG.
Move to This control map is configured such that the motor supply current change rate Hi linearly increases as the vehicle speed V increases. The gradient of the motor supply current change rate Hi is relatively small.

【0052】また、前記ステップS37では、図9bの
制御マップに基づいて、車速Vに応じたモータ供給電流
変化率Hiを設定してから前記ステップS39に移行す
る。この制御マップは、車速Vが大きいほどモータ供給
電流変化率Hiがリニアに小さくなるように構成されて
いる。なお、モータ供給電流変化率Hiの傾きは比較的
大きい。
In step S37, the motor supply current change rate Hi corresponding to the vehicle speed V is set based on the control map shown in FIG. 9B, and then the flow shifts to step S39. This control map is configured such that the motor supply current change rate Hi decreases linearly as the vehicle speed V increases. Note that the gradient of the motor supply current change rate Hi is relatively large.

【0053】前記ステップS39では、前記ステップS
30又はステップS36で設定されたモータ供給電流制
限値iL が前記比較的小さな所定値iLoであるか否かを
判定し、当該モータ供給電流制限値iL が所定値iLo
ある場合にはステップS40に移行し、そうでない場合
にはステップS41に移行する。前記ステップS40で
は、前回のサンプリング時刻に設定したモータ供給電流
M から前記ステップS30又はステップS36で設定
したモータ供給電流制限値iL を減じた値の絶対値|i
M −iL |が予め設定された比較的小さい所定値Δi0
以下であるか否かを判定し、前回のモータ供給電流iM
からモータ供給電流制限値iL を減じた値の絶対値|i
M −iL |が所定値Δi0 以下である場合にはステップ
S43に移行し、そうでない場合にはステップS42に
移行する。
At the step S39, at the step S39
It is determined whether or not the motor supply current limit value i L set in step 30 or step S36 is the relatively small predetermined value i Lo . If the motor supply current limit value i L is the predetermined value i Lo , Shifts to step S40, and if not, shifts to step S41. In step S40, the absolute value | i of a value obtained by subtracting the motor supply current limit value i L set in step S30 or step S36 from the motor supply current i M set at the previous sampling time.
M− i L | is a relatively small predetermined value Δi 0 set in advance.
To determine a whether or less, a previous motor supply current i M
The absolute value of the value obtained by subtracting the motor supply current limit i L from | i
If M− i L | is equal to or smaller than the predetermined value Δi 0 , the process shifts to step S43; otherwise, the process shifts to step S42.

【0054】前記ステップS41では、前記ステップS
29で算出した基準モータ供給電流iM0から前回のサン
プリング時刻に設定したモータ供給電流iM を減じた値
の絶対値|iM0−iM |が前記予め設定された比較的小
さい所定値Δi0 以下であるか否かを判定し、基準モー
タ供給電流iM0から前回のモータ供給電流iM を減じた
値の絶対値|iM0−iM |が所定値Δi0 以下である場
合には前記ステップS43に移行し、そうでない場合に
は前記ステップS42に移行する。
At the step S41, at the step S41
The absolute value | i M0 −i M | of the value obtained by subtracting the motor supply current i M set at the previous sampling time from the reference motor supply current i M0 calculated in 29 is the relatively small predetermined value Δi 0. wherein if is less than a predetermined value .DELTA.i 0 | determines whether the whether or less, the absolute value of the reference motor current supplied from the i M0 previous motor supply current i a value obtained by subtracting the M | i M0 -i M The process proceeds to step S43, and if not, the process proceeds to step S42.

【0055】前記ステップS42では、前回のサンプリ
ング時刻に設定されたモータ供給電流iM を、前記ステ
ップS37又はステップS38で設定された変化率Hi
で前記モータ供給電流制限値iL に漸近させ、それを新
たなモータ供給電流iM の指令値としてから前記ステッ
プS43に移行する。前記ステップS43では、前記ス
テップS30又はステップS36で設定されたモータ供
給電流制限値iL が前記比較的小さな所定値iLoである
か否かを判定し、当該モータ供給電流制限値iL が所定
値iLoである場合にはステップS44に移行し、そうで
ない場合にはステップS45に移行する。
In step S42, the motor supply current i M set at the previous sampling time is changed to the rate of change Hi set in step S37 or S38.
To ascend to the motor supply current limit value i L , make it a new command value of the motor supply current i M , and then proceed to step S43. In the step S43, the steps S30 or motor supply current limit i L set in step S36, it is determined whether the relatively small predetermined value i Lo, the motor supply current limit i L is predetermined If the value is i Lo , the process proceeds to step S44; otherwise, the process proceeds to step S45.

【0056】前記ステップS44では、車線追従逸脱を
判定するための横変位閾値yL を比較的小さな所定値y
LLo に設定してからステップS46に移行する。前記ス
テップS46では、モータ供給電流にアシストトルク変
動信号を付加してからステップS47に移行する。この
アシストトルク変動信号は、例えばステアリングホイー
ルを振動させたり、或いは漸近中のモータ供給電流をや
やステップ的に変化させたりすることによって、前記モ
ータ供給電流制限値iL が所定値iLoである、つまり操
舵アシストトルクが不足気味であることを運転者に認識
させるものである。
In step S44, the lateral displacement threshold value y L for determining lane following deviation is set to a relatively small predetermined value y.
After setting to LLo , the process proceeds to step S46. In the step S46, an assist torque variation signal is added to the motor supply current, and the process proceeds to step S47. The assist torque fluctuation signal is obtained by, for example, vibrating the steering wheel or changing the motor supply current during asymptote in a stepwise manner, so that the motor supply current limit value i L is a predetermined value i Lo . That is, the driver is made to recognize that the steering assist torque tends to be insufficient.

【0057】一方、前記ステップS45では、車線追従
逸脱を判定するための横変位閾値y L を比較的大きな所
定値yLHi に設定してから前記ステップS47に移行す
る。前記ステップS47では、前記ステップS23で読
込んだ相対横変位の絶対値|y|が前記横変位閾値yL
以上であるか否かを判定し、当該相対横変位の絶対値|
y|が横変位閾値yL 以上である場合にはステップS4
8に移行し、そうでない場合にはステップS49に移行
する。
On the other hand, in step S45, the vehicle follows the lane.
Lateral displacement threshold y for determining deviation LA relatively large place
Fixed value yLHiAnd then proceed to step S47.
You. In step S47, the read in step S23 is performed.
The absolute value of the relative lateral displacement | y |L
The absolute value of the relative lateral displacement |
y | is the lateral displacement threshold yLIf so, step S4
8; otherwise, go to step S49.
I do.

【0058】前記ステップS48では、図示しない警報
装置に警報指令を出力してから前記ステップS49に移
行する。前記ステップS49では、設定されたモータ供
給電流iM を指令値としてモータ16に出力してからメ
インプログラムに復帰する。この演算処理では、まず走
行車線をロストしていないときに、ローパスフィルタ処
理された横加速度GY-LPF から推定曲率半径ρ^を算出
し、画像情報から得られた走行車線曲率半径ρと比較し
て補正係数k及び誤差Δρを算出している。通常、検出
された横加速度と、それから算出した曲率半径との間に
は、ドリフト成分等の定常誤差があることが多い。この
誤差を、画像情報から得た走行車線曲率半径ρと比較し
て求め、走行車線をロストしたときには、この曲率半径
誤差Δρ及び補正係数kを用いてより正確な推定曲率半
径ρ^を算出することが可能となる。
In step S48, an alarm command is output to an alarm device (not shown), and the flow advances to step S49. In step S49, the set motor supply current i M is output to the motor 16 as a command value, and then the process returns to the main program. In this calculation process, when the traveling lane is not lost, the estimated curvature radius ρ ^ is calculated from the low-pass filtered lateral acceleration G Y-LPF and compared with the traveling lane curvature radius ρ obtained from the image information. To calculate the correction coefficient k and the error Δρ. Usually, there is often a steady-state error such as a drift component between the detected lateral acceleration and the radius of curvature calculated therefrom. This error is obtained by comparing with the traveling lane curvature radius ρ obtained from the image information, and when the traveling lane is lost, a more accurate estimated curvature radius ρ ^ is calculated using the curvature radius error Δρ and the correction coefficient k. It becomes possible.

【0059】また、この演算処理では、前記横加速度G
Y に施すローパスフィルタのカットオフ周波数FC-OFF
を、車速Vが小さいほど、或いは走行車線曲率半径ρが
大きいほど小さく設定している、つまりより低周波の横
加速度GY だけを抽出している。一般に、車速Vが小さ
いほど、或いは走行車線曲率半径ρが大きいほど、運転
者による操舵の自由度が大きい、つまりふらついたり修
正舵を加えたりし易い。すると、横加速度GY に変動が
生じ、正確な推定曲率半径ρ^の算出が困難になる。そ
こで、本実施形態では、車速Vが小さいほど、或いは走
行車線曲率半径ρが大きいほど、ローパスフィルタのカ
ットオフ周波数FC-OFF を小さく設定し、より低周波の
横加速度GY 、つまりふらつきや修正舵による成分のな
い横加速度だけを抽出し、そのローパスフィルタ処理済
み横加速度GY-LPF に基づいて、推定曲率半径ρ^をよ
り正確に算出できるようにしている。
In this calculation process, the lateral acceleration G
Cutoff frequency F C-OFF of low-pass filter applied to Y
Is set smaller as the vehicle speed V is smaller or the traveling lane curvature radius ρ is larger, that is, only the lower frequency lateral acceleration G Y is extracted. In general, the lower the vehicle speed V or the larger the radius of curvature ρ of the traveling lane, the greater the degree of freedom of the steering by the driver, that is, the more easily the driver fluctuates or applies a corrected rudder. Then, a change occurs in the lateral acceleration G Y , and it is difficult to calculate an accurate estimated radius of curvature ρ ^. Therefore, in the present embodiment, the cutoff frequency F C-OFF of the low - pass filter is set smaller as the vehicle speed V is smaller or the traveling lane curvature radius ρ is larger, so that the lower frequency lateral acceleration G Y , that is, Only the lateral acceleration having no component due to the corrected steering is extracted, and the estimated radius of curvature ρ ^ can be calculated more accurately based on the low-pass filtered lateral acceleration G Y-LPF .

【0060】勿論、このようにロストしているときに
も、算出した推定曲率半径ρ^に基づいてモータ供給電
流制限値iL を設定しているので、走行車線を再び検出
したときの操舵トルクの変動が小さくなる。また、この
演算処理では、モータ供給電流制限値iL が前記比較的
小さい所定値iLoであるか否か、即ちモータ供給電流制
限値iL が所定値iLoであるか、所定値iHiであるかに
応じて、車速Vに応じた異なるモータ供給電流変化率H
iを設定している。具体的には、モータ供給電流制限値
L が前記比較的小さい所定値iLoであるときには、同
等の車速Vに対し、より大きな減少傾きの変化率Hiを
設定し、モータ供給電流制限値iL が前記比較的大きい
所定値iHiであるときには、同等の車速Vに対し、より
小さな増大傾きの変化率Hiを設定するようにしてい
る。
Of course, even when the vehicle is lost in this manner, the motor supply current limit value i L is set based on the calculated estimated radius of curvature ρ ^. Fluctuation becomes small. Further, in this calculation processing, it is determined whether the motor supply current limit value i L is the relatively small predetermined value i Lo, that is, whether the motor supply current limit value i L is the predetermined value i Lo or the predetermined value i Hi. The motor supply current change rate H depending on the vehicle speed V
i is set. Specifically, when the motor supply current limit value i L is the relatively small predetermined value i Lo , a larger decrease gradient Hi is set for the same vehicle speed V, and the motor supply current limit value i L is set. When L is the relatively large predetermined value i Hi , a smaller increase gradient Hi is set for the same vehicle speed V.

【0061】まず、車速Vに対してであるが、同じ場所
のカーブでは、曲率半径ρは一定であるから、モータ供
給電流制限値iL はいつも同じに設定される。もし、モ
ータ供給電流iM を制限値iL に漸近させる変化率が一
定であると、車速Vに応じて、モータ供給電流iM が制
限値iL に一致又はほぼ一致するまでの走行距離が異な
る、つまり位置が変化する。逆に、車速Vが大きいほ
ど、変化率Hiを大きくすると、モータ供給電流iM
制限値iL に一致する又はほぼ一致するまでの走行距離
を同じにする、つまり位置を同じにすることが可能とな
る。従って、同じ場所の同じカーブでは、車速Vに関わ
らず、常に同じ位置で同じような操舵トルク変化を行う
ことが可能となるので、同じ場所を走行する運転者への
違和感を抑制防止することが可能となる。
First, with respect to the vehicle speed V, in a curve at the same place, since the radius of curvature ρ is constant, the motor supply current limit value i L is always set to the same value. If the rate of change that causes the motor supply current i M to gradually approach the limit value i L is constant, the traveling distance until the motor supply current i M matches or almost matches the limit value i L according to the vehicle speed V. Different, that is, the position changes. Conversely, if the change rate Hi is increased as the vehicle speed V increases, the travel distance until the motor supply current i M matches or almost matches the limit value i L can be made equal, that is, the position can be made the same. It becomes possible. Therefore, it is possible to always perform the same steering torque change at the same position regardless of the vehicle speed V on the same curve at the same place, so that it is possible to prevent a driver traveling in the same place from feeling uncomfortable. It becomes possible.

【0062】また、モータ供給電流制限値iL が前記比
較的小さい所定値iLoであるときには、同等の車速Vに
対し、より大きな減少傾きの変化率Hiを設定する、即
ち操舵トルクを不足させるときには速やかに小さくする
ことにより、フェイル時の操舵トルクの急変に備えるこ
とができる。また、モータ供給電流制限値iL が前記比
較的大きい所定値iHiであるときには、同等の車速Vに
対し、より小さな増大傾きの変化率Hiを設定する、即
ち操舵トルクを増大させるときにはゆっくりと変化させ
るようにすることにより、旋回が交互に繰り返される走
行車線での操舵トルクの変動を抑制防止することができ
る。
When the motor supply current limit value i L is the relatively small predetermined value i Lo , a larger decreasing rate of change Hi is set for the same vehicle speed V, that is, the steering torque is insufficient. At times, the steering torque can be reduced quickly to prepare for a sudden change in the steering torque during a failure. When the motor supply current limit value i L is the relatively large predetermined value i Hi , a smaller change rate Hi of the increasing slope is set for the same vehicle speed V, that is, slowly when the steering torque is increased. By changing the steering torque, it is possible to prevent the fluctuation of the steering torque in the traveling lane in which the turning is alternately repeated.

【0063】また、この演算処理では、モータ供給電流
制限値iL が前記比較的小さい所定値iLoであるとき、
即ち操舵トルクを不足させるときには、比較的小さな所
定値yLLo を車線追従走行逸脱を判定するための横変位
閾値yL に設定する。これは、図7の演算処理のステッ
プS47で、検出された相対横変位の絶対値|y|が横
変位閾値yL 以上であったときに、ステップS48で警
報を発生するようにするためのものである。前述のよう
に、操舵トルクを不足させるときには、運転者が自ら操
舵トルクを付与する必要があり、そのようにしないと走
行車線から逸脱する恐れがある。そこで、本実施形態で
は、操舵トルクを不足させるときには、車線追従走行逸
脱を判定するための横変位閾値yL を小さな値とし、逸
脱しそうなときを速やかに警報で運転者に認識させるよ
うにしている。
In this calculation process, when the motor supply current limit value i L is the relatively small predetermined value i Lo ,
That is, when the steering torque is insufficient, a relatively small predetermined value y LLo is set as a lateral displacement threshold value y L for determining lane-following traveling deviation. This is for generating an alarm in step S48 when the absolute value | y | of the detected relative lateral displacement is equal to or greater than the lateral displacement threshold y L in step S47 of the arithmetic processing in FIG. Things. As described above, when the steering torque is insufficient, the driver needs to apply the steering torque by himself / herself, or the driver may deviate from the traveling lane. Therefore, in this embodiment, when to insufficient steering torque, a smaller value of the lateral displacement threshold y L for determining the lane keeping running deviation, so as to recognize the driver in promptly alert when deviating likely I have.

【0064】また、この演算処理では、モータ供給電流
制限値iL が前記比較的小さい所定値iLoであるとき、
即ち操舵トルクを不足させるときには、モータ供給電流
にアシストトルク変動信号を付加するようにしている。
これは、前述のようにステアリングホイールを振動させ
たり、操舵トルクをステップ的に減少させたりするもの
であり、これにより運転者は操舵トルクが減少されるこ
と、つまり操舵トルクが不足することを速やかに認識す
ることができる。
In this calculation process, when the motor supply current limit value i L is the relatively small predetermined value i Lo ,
That is, when the steering torque is insufficient, an assist torque variation signal is added to the motor supply current.
As described above, the steering wheel is vibrated or the steering torque is reduced stepwise, so that the driver can quickly determine that the steering torque is reduced, that is, the steering torque is insufficient. Can be recognized.

【0065】図10は、前記図7の演算処理によるモー
タ供給電流のタイミングチャートである。なお、図中の
走行車線情報は、“1”で走行車線検出を、“0”で走
行車線非検出を示す。ここでは、曲率半径ρが前記比較
的小さい所定値ρ1 以上の走行車線を走行している状態
から、時刻t21以後、当該所定値ρ1 以下の曲率半径の
走行車線を走行し、その後、時刻t25以後、前記比較的
大きい所定値ρ2 以上の曲率半径の走行車線に移行す
る。また、前記時刻t21から時刻t25までの間には、時
刻t23から時刻t24まで、前記時刻t25以後では、時刻
26から時刻t27まで、カメラ25による走行車線を見
失っている。
FIG. 10 is a timing chart of the motor supply current by the calculation processing of FIG. It should be noted that the traveling lane information in the drawing indicates “1” to indicate traveling lane detection and “0” to indicate no traveling lane detection. Here, the state in which the curvature radius [rho is traveling the relatively small predetermined value [rho 1 or more driving lane, the time t 21 after travels the predetermined value [rho 1 following the radius of curvature of the traffic lane, then time t 25 after, proceeds to the larger predetermined value [rho 2 or more the radius of curvature of the traffic lane. Also, until time t 25 from the time t 21, from the time t 23 to the time t 24, and in the time t 25 since, from the time t 26 to time t 27, which lost the driving lane by the camera 25 .

【0066】このタイミングチャートでは、前記時刻t
21まで、モータ供給電流制限値iLは比較的大きな所定
値iHiであり、時刻t21から時刻t25まで比較的小さな
所定値iLoであり、時刻t25以後、再び所定値iHiであ
る。前述のように、この比較的大きな所定値iHiは、凡
そ必要な操舵アシストトルクの全領域をカバーできる程
度の大きな電流値であり、逆に比較的小さな所定値iLo
は、フェイルが発生して供給電流が停止されても操舵ト
ルクが急変しない程度の小さな電流値である。
In this timing chart, the time t
Until 21 , the motor supply current limit value i L is a relatively large predetermined value i Hi , a relatively small predetermined value i Lo from time t 21 to time t 25 , and after time t 25 , the motor supply current limit value i L is again a predetermined value i Hi . is there. As described above, the relatively large predetermined value i Hi is a large current value that can cover almost the entire region of the necessary steering assist torque, and conversely, the relatively small predetermined value i Lo
Is a small current value such that the steering torque does not suddenly change even if a failure occurs and the supply current is stopped.

【0067】そのため、時刻t21までは、前記図7の演
算処理のステップS29で走行車線の曲率半径ρに応じ
て算出された基準モータ供給電流iM0がそのままモータ
供給電流iM として出力される。一方、時刻t21でモー
タ供給電流制限値iL が比較的小さな所定値iLoに切り
替えられるため、当該時刻t21以後、図7の演算処理の
ステップS39からステップS40を経てステップS4
2に移行するフローが繰り返され、その結果、モータ供
給電流iM は、ステップS37で設定された変化率Hi
で制限値iL (=iLo)に漸近されてゆき、時刻t22
制限値iL に一致又はほぼ一致すると、図7の演算処理
のステップS41からステップS43に移行するフロー
に切り替えられるため、それ以後、モータ供給電流iM
は比較的小さな所定値iLoからなる制限値iL に保持さ
れる。その後、前記時刻t23から時刻t24まで走行車線
を見失うが、その場合には前記図7の演算処理のステッ
プS21からステップS22以後に移行し、推定曲率半
径ρ^に応じたモータ供給電流制限値iL 、つまり前記
比較的小さな所定値iLoが設定され続ける。
[0067] Therefore, until the time t 21, the 7 reference motor supply current i M0 calculated according to the radius of curvature ρ of the traffic lane in step S29 of the arithmetic processing is outputted as a motor supply current i M intact . Meanwhile, since the motor supply current limit i L is switched to a relatively small predetermined value i Lo at time t 21, step through the time t 21 after the step S40 from the step S39 of the arithmetic processing of Fig. 7 S4
2 is repeated, and as a result, the motor supply current i M changes at the rate of change Hi set in step S37.
In Yuki it is asymptotic to limit i L (= i Lo), match or when substantially matches the limit value i L at time t 22, since it is switched to the flow moves from step S41 in the arithmetic processing of Fig. 7 to step S43 , And thereafter, the motor supply current i M
Is held at a limit value i L consisting of a relatively small predetermined value i Lo . Thereafter, missing the traffic lane from the time t 23 to the time t 24, and proceeds to S22 after step from the step S21 of the arithmetic processing of FIG. 7 in that case, the motor supply current limit corresponding to the estimated radius of curvature [rho ^ The value i L , that is, the relatively small predetermined value i Lo continues to be set.

【0068】このようにモータ供給電流iM が比較的小
さな制限値iL (=iLo)に保持されるということは、
操舵アシストトルクは不足している。そのため、運転者
は自らステアリングホイールを操舵しなければならない
が、逆にフェイルが発生しても操舵トルクは急変しな
い。そして、前記時刻t25で走行車線曲率半径ρが所定
値ρ2 以上となってからはモータ供給電流制限値iL
比較的大きな所定値iHiに切り替えられるので、当該時
刻t25以後、図7の演算処理のステップS39からステ
ップS41を経てステップS42に移行するフローが繰
り返され、その結果、モータ供給電流iM は、ステップ
S38で設定された変化率Hiで制限値iL (=iHi
に向けて漸近されてゆく。その間、時刻t26から時刻t
27まで走行車線を見失うが、前述と同様に算出した推定
曲率半径ρ^に基づいてモータ供給電流制限値iL を比
較的大きな所定値iHiに設定し続け、その間もモータ供
給電流iM は変化率Hiで制限値iL (=iHi)に向け
て漸近され続ける。
The fact that the motor supply current i M is held at the relatively small limit value i L (= i Lo ) means that
The steering assist torque is insufficient. Therefore, the driver has to steer the steering wheel by himself, but the steering torque does not change suddenly even if a failure occurs. Since the time t 25 in lane curvature radius [rho motor supply current limit i L from becoming a predetermined value [rho 2 or is switched to a relatively large predetermined value i Hi, the time t 25 after, Figure 7 is repeated from step S39 to step S42 via step S41. As a result, the motor supply current i M is limited to the limit value i L (= i Hi at the rate of change Hi set in step S38). )
It is asymptotic toward. Meanwhile, the time from the time t 26 t
To 27 missing the traffic lane, but continue to set the motor supply current limit i L based on the estimated radius of curvature [rho ^ calculated in the same manner as described above to a relatively large predetermined value i Hi, the motor supply current i M also during It keeps asymptotic toward the limit value i L (= i Hi ) at the change rate Hi.

【0069】やがて、時刻t27で走行車線を再び検出し
たが、その時点ではモータ供給電流iM が基準モータ供
給電流iM0に一致しておらず、その後、時刻t28で増加
されるモータ供給電流iM が前記図7の演算処理のステ
ップS29で算出される基準モータ供給電流iM0に一致
又はほぼ一致すると、図7の演算処理のステップS41
からステップS43に移行するフローに切り替えられる
ため、それ以後、前記走行車線の曲率半径ρに応じて算
出された基準モータ供給電流iM0がそのままモータ供給
電流iM として出力される。
The traveling lane was detected again at time t 27 , but at that time, the motor supply current i M did not match the reference motor supply current i M0, and the motor supply current increased at time t 28. When the current i M matches or almost matches the reference motor supply current i M0 calculated in step S29 of the calculation processing of FIG. 7, step S41 of the calculation processing of FIG.
Is switched to the flow from step to step S43, and thereafter, the reference motor supply current i M0 calculated according to the radius of curvature ρ of the traveling lane is output as it is as the motor supply current i M.

【0070】このように、本実施形態の車線追従走行制
御装置では、検出された走行車線の曲率半径ρが所定値
ρ1 又は所定値ρ2 より小さいとき、モータ供給電流制
限値iL を比較的小さな所定値iLoに設定する構成とし
たため、フェイル時の操舵トルクの急変を抑制防止する
ことができる。以上より、前記操舵角センサ21及び図
7の演算処理のステップS23及びステップS22が本
発明の操舵角検出手段を構成し、以下同様に、前記単眼
カメラ25が画像情報検出手段を構成し、前記カメラコ
ントローラ26及び図7の演算処理のステップS23が
走行車線情報検出手段を構成し、前記モータ16が操舵
トルク発生手段を構成し、図7の演算処理全体及び前記
コントロールユニット10が操舵トルク制御手段を構成
し、図7の演算処理のステップS28及びステップS2
9が供給電流算出手段を構成し、図7の演算処理のステ
ップS30及びステップS36が供給電流制限値設定手
段を構成し、図7の演算処理のステップS31、ステッ
プS37、ステップS38、ステップS42が供給電流
漸近手段を構成し、前記車輪速センサ22及び図7の演
算処理のステップS22及びステップS23が車速検出
手段を構成し、前記横加速度センサ23及び図7の演算
処理のステップS22及びステップS23が横加速度検
出手段を構成し、図7の演算処理のステップS32〜ス
テップS34が曲率半径算出手段を構成し、前記カメラ
コントローラ26及び図7の演算処理のステップS23
が横変位検出手段を構成し、図7の演算処理のステップ
S43、ステップS44、ステップS47が逸脱判定手
段を構成し、図7の演算処理のステップS46が操舵ト
ルク変動付加手段を構成している。
As described above, in the lane-following traveling control device of this embodiment, when the detected curvature radius ρ of the traveling lane is smaller than the predetermined value ρ 1 or the predetermined value ρ 2 , the motor supply current limit value i L is compared. Since the predetermined value i Lo is set to a very small value, it is possible to prevent a sudden change in the steering torque at the time of a failure. As described above, the steering angle sensor 21 and steps S23 and S22 of the calculation processing in FIG. 7 constitute a steering angle detecting means of the present invention, and similarly, the monocular camera 25 constitutes an image information detecting means, and The camera controller 26 and step S23 of the arithmetic processing of FIG. 7 constitute a traveling lane information detecting means, the motor 16 constitutes a steering torque generating means, and the entire arithmetic processing of FIG. 7 and the control unit 10 constitute a steering torque control means. And steps S28 and S2 of the arithmetic processing of FIG.
9 constitutes supply current calculation means, steps S30 and S36 of the calculation processing of FIG. 7 constitute supply current limit value setting means, and steps S31, S37, S38 and S42 of the calculation processing of FIG. The supply current asymptotic means is constituted, the wheel speed sensor 22 and steps S22 and S23 of the calculation processing of FIG. 7 constitute vehicle speed detection means, and the lateral acceleration sensor 23 and steps S22 and S23 of the calculation processing of FIG. Constitutes a lateral acceleration detecting means, and steps S32 to S34 of the arithmetic processing of FIG. 7 constitute a radius of curvature calculating means, and the camera controller 26 and step S23 of the arithmetic processing of FIG.
Constitute the lateral displacement detecting means, steps S43, S44, and S47 of the arithmetic processing in FIG. 7 constitute the deviation determining means, and step S46 of the arithmetic processing in FIG. 7 constitutes the steering torque fluctuation adding means. .

【0071】なお、前記実施形態では、目標操舵角θ*
をヨー角Φ、相対横偏位y及び道路曲率半径ρに基づい
て算出する場合について説明したが、これに限定される
もではなく、相対横偏位yと道路曲率半径ρとに基づい
て目標操舵角θ* を算出するようにしてもよく、さらに
は車速Vと道路曲率半径ρとに基づいて目標操舵角θ*
を算出したり、GPS機能を使用して現在位置を把握
し、ナビゲーションシステムの地図情報から道路曲率半
径ρを算出して目標操舵角θ* を算出するようにしても
よい。
In the above embodiment, the target steering angle θ *
Has been described based on the yaw angle Φ, the relative lateral deviation y and the road curvature radius ρ, but the present invention is not limited to this. The target is calculated based on the relative lateral deviation y and the road curvature radius ρ. The steering angle θ * may be calculated, and further, the target steering angle θ * may be calculated based on the vehicle speed V and the road curvature radius ρ .
Or the current steering position may be grasped by using the GPS function, and the target steering angle θ * may be calculated by calculating the road curvature radius ρ from the map information of the navigation system.

【0072】また、前記実施形態では、コントロールユ
ニットの演算処理をマイクロコンピュータによって行わ
せたが、これに代えて各種の理論回路を組合せて構成す
るようにしてもよい。
Further, in the above-described embodiment, the arithmetic processing of the control unit is performed by the microcomputer. However, instead of this, various theoretical circuits may be combined.

【図面の簡単な説明】[Brief description of the drawings]

【図1】本発明の車線追従走行制御装置の一実施形態を
示す概略構成図である。
FIG. 1 is a schematic configuration diagram showing an embodiment of a lane-following traveling control device of the present invention.

【図2】制御操舵方向、横加速度方向を説明する説明図
である。
FIG. 2 is an explanatory diagram illustrating a control steering direction and a lateral acceleration direction.

【図3】車線追従走行制御のための演算処理の第1実施
形態を示すフローチャートである。
FIG. 3 is a flowchart illustrating a first embodiment of a calculation process for lane-following traveling control.

【図4】操舵サーボ系の一例を示すブロック線図であ
る。
FIG. 4 is a block diagram illustrating an example of a steering servo system.

【図5】供給電流制限値設定のための制御マップであ
る。
FIG. 5 is a control map for setting a supply current limit value.

【図6】図3の演算処理によるタイミングチャートであ
る。
FIG. 6 is a timing chart according to the calculation processing of FIG. 3;

【図7】車線追従走行制御のための演算処理の第2実施
形態を示すフローチャートである。
FIG. 7 is a flowchart illustrating a second embodiment of a calculation process for lane-following traveling control.

【図8】ローパスフィルタのカットオフ周波数を設定す
るための制御マップである。
FIG. 8 is a control map for setting a cutoff frequency of a low-pass filter.

【図9】供給電流変化率を設定するための制御マップで
ある。
FIG. 9 is a control map for setting a supply current change rate.

【図10】図3の演算処理によるタイミングチャートで
ある。
FIG. 10 is a timing chart according to the calculation processing of FIG. 3;

【符号の説明】[Explanation of symbols]

2はラック 3はピニオン 4はステアリングホイール 5はステアリングシャフト 10はコントロールユニット 13は操舵機構 16は自動操舵用モータ 21は操舵角センサ 22は車速センサ 23は横加速度センサ 25は単眼カメラ 26はカメラコントローラ 2 is a rack 3 is a pinion 4 is a steering wheel 5 is a steering shaft 10 is a control unit 13 is a steering mechanism 16 is an automatic steering motor 21 is a steering angle sensor 22 is a vehicle speed sensor 23 is a lateral acceleration sensor 25 is a monocular camera 26 is a camera controller

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.7 識別記号 FI テーマコート゛(参考) G08G 1/16 G08G 1/16 C 5H301 // B62D 101:00 B62D 101:00 111:00 111:00 113:00 113:00 Fターム(参考) 3D032 CC03 CC08 CC32 CC39 CC46 DA03 DA23 DA24 DA27 DA29 DA32 DA84 DA88 DC01 DC02 DC03 DC07 DC08 DC09 DC12 DC21 DC29 DC33 DC34 DD02 DD05 DD10 DD17 DE03 DE05 DE08 EA01 EB11 EC23 EC24 GG01 3D033 CA13 CA14 CA17 CA21 CA31 CA33 3D044 AA01 AA24 AA41 AB01 AC26 AC31 AC56 3G093 AA01 BA04 BA23 CB09 CB10 DB05 DB18 5H180 AA01 CC04 LL09 LL15 5H301 AA03 CC06 EE07 EE12 EE27 GG09 GG14 LL11 ──────────────────────────────────────────────────続 き Continued on the front page (51) Int.Cl. 7 Identification symbol FI Theme coat ゛ (Reference) G08G 1/16 G08G 1/16 C 5H301 // B62D 101: 00 B62D 101: 00 111: 00 111: 00 113 : 00 113: 00 F term (reference) 3D032 CC03 CC08 CC32 CC39 CC46 DA03 DA23 DA24 DA27 DA29 DA32 DA84 DA88 DC01 DC02 DC03 DC07 DC08 DC09 DC12 DC21 DC29 DC33 DC34 DD02 DD05 DD10 DD17 DE03 DE05 DE08 EA01 EB11 EC23 EC24 GG01 3D033 CA13 CA17 CA21 CA31 CA33 3D044 AA01 AA24 AA41 AB01 AC26 AC31 AC56 3G093 AA01 BA04 BA23 CB09 CB10 DB05 DB18 5H180 AA01 CC04 LL09 LL15 5H301 AA03 CC06 EE07 EE12 EE27 GG09 GG14 LL11

Claims (10)

【特許請求の範囲】[Claims] 【請求項1】 操舵角を検出する操舵角検出手段と、自
車両の前方の道路画像を検出する画像情報検出手段と、
前記画像情報検出手段で検出された自車両前方の道路画
像から、少なくとも走行車線の曲率半径を含む走行車線
情報を検出する走行車線情報検出手段と、供給電流に応
じた操舵トルクを発生させる操舵トルク発生手段と、走
行車線に追従するために必要な操舵トルクを前記操舵ト
ルク発生手段で発生させる供給電流を出力する操舵トル
ク制御手段とを備え、前記操舵トルク制御手段は、少な
くとも前記走行車線情報検出手段で検出された走行車線
情報及び前記操舵角検出手段で検出された操舵角に基づ
いて、前記走行車線に追従するために必要な操舵トルク
を前記操舵トルク発生手段で発生させる供給電流を算出
する供給電流算出手段と、前記走行車線情報検出手段で
検出された走行車線の曲率半径に基づいて前記操舵トル
ク発生手段への供給電流の制限値を設定する供給電流制
限値設定手段とを備えたことを特徴とする車線追従走行
制御装置。
1. A steering angle detecting means for detecting a steering angle, an image information detecting means for detecting a road image in front of a host vehicle,
Traveling lane information detecting means for detecting traveling lane information including at least a radius of curvature of the traveling lane from a road image ahead of the host vehicle detected by the image information detecting means; and a steering torque for generating a steering torque according to the supplied current. Generating means, and steering torque control means for outputting a supply current for causing the steering torque generating means to generate a steering torque required to follow the travel lane, wherein the steering torque control means detects at least the travel lane information. Calculating a supply current for causing the steering torque generating means to generate a steering torque necessary for following the travel lane based on the travel lane information detected by the means and the steering angle detected by the steering angle detection means. Supply current calculation means, and supply to the steering torque generation means based on the radius of curvature of the travel lane detected by the travel lane information detection means. Lane following distance control device being characterized in that a supply current limit value setting means for setting a limit value of the current.
【請求項2】 前記供給電流制限値設定手段は、前記走
行車線情報検出手段で検出された走行車線の曲率半径が
小さいとき、供給電流の制限値を小さく設定することを
特徴とする請求項1に記載の車線追従走行制御装置。
2. The supply current limit value setting unit, when the curvature radius of the traveling lane detected by the traveling lane information detection unit is small, sets the supply current limit value small. 5. The lane-following travel control device according to claim 1.
【請求項3】 前記操舵トルク制御手段は、前記供給電
流算出手段で算出された供給電流を、前記供給電流制限
値設定手段で設定された供給電流の制限値に次第に近づ
けて前記操舵トルク発生手段への供給電流とする供給電
流漸近手段を備え、当該供給電流漸近手段は、供給電流
を減少するときの変化率と当該供給電流を増大するとき
の変化率とを個別の調整可能とし、且つ供給電流を減少
するときの変化率を増大するときの変化率よりも大きく
設定することを特徴とする請求項2に記載の車線追従走
行制御装置。
3. The steering torque generating means according to claim 1, wherein said steering torque control means gradually brings the supply current calculated by said supply current calculation means closer to a supply current limit value set by said supply current limit value setting means. Supply current asymptotic means for supplying current to the supply current, the supply current asymptotic means makes it possible to individually adjust the rate of change when decreasing the supply current and the rate of change when increasing the supply current, and The lane-following travel control device according to claim 2, wherein the change rate when the current is decreased is set to be larger than the change rate when the current is increased.
【請求項4】 自車両の走行速度を検出する車速検出手
段を備え、前記供給電流漸近手段は、前記車速検出手段
で検出された自車両の走行速度が大きいとき、供給電流
を減少するとき及び増加するときの変化率を大きくする
ことを特徴とする請求項3に記載の車線追従走行制御装
置。
4. A vehicle speed detecting means for detecting a running speed of the own vehicle, wherein the supply current asymptotic means is used when the running speed of the own vehicle detected by the vehicle speed detecting means is high, when the supply current is reduced, and 4. The lane-following travel control device according to claim 3, wherein the rate of change when increasing is increased.
【請求項5】 前記供給電流制限値設定手段は、前記走
行車線情報検出手段が走行車線を検出できなくなったと
きに前記供給電流の制限値を保持することを特徴とする
請求項1乃至4の何れかに記載の車線追従走行制御装
置。
5. The supply current limit value setting means according to claim 1, wherein said supply current limit value is held when said travel lane information detecting means cannot detect a travel lane. The lane following travel control device according to any one of the above.
【請求項6】 自車両に発生する横加速度を検出する横
加速度検出手段を備えると共に、前記操舵トルク制御手
段は、少なくとも前記横加速度検出手段で検出された横
加速度から走行車線の曲率半径を算出する曲率半径算出
手段を備え、前記供給電流制限値設定手段は、前記走行
車線情報検出手段が走行車線を検出できなくなったとき
に前記曲率半径算出手段で算出された走行車線の曲率半
径に基づいて供給電流の制限値を設定することを特徴と
する請求項1乃至5の何れかに記載の車線追従走行制御
装置。
6. A lateral acceleration detecting means for detecting a lateral acceleration generated in the host vehicle, and said steering torque control means calculates a radius of curvature of a traveling lane from at least the lateral acceleration detected by said lateral acceleration detecting means. The supply current limit value setting means, based on the curvature radius of the traveling lane calculated by the curvature radius calculation means when the traveling lane information detection means cannot detect the traveling lane. The lane-following travel control device according to any one of claims 1 to 5, wherein a limit value of the supply current is set.
【請求項7】 前記曲率半径算出手段は、前記走行車線
情報検出手段が走行車線を検出しているときに、前記横
加速度検出手段で検出された横加速度から算出した走行
車線の曲率半径と検出された走行車線の曲率半径との誤
差を算出することを特徴とする請求項6に記載の車線追
従走行制御装置。
7. The method according to claim 7, wherein the curvature radius calculating unit detects the curvature radius of the traveling lane calculated from the lateral acceleration detected by the lateral acceleration detecting unit when the traveling lane information detecting unit detects the traveling lane. The lane-following travel control device according to claim 6, wherein an error from the calculated radius of curvature of the travel lane is calculated.
【請求項8】 自車両の走行速度を検出する車速検出手
段を備えると共に、前記曲率半径算出手段は、前記横加
速度検出手段で検出された横加速度をローパスフィルタ
処理するローパスフィルタを備えると共に、前記車速検
出手段で検出された自車両の走行速度が小さいほど、前
記ローパスフィルタのカットオフ周波数を小さく設定す
ることを特徴とする請求項6又は7に記載の車線追従走
行制御装置。
8. A vehicle, comprising: a vehicle speed detecting means for detecting a traveling speed of the host vehicle; wherein the curvature radius calculating means includes a low-pass filter for performing a low-pass filtering process on the lateral acceleration detected by the lateral acceleration detecting means; 8. The lane-following traveling control device according to claim 6, wherein the cutoff frequency of the low-pass filter is set smaller as the traveling speed of the host vehicle detected by the vehicle speed detecting unit is lower.
【請求項9】 前記走行車線情報検出手段は、自車両の
走行車線に対する横変位を検出する横変位検出手段を備
えると共に、前記操舵トルク制御手段は、前記横変位検
出手段で検出された自車両の走行車線に対する横変位が
所定値以上となったときに走行車線追従走行が逸脱した
と判定する逸脱判定手段を備え、当該逸脱判定手段は、
前記供給電流制限値設定手段が小さな制限値を設定し、
操舵トルク発生手段への供給電流が小さく制限されてい
るときに、前記走行車線追従走行の逸脱を判定する横変
位の所定値を小さく設定することを特徴とする請求項1
乃至8の何れかに記載の車線追従走行制御装置。
9. The driving lane information detecting means includes a lateral displacement detecting means for detecting a lateral displacement of the host vehicle with respect to the driving lane, and the steering torque control means includes a host vehicle detected by the lateral displacement detecting means. When the lateral displacement with respect to the traveling lane is equal to or more than a predetermined value, the traveling lane following traveling is deviated.
The supply current limit value setting means sets a small limit value,
2. The method according to claim 1, wherein when the supply current to the steering torque generating means is limited to a small value, a predetermined value of the lateral displacement for judging the deviation from the traveling lane-following traveling is set small.
The lane-following travel control device according to any one of claims 1 to 8.
【請求項10】 前記操舵トルク制御手段は、前記供給
電流制限値設定手段が小さな制限値を設定し、操舵トル
ク発生手段への供給電流が小さく制限されているとき
に、操舵トルクの変動を与える操舵トルク変動付加手段
を備えることを特徴とする請求項1乃至9の何れかに記
載の車線追従走行制御装置。
10. The steering torque control means provides a change in steering torque when the supply current limit value setting means sets a small limit value and the supply current to the steering torque generation means is limited to a small value. The lane-following travel control device according to any one of claims 1 to 9, further comprising a steering torque variation adding unit.
JP2001112119A 2001-04-11 2001-04-11 Lane tracking control device Expired - Fee Related JP3709806B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2001112119A JP3709806B2 (en) 2001-04-11 2001-04-11 Lane tracking control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2001112119A JP3709806B2 (en) 2001-04-11 2001-04-11 Lane tracking control device

Publications (2)

Publication Number Publication Date
JP2002308129A true JP2002308129A (en) 2002-10-23
JP3709806B2 JP3709806B2 (en) 2005-10-26

Family

ID=18963587

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001112119A Expired - Fee Related JP3709806B2 (en) 2001-04-11 2001-04-11 Lane tracking control device

Country Status (1)

Country Link
JP (1) JP3709806B2 (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007038702A (en) * 2005-07-29 2007-02-15 Toyota Motor Corp Steering supporting device
US20090265062A1 (en) * 2006-08-16 2009-10-22 Toyota Jidosha Kabushiki Kaisha Steering support device
JP2015157612A (en) * 2014-02-25 2015-09-03 株式会社デンソー vehicle behavior control device
KR20190043270A (en) * 2017-10-18 2019-04-26 현대자동차주식회사 Apparatus and method for estimating redius of curvature of vehicle
JP2019123276A (en) * 2018-01-12 2019-07-25 三菱電機株式会社 Steering controller, electric power steering controller and steering control method
JP7452522B2 (en) 2021-12-01 2024-03-19 トヨタ自動車株式会社 Control method, control device, and control program

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007038702A (en) * 2005-07-29 2007-02-15 Toyota Motor Corp Steering supporting device
US20090265062A1 (en) * 2006-08-16 2009-10-22 Toyota Jidosha Kabushiki Kaisha Steering support device
US8676441B2 (en) * 2006-08-16 2014-03-18 Toyota Jidosha Kabushiki Kaisha Steering support device
JP2015157612A (en) * 2014-02-25 2015-09-03 株式会社デンソー vehicle behavior control device
KR20190043270A (en) * 2017-10-18 2019-04-26 현대자동차주식회사 Apparatus and method for estimating redius of curvature of vehicle
KR102375149B1 (en) 2017-10-18 2022-03-16 현대자동차주식회사 Apparatus and method for estimating redius of curvature of vehicle
JP2019123276A (en) * 2018-01-12 2019-07-25 三菱電機株式会社 Steering controller, electric power steering controller and steering control method
JP7452522B2 (en) 2021-12-01 2024-03-19 トヨタ自動車株式会社 Control method, control device, and control program

Also Published As

Publication number Publication date
JP3709806B2 (en) 2005-10-26

Similar Documents

Publication Publication Date Title
US6256561B1 (en) Vehicle steering control system
US20210253164A1 (en) Steering control apparatus
JP6743719B2 (en) Vehicle steering assist device
JP2002019634A (en) Control device for lane follow up driving
JP6751511B2 (en) Steering support device
CN104583056A (en) Electric power steering device
US20210245796A1 (en) Steering control device
CN104661898A (en) Electric power steering device
JP2001010519A (en) Vehicle steering control device
US10392019B2 (en) Vehicle controller
CN104661896A (en) Electric power steering device
JP2002120744A (en) Lane keep assist control device
JP2018177120A (en) Automatic drive system
US11091195B2 (en) Motor control device and motor control method
JP2020168918A (en) Steering gear
JP7028115B2 (en) Vehicle steering support device
JPH107010A (en) Vehicle motion control device
JP4430483B2 (en) Power steering device
JP2018127146A (en) Steering assist device for vehicle
JP2017202772A (en) Drive support method and drive support apparatus
JP3714269B2 (en) Automatic steering device
JP2002308129A (en) Lane follow-up running control device
JP2017202773A (en) Drive support method and drive support apparatus
JP2018114934A (en) Control device for vehicle
JP2002193126A (en) Lane follow-up control device of vehicle

Legal Events

Date Code Title Description
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20050630

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20050801

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080819

Year of fee payment: 3

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090819

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090819

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100819

Year of fee payment: 5

LAPS Cancellation because of no payment of annual fees