JPH0781602A - Automatic steering gear for vehicle - Google Patents
Automatic steering gear for vehicleInfo
- Publication number
- JPH0781602A JPH0781602A JP5230560A JP23056093A JPH0781602A JP H0781602 A JPH0781602 A JP H0781602A JP 5230560 A JP5230560 A JP 5230560A JP 23056093 A JP23056093 A JP 23056093A JP H0781602 A JPH0781602 A JP H0781602A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- steering
- angle
- image information
- deviation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 230000010365 information processing Effects 0.000 claims abstract description 29
- 238000012545 processing Methods 0.000 claims abstract description 20
- 238000003384 imaging method Methods 0.000 claims description 9
- 230000007423 decrease Effects 0.000 claims description 3
- 238000013459 approach Methods 0.000 abstract description 2
- 238000001514 detection method Methods 0.000 description 29
- 238000010586 diagram Methods 0.000 description 26
- 230000001133 acceleration Effects 0.000 description 18
- 230000036461 convulsion Effects 0.000 description 12
- 239000003921 oil Substances 0.000 description 11
- 238000000034 method Methods 0.000 description 10
- 239000010720 hydraulic oil Substances 0.000 description 9
- 230000006870 function Effects 0.000 description 6
- 230000000694 effects Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 238000012937 correction Methods 0.000 description 3
- 241000981595 Zoysia japonica Species 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 239000000047 product Substances 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 230000004043 responsiveness Effects 0.000 description 1
- 230000035807 sensation Effects 0.000 description 1
- 239000013589 supplement Substances 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Controls For Constant Speed Travelling (AREA)
- Image Processing (AREA)
- Closed-Circuit Television Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
【0001】[0001]
【産業上の利用分野】本発明は、自動車に用いて好適の
車両用自動操舵装置に関し、特に、道路の基準線と曲率
とを認識して滑らかに操舵できるようにした、車両用自
動操舵装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a vehicle automatic steering device suitable for use in an automobile, and more particularly to a vehicle automatic steering device capable of recognizing a reference line and a curvature of a road for smooth steering. Regarding
【0002】[0002]
【従来の技術】近年、自動車にそなえられた操舵機構に
おいて、例えば車両に各種のセンサを設け、これらのセ
ンサからの情報に基づいて制御信号を設定し、油圧や電
動モータ等により操舵機構を積極的、且つ自動的に操舵
させるような自動操舵装置又は自動操舵操舵付き車両が
多数提案されている。2. Description of the Related Art Recently, in a steering mechanism provided for an automobile, for example, various sensors are provided on the vehicle, a control signal is set based on information from these sensors, and the steering mechanism is positively activated by hydraulic pressure or an electric motor. There have been proposed a number of automatic steering devices or vehicles with automatic steering that automatically and automatically steer.
【0003】例えば、特開平3−137798号公報や
特開平4−504号公報には、このような自動操舵装置
が開示されており、また、このような自動操舵装置に関
する種々の技術はこれ以外にも多数提案されている。For example, Japanese Unexamined Patent Publication No. 3-137798 and Japanese Unexamined Patent Publication No. 4-504 disclose such an automatic steering device, and various techniques related to such an automatic steering device are other than the above. Has been proposed to many.
【0004】[0004]
【発明が解決しようとする課題】しかしながら、自動車
の走行状態や周囲の交通状況を正しく把握して操舵機構
を正確に制御しながら、乗員に違和感を与えずにあたか
も熟練したドライバが運転しているような自然な走行感
を実現するのは非常に困難であるという課題がある。However, it is as if a skilled driver is driving without giving a feeling of discomfort to the occupants while accurately grasping the traveling state of the automobile and the surrounding traffic conditions and accurately controlling the steering mechanism. There is a problem that it is very difficult to realize such a natural driving feeling.
【0005】本発明は、このような課題に鑑み創案され
たもので、人為的な操舵特性に近づけてより自然な走行
感を得られるようにした、車両用自動操舵装置を提供す
ることを目的とする。The present invention was conceived in view of the above problems, and an object thereof is to provide an automatic steering device for a vehicle, which can bring a more natural running feeling by approaching artificial steering characteristics. And
【0006】[0006]
【課題を解決するための手段】このため、請求項1記載
の本発明の車両用自動操舵装置は、車両の操舵輪を転舵
する操舵アクチュエータと、該車両前方の道路を撮像す
る撮像手段と、該撮像手段からの画像情報を処理する画
像情報処理手段と、該画像情報処理手段からの処理情報
に基づいて目標操舵角を設定しこの目標操舵角が得られ
るように該操舵アクチュエータの駆動を制御する制御手
段とをそなえ、該画像情報処理手段が、該画像情報に基
づいて、該道路の基準線に対する該車両の横偏差を算出
する横偏差算出手段と、該画像情報に基づいて、該車両
前方の道路方向に対する該車両の偏角を算出する偏角算
出手段とをそなえるとともに、該制御手段が、該横偏差
算出手段及び該偏角算出手段からの情報に基づいて、該
横偏差及び該偏角がいずれも減少していくように、該目
標操舵角を設定することを特徴としている。Therefore, an automatic vehicle steering system according to the present invention is a steering actuator for steering steered wheels of a vehicle, and an image pickup means for picking up an image of a road ahead of the vehicle. , An image information processing means for processing image information from the image pickup means, a target steering angle is set based on the processing information from the image information processing means, and the steering actuator is driven so as to obtain the target steering angle. A control means for controlling the image information processing means, wherein the image information processing means calculates the lateral deviation of the vehicle with respect to the reference line of the road based on the image information; and the lateral deviation calculation means based on the image information. And a deviation angle calculating means for calculating a deviation angle of the vehicle with respect to a road direction ahead of the vehicle, and the control means, based on the information from the lateral deviation calculating means and the deviation angle calculating means, The declination Both as decreases, it is characterized by setting the target steering angle.
【0007】また、請求項2記載の本発明の車両用自動
操舵装置は、請求項1記載の構成に加えて、該横偏差算
出手段が、該画像情報から得られる路面情報のうちの該
車両に最も近い地点の基準線位置情報を用いて該横偏差
を算出し、該偏角算出手段が、該画像情報から得られる
路面情報を用いて該車両から所定距離だけ離れた地点に
おける該偏角を算出するように設定されていることを特
徴としている。Further, in the vehicle automatic steering apparatus according to the present invention as defined in claim 2, in addition to the configuration according to claim 1, the lateral deviation calculating means includes the vehicle among the road surface information obtained from the image information. The lateral deviation is calculated using the reference line position information of the point closest to, and the deviation angle calculation means uses the road surface information obtained from the image information to calculate the deviation angle at a point away from the vehicle by a predetermined distance. It is characterized in that it is set to calculate
【0008】また、請求項3記載の本発明の車両用自動
操舵装置は、上述の請求項2記載の構成に加えて、該車
両の車速を検出する車速検出手段をそなえ、該偏角算出
手段が、該車速検出手段からの情報を受けて、該車両か
ら該車速に応じた距離だけ離れた地点における該偏角を
算出するように設定されていることを特徴としている。According to a third aspect of the present invention, there is provided a vehicle automatic steering device further comprising a vehicle speed detecting means for detecting a vehicle speed of the vehicle, in addition to the structure of the above-mentioned second aspect. However, it is set so that it receives the information from the vehicle speed detecting means and calculates the declination at a point distant from the vehicle by a distance corresponding to the vehicle speed.
【0009】また、請求項4記載の本発明の車両用自動
操舵装置は、上述の請求項2記載の構成に加えて、該偏
角算出手段が、該画像情報から得られる路面情報のうち
該車両から所定距離だけ離れた第1の地点における基準
線位置情報と、該第1の地点よりもさらに該車両から離
れた第2の地点における基準線位置情報とから、該偏角
を算出するように設定されていることを特徴としてい
る。According to a fourth aspect of the present invention, in addition to the configuration of the above-described second aspect, the vehicle automatic steering apparatus further comprises: The declination is calculated from reference line position information at a first point that is a predetermined distance away from the vehicle and reference line position information at a second point that is further away from the vehicle than the first point. It is characterized by being set to.
【0010】また、請求項5記載の本発明の車両用自動
操舵装置は、上述の請求項4記載の構成に加えて、該第
1の地点が、該画像情報から得られる路面情報のうちの
該車両に最も近い地点であることを特徴としている。ま
た、請求項6記載の本発明の車両用自動操舵装置は、上
述の請求項5記載の構成に加えて、該車両の車速を検出
する車速検出手段をそなえ、該第2の地点が、該車速検
出手段からの情報に基づいて、該車両から該車速に応じ
た距離だけ離れた地点であることを特徴としている。Further, in the vehicle automatic steering apparatus according to a fifth aspect of the present invention, in addition to the configuration according to the fourth aspect, the first point is included in road surface information obtained from the image information. It is characterized in that it is the closest point to the vehicle. Further, an automatic vehicle steering system according to a sixth aspect of the present invention includes a vehicle speed detecting means for detecting a vehicle speed of the vehicle in addition to the configuration of the fifth aspect, and the second point is the The vehicle is characterized in that it is a point distant from the vehicle by a distance corresponding to the vehicle speed based on the information from the vehicle speed detecting means.
【0011】また、請求項7記載の本発明の車両用自動
操舵装置は、車両の操舵輪を転舵する操舵アクチュエー
タと、該車両前方の道路を撮像する撮像手段と、該撮像
手段からの画像情報を処理する画像情報処理手段と、該
車両の車速を検出する車速検出手段と、該画像情報処理
手段からの処理情報に基づいて目標操舵角を設定し、こ
の目標操舵角が得られるように該操舵アクチュエータの
駆動を制御する制御手段とをそなえ、該画像情報処理手
段が、該画像情報から得られる路面情報を用いて該車両
から所定距離Kだけ離れた地点における偏角βを算出す
る偏角算出手段をそなえ、該制御手段が、予め記憶され
た車両のスタビリティファクタA及びホイールベースW
Bと、該車速検出手段から得られる車速Vと、該距離K
と、該偏角βとから、δ=(1+AV2 )・(WB/
K)・βの関係式に基づいて、目標操舵角δを設定する
ことを特徴としている。According to a seventh aspect of the present invention, there is provided an automatic vehicle steering system for a vehicle, wherein a steering actuator for steering steered wheels of a vehicle, an image pickup means for picking up an image of a road ahead of the vehicle, and an image from the image pickup means. An image information processing means for processing information, a vehicle speed detecting means for detecting the vehicle speed of the vehicle, and a target steering angle are set on the basis of processing information from the image information processing means so that the target steering angle can be obtained. The image processing means further comprises control means for controlling the drive of the steering actuator, and the image information processing means uses the road surface information obtained from the image information to calculate a deviation angle β at a point separated from the vehicle by a predetermined distance K. The control means further comprises angle calculation means, and the control means stores the vehicle stability factor A and the wheel base W stored in advance.
B, the vehicle speed V obtained from the vehicle speed detecting means, and the distance K
And the argument β, δ = (1 + AV 2 ) · (WB /
The target steering angle δ is set based on the relational expression of K) · β.
【0012】また、請求項8記載の本発明の車両用自動
操舵装置は、上述の請求項7記載の構成に加えて、該所
定距離Kが、該車両の車速の関数として与えられること
を特徴としている。Further, in the vehicle automatic steering apparatus according to the present invention of claim 8, in addition to the configuration of claim 7 described above, the predetermined distance K is given as a function of the vehicle speed of the vehicle. I am trying.
【0013】[0013]
【作用】上述の請求項1記載の本発明の車両用自動操舵
装置では、撮像手段により車両前方の道路が撮像される
と、この画像情報が画像情報処理手段により処理され
る。そして、制御手段では画像処理情報に基づいて目標
操舵角が設定されるとともに、制御手段により目標操舵
角が得られるように操舵アクチュエータが駆動され、操
舵輪が操舵される。In the vehicle automatic steering apparatus according to the first aspect of the present invention, when the image of the road ahead of the vehicle is picked up by the image pickup means, the image information is processed by the image information processing means. Then, the control means sets the target steering angle based on the image processing information, and the control means drives the steering actuator to steer the steered wheels so as to obtain the target steering angle.
【0014】この時、制御手段が、画像情報処理手段に
そなえられた横偏差算出手段及び該偏角算出手段からの
情報に基づいて、車両の横偏差及び偏角がいずれも減少
していくように操舵アクチュエータが制御される。ま
た、請求項2記載の本発明の車両用自動操舵装置では、
横偏差算出手段によって車両に最も近い地点の基準線位
置情報を用いて、車両の道路中心に対する横偏差が算出
される。これとともに、偏角算出手段により車両から所
定距離だけ離れた地点での偏角が算出される。At this time, the control means reduces both the lateral deviation and the deviation angle of the vehicle based on the information from the lateral deviation calculation means and the deviation angle calculation means provided in the image information processing means. The steering actuator is controlled by. Further, in the vehicle automatic steering device according to the second aspect of the present invention,
The lateral deviation calculating means calculates the lateral deviation of the vehicle from the center of the road by using the reference line position information of the point closest to the vehicle. At the same time, the declination calculation means calculates the declination at a point away from the vehicle by a predetermined distance.
【0015】また、請求項3記載の本発明の車両用自動
操舵装置では、偏角算出手段に車速検出手段からの車速
情報が入力されて、車両から車速に応じた距離だけ離れ
た地点における偏角が算出される。また、請求項4記載
の本発明の車両用自動操舵装置では、偏角算出手段によ
り、画像情報から得られる路面情報のうち車両から所定
距離だけ離れた第1の地点における基準線位置情報と、
第1の地点よりもさらに車両から離れた第2の地点にお
ける基準線位置情報とから偏角が算出される。Further, in the vehicle automatic steering apparatus according to the third aspect of the present invention, the vehicle speed information from the vehicle speed detecting means is input to the declination calculating means, and the deviation is obtained at a point distant from the vehicle by a distance corresponding to the vehicle speed. The angle is calculated. Further, in the vehicle automatic steering apparatus according to the present invention, the deviation angle calculating means includes reference line position information at a first point apart from the vehicle by a predetermined distance in the road surface information obtained from the image information,
The declination is calculated from the reference line position information at the second point further away from the vehicle than at the first point.
【0016】また、請求項5記載の本発明の車両用自動
操舵装置では、画像情報から得られる路面情報のうち車
両に最も近い地点が第1の地点となる。また、請求項6
記載の本発明の車両用自動操舵装置では、車速検出手段
により車両の車速が検出されると、この車速情報に基づ
いて、車両から車速に応じた距離だけ離れた地点が第2
の地点となる。In the vehicle automatic steering apparatus according to the fifth aspect of the present invention, the first point is the point closest to the vehicle in the road surface information obtained from the image information. In addition, claim 6
In the vehicle automatic steering device of the present invention described, when the vehicle speed of the vehicle is detected by the vehicle speed detecting means, a point separated by a distance corresponding to the vehicle speed from the vehicle is second based on the vehicle speed information.
It becomes the point of.
【0017】また、請求項7記載の本発明の車両用自動
操舵装置では、撮像手段により車両前方の道路が撮像さ
れると、画像情報処理手段において撮像手段からの画像
情報が処理される。そして、制御手段により画像の処理
情報に基づいて目標操舵角が設定され、この目標操舵角
が得られるように操舵アクチュエータが駆動される。こ
れにより、操舵輪が操舵される。In the vehicle automatic steering apparatus according to the present invention, when the road ahead of the vehicle is imaged by the image pickup means, the image information processing means processes the image information from the image pickup means. Then, the control means sets the target steering angle based on the processing information of the image, and the steering actuator is driven so as to obtain this target steering angle. As a result, the steered wheels are steered.
【0018】そして、偏角算出手段によって車両から所
定距離Kだけ離れた地点における偏角βが算出されると
ともに、制御手段において、予め記憶された車両のスタ
ビリティファクタA及びホイールベースWBと、車速検
出手段から得られる車速Vと、距離Kと、偏角βとから
目標操舵角δが、δ=(1+AV2 )・(WB/K)・
βの関係式に基づいて設定される。Then, the deviation angle calculating means calculates the deviation angle β at a point distant from the vehicle by a predetermined distance K, and the controlling means stores the vehicle stability factor A and the wheel base WB stored in advance, and the vehicle speed. Based on the vehicle speed V obtained from the detection means, the distance K, and the deviation angle β, the target steering angle δ is δ = (1 + AV 2 ) · (WB / K) ·
It is set based on the relational expression of β.
【0019】また、請求項8記載の本発明の車両用自動
操舵装置では、所定距離Kが、車両の車速の関数として
あたえられ、車速に応じて変化する。Further, in the vehicle automatic steering apparatus according to the present invention, the predetermined distance K is given as a function of the vehicle speed of the vehicle and changes according to the vehicle speed.
【0020】[0020]
【実施例】以下、図面により、本発明の一実施例として
の車両用自動操舵装置について説明すると、図1はその
機能構成をドライバの操舵操作時の各機能と対応させる
ように整理して示す機能ブロック図、図2はその要部構
成を示す模式的な構成図、図3はその曲率半径と偏角と
の関係を模式的に示す図であって車両上方から見た模式
図、図4はその車両の偏角と道路のカーブ半径との関係
を示すグラフ、図5はそのドライバ操舵による車両の偏
角と操舵角との関係を示すグラフ,図6はそのドライバ
操舵によるカーブを走行中の横加速度のピーク値と横ジ
ャーク(単位時間当りの横加速度の変化量)のピーク値
との関係を示すグラフ、図7はその自動操舵における操
舵開始距離と操舵速度との関係を示すグラフ、図8
(a)〜(f)はいずれもその白線認識方法を説明する
ための模式図、図9はその車速と操舵開始距離との関係
を示すグラフ、図10はその自動操舵とドライバ操舵と
の特性を示すグラフであって車速と操舵開始距離との関
係を示すグラフ、図11はその偏角の変動を説明するた
めの模式的な図であって車両上方から見た模式図、図1
2はその車両旋回時における車両と道路中心との偏差を
示す模式的な図であって車両上方から見た図、図13は
その偏角検出点を車速対応にした場合におけるゲインの
設定を説明する模式的なブロック図、図14はその偏角
検出点を固定式にした場合のゲインの設定を説明する模
式的なブロック図であって図13に対応する図、図15
〜図18はいずれもその効果を説明するための図であっ
て図15は屈曲路の一例を示す図、その操舵特性を示す
グラフであって(a)は自動操舵時とドライバ操舵時と
における屈曲路走行時の操舵角特性を示すグラフ(b)
は自動操舵時とドライバ操舵時とにおける屈曲路走行時
の車両の横加速度の特性を示すグラフ、図17は自動操
舵時とドライバ操舵時とにおける横加速度のピーク値と
横ジャークのピーク値との関係を示すグラフ、図18
(a)〜(c)は道路の基準線の認識の一例を説明する
ための図、図19はその操舵アクチュエータの全体構成
の一例を示す模式図、図20はその前方注視距離の設定
方法について説明するためのグラフであって図10に対
応するグラフ、図21はその偏角ゲインの設定方法を説
明するための図であって車両上方から見た模式図であ
る。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS A vehicle automatic steering apparatus as an embodiment of the present invention will be described below with reference to the drawings. FIG. 1 shows the functional configuration thereof so as to correspond to the respective functions at the time of steering operation of a driver. FIG. 4 is a functional block diagram, FIG. 2 is a schematic configuration diagram showing a configuration of a main part thereof, FIG. 3 is a diagram schematically showing a relationship between a radius of curvature and a declination, and a schematic view seen from above the vehicle, FIG. Is a graph showing the relationship between the vehicle declination and the curve radius of the road, FIG. 5 is a graph showing the relationship between the vehicle declination due to the driver steering and the steering angle, and FIG. 6 is traveling along the curve due to the driver steering. Is a graph showing the relationship between the peak value of the lateral acceleration and the peak value of the lateral jerk (the amount of change in the lateral acceleration per unit time). FIG. 7 is a graph showing the relationship between the steering start distance and the steering speed in the automatic steering. Figure 8
(A) to (f) are schematic diagrams for explaining the white line recognition method, FIG. 9 is a graph showing the relationship between the vehicle speed and the steering start distance, and FIG. 10 is a characteristic of the automatic steering and the driver steering. 1 is a graph showing the relationship between the vehicle speed and the steering start distance, and FIG. 11 is a schematic diagram for explaining the variation of the deviation angle, which is a schematic view seen from above the vehicle, FIG.
2 is a schematic diagram showing the deviation between the vehicle and the center of the road when the vehicle is turning, as viewed from above the vehicle, and FIG. 13 illustrates the gain setting when the declination detection point corresponds to the vehicle speed. 15 is a schematic block diagram for explaining gain setting when the declination detection point is fixed, and FIG. 15 is a schematic block diagram corresponding to FIG.
To FIG. 18 are views for explaining the effect, FIG. 15 is a view showing an example of a curved road, and a graph showing steering characteristics thereof. FIG. 18A is a graph at the time of automatic steering and at the time of driver steering. Graph (b) showing steering angle characteristics when traveling on a bend
FIG. 17 is a graph showing the characteristics of the lateral acceleration of the vehicle during traveling on a curved road during automatic steering and driver steering. FIG. 17 shows the lateral acceleration peak value and lateral jerk peak value during automatic steering and driver steering. Graph showing the relationship, FIG.
(A)-(c) is a figure for demonstrating an example of recognition of the reference line of a road, FIG. 19 is a schematic diagram which shows an example of the whole structure of the steering actuator, FIG. 20 is about the setting method of the front gaze distance. FIG. 21 is a graph for explaining the graph corresponding to FIG. 10, and FIG. 21 is a diagram for explaining the setting method of the declination gain, which is a schematic view seen from above the vehicle.
【0021】図2に示すように、車両1には、操舵輪2
を転舵させるための操舵アクチュエータ2Aと、この車
両前方の道路状態を撮像する撮像手段としてのカメラ3
と、このカメラ3からの画像情報を処理する画像情報処
理手段4と、操舵アクチュエータ2Aに対して制御信号
を設定する制御手段としてのコントローラ5とがそなえ
られている。As shown in FIG. 2, the vehicle 1 has steering wheels 2
A steering actuator 2A for steering the vehicle, and a camera 3 as an imaging means for imaging the road condition in front of the vehicle.
An image information processing means 4 for processing the image information from the camera 3 and a controller 5 as a control means for setting a control signal for the steering actuator 2A are provided.
【0022】つまり、この車両1は、カメラ3で撮像さ
れた画像に基づいて操舵輪2を自動的に転舵させるよう
な自動操舵車両であって、コントローラ5では、画像情
報処理手段4からの情報に基づいて、操舵輪2を制御す
るための制御量として目標操舵角が設定され、この目標
操舵角の設定量に応じて操舵アクチュエータ2Aが作動
するようになっている。That is, the vehicle 1 is an automatic steering vehicle that automatically steers the steered wheels 2 based on the image captured by the camera 3. Based on the information, a target steering angle is set as a control amount for controlling the steered wheels 2, and the steering actuator 2A is operated according to the set amount of the target steering angle.
【0023】ここで、この自動操舵装置の制御機能の構
成について説明する。ドライバが、操舵操作(舵角の変
更)を行なうのは、主に、車両1の走行方向が走行して
いる道路(走行レーン)の方向と合わなくなったときに
これを修正しようとする場合であり、これに加えて、車
両1が走行レーンを横方向(左右外方)にはみ出そうと
しているときにこれを修正しようとする場合が考えられ
る。走行方向が走行レーン方向と合わなくなるのは、曲
走路の走行中が考えられるが、直走路を走行していると
きにも車両自体の姿勢がヨー方向に動くことで走行方向
が走行レーン方向から外れる場合もある。Here, the structure of the control function of the automatic steering device will be described. The driver mainly performs the steering operation (changing the rudder angle) mainly when the traveling direction of the vehicle 1 is to be corrected when the traveling direction of the vehicle (traveling lane) does not match. In addition, in addition to this, there is a case in which the vehicle 1 tries to correct the traveling lane when it is about to extend laterally (outward and leftward). It is possible that the traveling direction does not match the traveling lane direction while traveling on a curved lane, but even when traveling on a straight lane, the posture of the vehicle itself moves in the yaw direction so that the traveling direction changes from the traveling lane direction. It may come off.
【0024】そこで、本装置では、主として、車両1の
走行方向を走行レーンの方向と合わせるように操舵を行
なって、これに、車両1の横方向位置の修正のための操
舵要素を付加するようになっている。また、人為的な操
舵(ドライバ操舵)では、ドライバが視覚で得た情報か
ら、車両と道路との相対的な状況を判断して、操舵操作
を行なっている。つまり、ドライバは、目から入った情
報に基づいて、車両1の走行方向と走行レーン方向との
相対関係(偏角)や、車両1の横方向の位置ずれ(横偏
差)を判断し、これらを修正するように操舵操作を行な
っている。Therefore, in the present apparatus, the steering is mainly performed so that the traveling direction of the vehicle 1 is aligned with the traveling lane direction, and a steering element for correcting the lateral position of the vehicle 1 is added thereto. It has become. Further, in artificial steering (driver steering), the driver performs a steering operation by judging the relative situation between the vehicle and the road from the information visually obtained by the driver. That is, the driver determines the relative relationship (deviation angle) between the traveling direction of the vehicle 1 and the traveling lane direction and the lateral displacement (lateral deviation) of the vehicle 1 based on the information entered from the eyes, and The steering operation is performed so as to correct.
【0025】ドライバが視覚で得る情報を整理すると、
道路のカーブの半径,車速,乗り心地(横加速度,横ジ
ャーク)の3つの要素に分類することができる。また、
一般に、曲走路の定常円及びこれに近い部分や直走路等
を走行している際(定常走行時)には、操舵角を一定に
保持しようとするので、ドライバは、操舵操作は走路の
曲率にあった操舵角δ0 を保持するように操舵を行な
う。これに対して、直走路から曲走路へ進入しようとす
る際(過渡走行時)には、曲走路のある程度手前から操
舵角δを曲走路の曲率に応じた操舵角δ0 に除々に増加
させていく。この場合、ドライバは、曲走路に入る地点
のどの程度手前から操舵を開始するか(すなわち、操舵
開始距離Dをどの程度にするか)、また、どの程度の割
合(操舵速度δV で操舵角δを増加させていくかを、そ
の時の車速や予想される乗り心地(横加速度のかかり具
合)等を考慮して設定する。When the information visually obtained by the driver is arranged,
It can be classified into three elements: road radius, vehicle speed, and riding comfort (lateral acceleration, lateral jerk). Also,
Generally, when traveling on a steady circle of a curved road, a portion close to this, a straight road, or the like (during steady running), the driver tries to keep the steering angle constant. Steering is performed so as to maintain a suitable steering angle δ 0 . On the other hand, when attempting to enter the straight track from the straight track (during transient running), the steering angle δ is gradually increased to a steering angle δ 0 corresponding to the curvature of the curved track from a certain degree before the curved track. To go. In this case, the driver needs to start steering before the point where the vehicle enters the curved road (that is, how much the steering start distance D should be), and what proportion (the steering angle δ V at the steering angle). Whether to increase δ is set in consideration of the vehicle speed at that time, the expected riding comfort (the degree of lateral acceleration), and the like.
【0026】つまり、ドライバが操舵操作に際して決定
する操舵要素を分類すると、操舵角δ0 ,操舵開始距離
(操舵開始タイミング)D,操舵速度δV に分けられ
る。本装置では、このような、ドライバ操舵と同様な手
法により自動操舵を行なうようになっている。そこで、
この装置では、ドライバの視覚系に対応した画像処理手
段4と、ドライバのデータ処理系に対応するように、操
舵に必要な各量、即ち、操舵角δ0 ,操舵開始距離D,
操舵速度δV を設定するコントローラ5とをそなえてい
るのである。That is, when classifying the steering elements determined by the driver during the steering operation, they are classified into a steering angle δ 0 , a steering start distance (steering start timing) D, and a steering speed δ V. In this device, automatic steering is performed by a method similar to such driver steering. Therefore,
In this device, the image processing means 4 corresponding to the driver's visual system and the respective amounts necessary for steering, that is, the steering angle δ 0 , the steering start distance D, so as to correspond to the driver's data processing system.
It has a controller 5 for setting the steering speed δ V.
【0027】ここで、まずドライバの視覚系に対応する
画像情報処理手段4について説明する。図1に示すよう
に、この画像情報処理手段4には、画像変換手段4Cと
横偏差算出手段7と偏角算出手段6と曲率状態推定手段
9とがそなえられている。そして、道路の状態がカメラ
3により撮像されると、このカメラ3からの原画像4A
が取り込まれ、次にこの原画像4Aが、画像変換手段4
Cにより、あたかも上方から見たような平面視画像4B
に変換されるようになっている。The image information processing means 4 corresponding to the visual system of the driver will be described first. As shown in FIG. 1, the image information processing means 4 is provided with an image converting means 4C, a lateral deviation calculating means 7, a deviation angle calculating means 6, and a curvature state estimating means 9. Then, when the state of the road is captured by the camera 3, the original image 4A from the camera 3 is captured.
Is taken in, and then the original image 4A is converted into the image conversion means 4
C shows a plan view image 4B as if it were viewed from above.
It is designed to be converted to.
【0028】偏角算出手段6では、平面視画像4Bに基
づいて車両1から所定距離だけ離れた地点(すなわち、
平面視画像4B内の所定の高さの地点)における偏角が
算出されるようになっている。この偏角とは、図1に示
すように、屈曲した道路中心線の接線と車両中心線とが
なす角である。また、偏角βは、以下のようにして算出
される。つまり、図1に示すように、車両から所定距離
だけ離れた第1の地点(第1検出点、図中には近地点と
示す)における基準線位置情報と、この近地点よりもさ
らに車両1から所定量離れた第2の地点(第2検出点、
図中には遠地点と示す)における基準線位置情報とか
ら、偏角βを算出するようになっている。なお、この例
では、第1検出点を横偏差の検出点、すなわちカメラ3
による画像情報のうち車両に最も近い地点としている。In the declination calculation means 6, a point separated from the vehicle 1 by a predetermined distance (that is,
The angle of deviation at a predetermined height in the planar view image 4B is calculated. This declination is the angle formed by the tangent to the curved road center line and the vehicle center line, as shown in FIG. Further, the argument β is calculated as follows. That is, as shown in FIG. 1, reference line position information at a first point (a first detection point, which is shown as a perigee in the figure) separated from the vehicle by a predetermined distance, and the position of the vehicle 1 further than the perigee. Second point separated by a fixed amount (second detection point,
The declination β is calculated from the reference line position information at the apogee (in the figure). In this example, the first detection point is the lateral deviation detection point, that is, the camera 3
Of the image information by, it is the closest point to the vehicle.
【0029】そして、偏角βは、これらの第1検出点と
第2検出点とを結んだ直線と、車両1の中心線とがなす
角として算出するようになっている。このようにして算
出される偏角は、第1検出点と第2検出点との中間地点
(図中×印)の偏角であり、すくなくとも車両1から一
定以上前方の地点の偏角である。さらに、曲率状態推定
手段9では、偏角算出手段6で算出された偏角βに基づ
いてカーブ半径Rを推定するようになっている。つま
り、カメラ3により撮像された道路の偏角βは、カーブ
半径Rを反映するための値として曲率状態推定手段9に
フィードフォワードされるようになっているのである。The deviation angle β is calculated as an angle formed by the straight line connecting the first detection point and the second detection point and the center line of the vehicle 1. The declination calculated in this way is the declination at the intermediate point (marked with X in the figure) between the first detection point and the second detection point, and at least the declination at a point ahead of the vehicle 1 by a certain amount or more. . Further, the curvature state estimating means 9 is adapted to estimate the curve radius R based on the argument β calculated by the argument calculating means 6. That is, the declination β of the road imaged by the camera 3 is fed forward to the curvature state estimating means 9 as a value for reflecting the curve radius R.
【0030】このカーブ半径Rの推定方法について説明
すると、図3に示すように、車両1から所定距離Kだけ
前方の偏角βが算出されると、偏角βが比較的小さい時
はカーブ半径Rと所定距離Kと偏角βとは、幾何学的
に、 R・β=K・・・・・(1) という関係式で近似することができる。すなわち、偏角
βの検出地点まで距離Kを一定とすると、カーブ半径R
と偏角βとは反比例の関係にある。これは、図4に示す
ように、実験結果からも立証される。したがって、この
式(1)によりカーブ半径Rが推定される。なお、横偏
差算出手段7については後述する。The method of estimating the curve radius R will be described. As shown in FIG. 3, when the declination β ahead of the vehicle 1 by a predetermined distance K is calculated, when the declination β is relatively small, the curve radius R is small. R, the predetermined distance K, and the argument β can be geometrically approximated by the relational expression R · β = K (1). That is, if the distance K is constant to the detection point of the declination β, the curve radius R
And the argument β are in inverse proportion. This is also verified from the experimental results, as shown in FIG. Therefore, the curve radius R is estimated by this equation (1). The lateral deviation calculating means 7 will be described later.
【0031】次に、コントローラ5について説明する。
このコントローラ5は、操舵角設定部5Aと、操舵開始
距離設定部5Bと、操舵速度設定部5Cと、操舵角を最
終的に設定する加算器5Dとをそなえている。操舵角設
定部5Aでは、以下のようにして操舵角δ0 が設定され
る。ドライバは、カーブ定常旋回時の操舵角をカーブの
曲率半径Rに応じて決定するので、本装置においても、
ドライバ操舵同様に、カーブ半径Rが推定されると、こ
のカーブ半径Rに基づいて操舵角δ0 が設定されるよう
になっている。Next, the controller 5 will be described.
The controller 5 includes a steering angle setting unit 5A, a steering start distance setting unit 5B, a steering speed setting unit 5C, and an adder 5D that finally sets the steering angle. In the steering angle setting unit 5A, the steering angle δ 0 is set as follows. Since the driver determines the steering angle at the time of steady turn of the curve according to the radius of curvature R of the curve, in this device as well,
Similarly to driver steering, when the curve radius R is estimated, the steering angle δ 0 is set based on the curve radius R.
【0032】つまり、操舵角設定部5Aには、上述の曲
率状態推定手段9で推定されたカーブ半径Rと、車速検
出手段16から得られる車速Vとが入力され、これらの
値R,Vと、予めインプットされた車両1のスタビリテ
ィファクタA及びホイールベースWBとにより、操舵角
δ0 が下式(2)にしたがって運動力学的に決定される
のである。 δ0 =(1+AV2 )・(Wb/R)・・・・・(2) これに前述した式(1)における偏角βを代入すると、 δ0 =(1+AV2 )・(WB/K)・β・・・・・(3) となる。この式(3)によれば、カーブ半径Rを用いる
ことなく、偏角βと車速Vとから直接δ0 を求めること
ができるので、実際の制御では、式(3)を用いてδ0
を求める。また、図5に示すグラフは、偏角βとドライ
バの操舵角との関係を示す実験データであるが、このグ
ラフから、式(3)に示すように、偏角βとドライバの
操舵角と、はほぼ比例の関係になっていることが立証さ
れる。That is, to the steering angle setting section 5A, the curve radius R estimated by the curvature state estimating means 9 and the vehicle speed V obtained from the vehicle speed detecting means 16 are input, and these values R and V are input. The steering angle δ 0 is kinematically determined according to the following equation (2) by the stability factor A of the vehicle 1 and the wheel base WB which are input in advance. δ 0 = (1 + AV 2 ) · (Wb / R) (2) Substituting the deviation angle β in the above equation (1) into δ 0 = (1 + AV 2 ) · (WB / K)・ Β ... (3) According to this equation (3), without using the curve radius R, it is possible to determine the direct [delta] 0 and a deviation angle β and the vehicle speed V, the actual control, [delta] using the equation (3) 0
Ask for. Further, the graph shown in FIG. 5 is experimental data showing the relationship between the deviation angle β and the steering angle of the driver. From this graph, as shown in the equation (3), the deviation angle β and the steering angle of the driver It is proved that and have a nearly proportional relationship.
【0033】そして、このように車両1の前方のカーブ
半径R又は偏角βをフィードフォワードするようにして
操舵角δ0 が設定されると、操舵角設定部5Aからは、
操舵角δ0 (操舵角指令値s0 )が車両1の操舵アクチ
ュエータ(ステアリングアクチュエータ)2Aに入力さ
れる。この操舵角指令値s0 により、車両1が走行レー
ンの方向に沿うような方向に調整されながら走行するよ
うになる。When the steering angle δ 0 is set so as to feed forward the curve radius R or the deflection angle β in front of the vehicle 1 in this way, the steering angle setting section 5A
The steering angle δ 0 (steering angle command value s 0 ) is input to the steering actuator (steering actuator) 2A of the vehicle 1. The steering angle command value s 0 causes the vehicle 1 to travel while being adjusted in a direction along the traveling lane.
【0034】ところで、車両1が上方から見て道路の中
心線に対してある程度の傾き(角度β2)をなして走行
している場合は、図21に示すように、偏角βには、実
際のカーブの偏角β1以外に、上述の車両1の傾きによ
る角度β2も含まれている。したがって、偏角ゲインK
1は、偏角β1により設定されるゲインK11と角度β2
により設定されるゲインK12とから設定されているので
ある。By the way, when the vehicle 1 is traveling with a certain inclination (angle β2) with respect to the center line of the road when viewed from above, as shown in FIG. In addition to the declination angle β1 of the curve, the angle β2 due to the inclination of the vehicle 1 is also included. Therefore, the declination gain K
1 is the gain K 11 and the angle β2 set by the argument β1.
It is set from the gain K 12 set by.
【0035】本来、ゲインK11とゲインK12とはそれぞ
れ独立に決定されるべきものではあるが、このように、
ゲインK1をK11+K12として設定することにより、現
在の車両1の方向を道路の方向へ合致させる操舵制御
と、車両1を前方のカーブの曲率Rに応じた向きに合致
させる操舵制御とを同時に実現することができる。ま
た、横偏差算出手段7では、車両1が道路中心8に対し
てどの程度横方向にずれているかそのずれ量(横偏差)
を算出するものであり、変換された平面視画像4Bに基
づいてこの横偏差の値が算出されるようになっている。
なお、この横偏差は、車両1の現在位置の横ずれに相当
する量にしたいので、平面視画像4B中でも、最も車両
に近い地点(すなわち、平面視画像4B内の有効な部分
内で最も下方の地点)において算出される。Originally, the gain K 11 and the gain K 12 should be determined independently of each other.
By setting the gain K1 as K 11 + K 12 , steering control for matching the current direction of the vehicle 1 with the direction of the road and steering control for matching the vehicle 1 with the direction corresponding to the curvature R of the curve ahead. Can be realized at the same time. Further, in the lateral deviation calculating means 7, how much laterally the vehicle 1 is deviated from the road center 8 is the amount of deviation (lateral deviation).
Is calculated, and the value of this lateral deviation is calculated based on the converted planar view image 4B.
Since it is desired to set the lateral deviation to an amount corresponding to the lateral deviation of the current position of the vehicle 1, the point closest to the vehicle in the planar image 4B (that is, the lowest point in the effective portion in the planar image 4B). Point).
【0036】この例では、左側通行の路側部分に当た
る、道路左端の白線12を基準線として、この基準線か
ら右へ一定距離(=レーン幅の略半分の距離)の位置を
道路中心と仮定するようになっている。そして、この道
路中心から自車両1の左右中心までの距離が横偏差とし
て算出されるようになっている。なお、ここではカメラ
3の左右中心が、自車両1の左右中心と一致するように
設置されており、この横偏差は、平面視画像4B上の左
右中心線3Aと道路中心線との距離にあたる。In this example, it is assumed that the white line 12 at the left end of the road, which corresponds to the roadside portion of left-hand traffic, is used as a reference line, and a position to a right of this reference line (= a distance approximately half the lane width) is the center of the road. It is like this. Then, the distance from the center of the road to the left-right center of the host vehicle 1 is calculated as the lateral deviation. Here, the left and right center of the camera 3 is installed so as to match the left and right center of the host vehicle 1, and this lateral deviation corresponds to the distance between the left and right center line 3A on the planar view image 4B and the road center line. .
【0037】そして、横偏差算出手段7により車両1の
横偏差が算出されると、この横偏差に応じて、横偏差を
0に近づけるための制御指令値として偏差×ゲインK0
により操舵角δ1 が設定され、この操舵角δ1 の指令値
s1 に応じて操舵アクチュエータ2Aが制御されるよう
になっている。そして、この指令値s1 を通じた操舵制
御により、車両1の横偏差が減少して、車両1の走行位
置を道路の走行車線の中央に修正するようになってい
る。なお、上述の白線12の認識方法については後で詳
述する。When the lateral deviation of the vehicle 1 is calculated by the lateral deviation calculating means 7, the deviation x gain K0 is set as a control command value for approaching the lateral deviation to 0 according to the lateral deviation.
Thus, the steering angle δ 1 is set, and the steering actuator 2A is controlled according to the command value s 1 of the steering angle δ 1 . Then, the steering deviation based on the command value s 1 reduces the lateral deviation of the vehicle 1 and corrects the traveling position of the vehicle 1 to the center of the traveling lane on the road. The method of recognizing the white line 12 described above will be described in detail later.
【0038】前述の操舵角指令値s0 は、車両1の前方
のカーブの偏角βを用いて設定される信号であり、これ
により車両1は、前方のカーブを予測制御しながら走行
することができるのである。このように操舵角δ0 をフ
ィードフォワードにより設定し、これを補足するよう
に、上述の横偏差をフィードバックしているので、操舵
アクチュエータ2Aにフィードフォワードの指令値s0
とフィードバックの指令値s1 とが入力されることにな
る。ここでは、主として偏角ゲインK1により操舵角δ
0 を設定し、横偏差ゲインK0を小さく設定しており、
外乱が入力された時の横偏差ゲインK0に基づく制御に
よる車両1への影響を極力小さなものにすることができ
る。The above-mentioned steering angle command value s 0 is a signal set by using the deflection angle β of the curve ahead of the vehicle 1, whereby the vehicle 1 travels while predictively controlling the curve ahead. Can be done. In this way, the steering angle δ 0 is set by feedforward, and the lateral deviation is fed back so as to supplement this, so the feedforward command value s 0 is given to the steering actuator 2A.
And the feedback command value s 1 are input. Here, the steering angle δ is mainly determined by the declination gain K1.
0 is set and the lateral deviation gain K0 is set small,
The influence on the vehicle 1 by the control based on the lateral deviation gain K0 when a disturbance is input can be minimized.
【0039】ところで、操舵開始距離設定部5Bでは、
車速や乗り心地を考慮して、操舵開始時期(操舵開始距
離D)を設定するようになっている。一般に、操舵時に
は、車両1やドライバ等に横加速度が加わり、この横加
速度が乗り心地大きく影響することが考えられる。これ
に対して、図5に示すように、ドライバ操舵における各
種のカーブの横加速度と横ジャーク(横加速度の単位時
間当りの変化量)との関係は、カーブ半径R,車速V,
走行感覚によらず、横加速度対横ジャークの比率がほぼ
一定の値となっている。By the way, in the steering start distance setting section 5B,
The steering start timing (steering start distance D) is set in consideration of the vehicle speed and riding comfort. Generally, during steering, lateral acceleration is applied to the vehicle 1, the driver, and the like, and this lateral acceleration is considered to greatly affect the riding comfort. On the other hand, as shown in FIG. 5, the relationship between the lateral acceleration of various curves and the lateral jerk (the amount of change in lateral acceleration per unit time) during driver steering is as follows: curve radius R, vehicle speed V,
The ratio of lateral acceleration to lateral jerk is almost constant regardless of the driving feeling.
【0040】これは、車両1がカーブ進入時に一定の横
ジャークでハンドルを操作するとすれば、一定横加速度
に達するまでの操舵時間ΔTが一定であることを意味し
ている。また、操舵開始距離Dは、操舵時間ΔTと車速
Vとの積として、下式(4)で示される。ここで、ΔT
を一定とすると、操舵開始距離Dは車速Vと比例関係に
なり、操舵開始距離設定部5Bでは車速Vから操舵開始
距離Dを決定する。 D=ΔT・V ・・・・・(4) なお、ドライバの実際に行なう操舵開始距離Dと車速V
との関係は、図9(a)に示すようになり、操舵開始距
離Dを車速Vに比例させて設定することが実証される。
なお、操舵開始距離Dは、図9(b)に示すように、自
車両1からカーブ入口までの距離である。This means that if the steering wheel is operated with a constant lateral jerk when the vehicle 1 enters a curve, the steering time ΔT until reaching a constant lateral acceleration is constant. Further, the steering start distance D is expressed by the following equation (4) as a product of the steering time ΔT and the vehicle speed V. Where ΔT
Is constant, the steering start distance D is proportional to the vehicle speed V, and the steering start distance setting unit 5B determines the steering start distance D from the vehicle speed V. D = ΔT · V (4) The steering start distance D and the vehicle speed V actually performed by the driver
The relationship between and is as shown in FIG. 9A, and it is proved that the steering start distance D is set in proportion to the vehicle speed V.
The steering start distance D is the distance from the vehicle 1 to the curve entrance, as shown in FIG. 9B.
【0041】また、操舵時間ΔTは、横ジャークをJと
すると ΔT=δ0 /δV =V2 /(R・J)=一定・・・・・(5) となる。式(5)からΔTを一定とすると、車速Vは、
乗り心地を考慮して横ジャークJの値がある上限値を越
えないようにカーブ半径Rに応じて設定すればよいこと
がわかる。Further, the steering time ΔT is ΔT = δ 0 / δ V = V 2 / (R · J) = constant (5) when the lateral jerk is J. If ΔT is constant from the equation (5), the vehicle speed V is
It is understood that the value of the lateral jerk J may be set according to the curve radius R so as not to exceed a certain upper limit value in consideration of the riding comfort.
【0042】このように、車速Vに応じて操舵を開始す
るタイミング(操舵開始距離D)を設定することによっ
て、直走路と曲走路との過渡領域や、道路の曲率の変化
する領域等で乗り心地のよい滑らかな走行を実現してい
るのである。次に、操舵速度設定部5Cについて説明す
ると、この操舵速度設定部5Cでは、操舵開始距離設定
部5Bで設定された操舵開始距離Dに基づいて操舵速度
δVが設定されるようになっている。Thus, by setting the timing for starting steering (steering start distance D) according to the vehicle speed V, the driver can ride in a transitional region between a straight road and a curved road, a region where the curvature of the road changes, or the like. It realizes comfortable and smooth running. Next, the steering speed setting unit 5C will be described. In the steering speed setting unit 5C, the steering speed δ V is set based on the steering start distance D set by the steering start distance setting unit 5B. .
【0043】つまり、図7のグラフに示すように、自動
操舵における操舵開始距離Dと操舵速度δV との関係か
ら、操舵開始距離Dが設定されると、本来、操舵速度δ
V は従属的に決定されてしまうものである。そして、こ
の操舵速度設定部5Cで設定された操舵速度δV は、偏
角算出手段6に取り込まれるようになっているのであ
る。That is, as shown in the graph of FIG. 7, when the steering start distance D is set from the relationship between the steering start distance D and the steering speed δ V in the automatic steering, the steering speed δ is originally set.
V is subordinately decided. The steering speed δ V set by the steering speed setting unit 5C is taken into the deviation angle calculating means 6.
【0044】ここで、偏角βや横偏差の算出基準であ
る、基準線としての道路上の白線12の認識方法につい
て説明する。なお、ここでは、走行レーン左端の路側線
としての白線12の認識について説明する。まず、図8
(a)に示すように、車両1にそなえられたカメラ3に
より平地において車両前方の範囲(例えば5m〜20
m)の白黒画像情報を取り込み、この画像情報から画面
上で縦方向の画像を一部省略する。そして、この画面上
で等間隔になるような複数の水平線11を設定する。な
お符号12は、道路の白線を示しているこの白黒画像情
報の取り込みは、微小な制御周期毎に更新されるように
なっており、図8(b)に示すように、それぞれの水平
線11上において前回の画面での白線位置の左右の所要
の範囲(ここでは、左右50画素〔dot〕)を白線探
査エリア(処理対象領域)10として設定する。また、
初回の画面は、直線路における白線位置を前回の画面デ
ータとして利用する。Now, a method of recognizing the white line 12 on the road as a reference line, which is a reference for calculating the deviation angle β and the lateral deviation, will be described. In addition, here, the recognition of the white line 12 as the roadside line at the left end of the driving lane will be described. First, FIG.
As shown in (a), the camera 3 provided on the vehicle 1 allows a range (eg, 5 m to 20
The black-and-white image information of m) is taken in, and a part of the vertical image on the screen is omitted from this image information. Then, a plurality of horizontal lines 11 are set so as to be evenly spaced on this screen. It should be noted that the reference numeral 12 indicates that the black-and-white image information indicating the white line of the road is updated at every minute control cycle. As shown in FIG. In, the required range on the left and right of the white line position on the previous screen (here, 50 pixels [dot] on the left and right) is set as the white line search area (processing target area) 10. Also,
For the first screen, the white line position on the straight road is used as the previous screen data.
【0045】そして、図8(c)に示すように、各水平
線の明度をそれぞれ左から横方向に微分する。また、図
中の符号14はガードレールである。ところで、通常の
路面は輝度が低く、輝度変化も小さい。これに対して、
白線12は通常の路面に比較して輝度が非常に高いの
で、このように道路の明度を微分すると、通常の路面か
ら白線12への境界点で輝度変化がプラス、白線12か
ら通常の路面への境界点で輝度変化がマイナスとなるよ
うな微分データが得られる。このような微分データの一
例を図8(d)示す。Then, as shown in FIG. 8C, the brightness of each horizontal line is differentiated from the left to the horizontal direction. Reference numeral 14 in the drawing is a guardrail. By the way, a normal road surface has low brightness and a small change in brightness. On the contrary,
Since the brightness of the white line 12 is much higher than that of a normal road surface, when the brightness of the road is differentiated in this way, a change in brightness is positive at the boundary point from the normal road surface to the white line 12, and the white line 12 changes to the normal road surface. Differentiated data is obtained such that the luminance change becomes negative at the boundary point of. An example of such differential data is shown in FIG.
【0046】そして、各水平線11のデータそれぞれに
ついて、微分値のピークが左からプラス,マイナスの順
に並んで現れ、且つそれぞれのピークの間隔が白線12
として妥当と思われる程度(プラスのピークからマイナ
スのピークまでの間隔が例えば30dot以内)に納ま
っている組み合わせを白線候補として抽出し、図8
(e)に示すように、その中点を白線候補点15として
保存する。For each data of each horizontal line 11, peaks of the differential value appear in the order of plus and minus from the left, and the intervals of the respective peaks are the white line 12.
8 are extracted as white line candidates, and combinations that are within a range that is considered to be appropriate (the interval from the positive peak to the negative peak is within 30 dots, for example) are extracted,
As shown in (e), the midpoint is stored as the white line candidate point 15.
【0047】そして、これらの白線候補点15のうち、
画面中心に最も近いもののみを最終候補点として残す。
これは、例えば車両1が左側通行の場合、探索エリア1
0の中の右側が通常輝度変化の少ない道路面であり、こ
の通常の道路面に最も近い白線候補点15が白線12と
判断できる。したがって白線12よりもさらに左側に、
ノイズの原因となる物体(例えばガードレール14等)
が存在する場合であっても、カメラ3により撮像された
画像情報から白線12を確実に認識することができる。Of these white line candidate points 15,
Only the one closest to the screen center is left as the final candidate point.
This is because, for example, when the vehicle 1 is driving on the left side, the search area 1
The right side of 0 is a road surface with little change in normal brightness, and the white line candidate point 15 closest to this normal road surface can be determined to be the white line 12. Therefore, to the left of the white line 12,
Objects that cause noise (eg guardrail 14)
Even if there is, the white line 12 can be surely recognized from the image information captured by the camera 3.
【0048】そして、図8(f)に示すように、最後に
各水平線データにおける白線候補点15の上下方向の連
続性を画面の下方から順次検証していく。まず、事前に
前画面での白線12の上下端間の傾きを計算しておく。
そして、最下点15Aを白線12とすると、一本上の水
平線11上の候補点15Bが、前回の白線12の傾き分
±50dotの範囲内に入っているかを検証する。Then, as shown in FIG. 8F, finally, the continuity in the vertical direction of the white line candidate points 15 in each horizontal line data is sequentially verified from the bottom of the screen. First, the slope between the upper and lower ends of the white line 12 on the previous screen is calculated in advance.
Then, assuming that the lowest point 15A is the white line 12, it is verified whether the candidate point 15B on the one horizontal line 11 is within the range of the inclination of the white line 12 of the previous time ± 50 dots.
【0049】候補点15Bがこの範囲内に入っていれば
これを白線とし、入っていないときは候補点15Bは却
下されて、上述の傾きから補間計算した座標が白線位置
としてみなされる。そして、この検証を各水平線につい
て同様の作業を行なうことにより、連続した白線12を
認識することができるのである。また、このような白線
認識の作業は、所要の周期で継続して行なわれ、その都
度白線12の認識が更新されるようになっている。If the candidate point 15B is within this range, it is set as a white line, and if it is not included, the candidate point 15B is rejected, and the coordinate calculated by interpolation from the above inclination is regarded as the white line position. Then, by performing the same work for each horizontal line in this verification, the continuous white line 12 can be recognized. Further, such white line recognition work is continuously performed in a required cycle, and the recognition of the white line 12 is updated each time.
【0050】ところで、白線12が検出されると、車両
1では横偏差及び偏角βが算出されるが、このうち横偏
差は、画像情報から得られる路面情報のうち有効なもの
のなかから、車両1に最も近い地点の基準線位置情報を
用いて算出されるようになっており、これにより、車両
1の現在位置での横偏差に近い値が算出され制御精度が
高められるようになっている。なお、車両1に最も近い
地点とは、上述の偏角βを算出する際に用いる第1検出
点のことである。By the way, when the white line 12 is detected, the lateral deviation and the deviation angle β are calculated in the vehicle 1. Among them, the lateral deviation is effective among the road surface information obtained from the image information. It is designed to be calculated using the reference line position information of the point closest to 1. Thus, a value close to the lateral deviation at the current position of the vehicle 1 is calculated and the control accuracy is improved. . The point closest to the vehicle 1 is the first detection point used when calculating the above-described deviation angle β.
【0051】ところで、車速が高くなれば高くなるほ
ど、車両直前の道路状況よりも車両遠方の道路状況の把
握が必要になってくる。つまり、図10の線aはドライ
バの運転特性を示しているが、このグラフに示すよう
に、通常車速が高いほど、前方注視距離は大きくなる。
そこで、本装置では、このようなドライバの操舵特性に
基づいて、偏角βを算出するための2つの検出点のう
ち、第2検出点を図10の線cのように動的に変化させ
ている。これにより、前方注視距離、すなわち車両1か
ら第1検出点と第2検出点との中間点までの距離Kが線
bのようになり、ドライバ操舵の運転特性を示す線aに
近づけることができるのである。なお、図20(a)に
示すように、前方注視距離は、第2検出点は固定したま
ま(線c1 参照)第1検出点を動的に変化させる(線d
1 参照)ことにより車速に対応させてもよく、また、図
20(b)に示すように、第1及び第2検出点の両方を
車速に応じて変化させて(線c2 ,d2 参照)前方注視
距離を決定してもよい。By the way, as the vehicle speed increases, it becomes necessary to grasp the road condition farther from the vehicle than the road condition immediately before the vehicle. That is, the line a in FIG. 10 shows the driving characteristics of the driver, but as shown in this graph, the higher the normal vehicle speed, the greater the forward gaze distance.
Therefore, in the present device, based on such steering characteristics of the driver, the second detection point among the two detection points for calculating the deflection angle β is dynamically changed as shown by the line c in FIG. ing. As a result, the forward gaze distance, that is, the distance K from the vehicle 1 to the intermediate point between the first detection point and the second detection point becomes like the line b, and can be brought close to the line a showing the driving characteristics of the driver steering. Of. As shown in FIG. 20A, the forward gaze distance dynamically changes the first detection point while the second detection point is fixed (see line c 1 ) (line d).
1 )) to correspond to the vehicle speed. Further, as shown in FIG. 20B, both the first and second detection points are changed according to the vehicle speed (see lines c 2 and d 2) . ) The forward gaze distance may be determined.
【0052】これにより、車速が大きい時は、カーブの
十分手前から偏角βが算出され、また、車速が十分小さ
い時は、比較的カーブに入口に近い位置で偏角βが算出
される。つまり、図14に示すように第1検出点,第2
検出点ともに固定の場合は、車速に関係なく操舵角指令
値s0 が設定されるので、車速によらず操舵が一定とな
り、操舵に違和感が生じる。As a result, when the vehicle speed is high, the declination angle β is calculated sufficiently before the curve, and when the vehicle speed is sufficiently low, the declination angle β is calculated at a position relatively close to the entrance to the curve. That is, as shown in FIG. 14, the first detection point and the second detection point
When both the detection points are fixed, the steering angle command value s 0 is set regardless of the vehicle speed, so the steering becomes constant regardless of the vehicle speed, and the steering feels uncomfortable.
【0053】これに対し、図13に示すように、車速に
対応させて前方注視距離を変更することにより、算出さ
れる偏角βの値を変動させ、これに応じて偏角ゲインK
1も可変にすることにより、車速に応じた操舵を実現す
ることができる。また、このように偏角βを算出するた
めの検出点を車速に応じて前後させることにより、図1
1に示すように、同一カーブであるにも関わらず算出さ
れる偏角βの値が変動してしまうことが考えられる。On the other hand, as shown in FIG. 13, the value of the calculated deviation angle β is changed by changing the forward gaze distance in accordance with the vehicle speed, and the deviation angle gain K is accordingly changed.
By making 1 also variable, steering according to the vehicle speed can be realized. In addition, by moving the detection points for calculating the deviation angle β back and forth according to the vehicle speed,
As shown in FIG. 1, the value of the calculated declination β may vary even though the curves are the same.
【0054】そこで、このような偏角βの変動を吸収さ
せる必要があるが、上述の(3)式に示すように、操舵
角δ0 は、偏角βとβの係数(1+AV2 )・WB/K
との積で算出されるので、この係数成分中の1/Kの要
素が偏角βの変動を相殺するようにして働き、操舵角δ
0 は適切に設定されるようになっている。ところで、横
偏差ゲインK0は、あくまで補正量的なものであるが、
図12に示すように、車両1がカーブ内を走行している
時は、道路の中央を走っている場合であっても、カーブ
の曲率の影響により、ある程度の横偏差が出力されてし
まうことが考えられる。このような場合に、出力された
横偏差により、偏差ゲインK0が必要以上に大きく設定
されてしまう。Therefore, it is necessary to absorb such a variation in the deviation angle β, but as shown in the above equation (3), the steering angle δ 0 is a coefficient (1 + AV 2 ) · of the deviation angles β and β. WB / K
Since it is calculated by the product of and, the element of 1 / K in this coefficient component works so as to cancel the fluctuation of the deflection angle β, and the steering angle δ
0 is set appropriately. By the way, the lateral deviation gain K0 is just a correction amount,
As shown in FIG. 12, when the vehicle 1 is traveling in a curve, some lateral deviation is output due to the influence of the curvature of the curve even when traveling in the center of the road. Can be considered. In such a case, the output lateral deviation causes the deviation gain K0 to be set larger than necessary.
【0055】そこで、例えば(3)式で算出された操舵
角δ0 から所定の値を減算して偏角ゲインK1を小さめ
に設定するようにしてもよい。この所定の値は、経験的
に求められたり、計算により算出された補正ゲインであ
る。このように、偏角ゲインK1を補正ゲインの分だけ
小さめの値に設定することにより、大きめに設定された
偏差ゲインK0を補完することができ、操舵アクチュエ
ータ2Aを正確に作動させることができる。Therefore, for example, the declination gain K1 may be set to a small value by subtracting a predetermined value from the steering angle δ 0 calculated by the equation (3). This predetermined value is a correction gain that is empirically determined or calculated. In this way, by setting the declination gain K1 to a value that is smaller by the amount of the correction gain, the deviation gain K0 that is set to a larger value can be complemented, and the steering actuator 2A can be operated accurately.
【0056】また、操舵アクチュエータ2Aとしては例
えば以下のような、油圧パワーステアリング機構104
を利用したものが考えられる。図19に示すように、車
両1の操舵力伝達系103にはパワーステアリング機構
104が設けられており、ステアリングホイール20に
操舵力が入力されると、車両の操舵状態に応じて、操舵
力がアシストされるようになっている。Further, as the steering actuator 2A, for example, the following hydraulic power steering mechanism 104 is used.
It is possible to use the. As shown in FIG. 19, the steering force transmission system 103 of the vehicle 1 is provided with a power steering mechanism 104. When the steering force is input to the steering wheel 20, the steering force is changed according to the steering state of the vehicle. It is supposed to be assisted.
【0057】このパワーステアリング機構104は、油
圧により操舵力をアシストする油圧式のパワーステアリ
ング機構として構成されており、所定の油圧の作動油を
油圧シリンダ104Aに供給することにより、ドライバ
の操舵力を低減できるようになっている。このため、こ
の車両には、例えば電動モータ122等により駆動され
るオイルポンプ110が設けられており、このオイルポ
ンプ110により作動油がオイルタンク111から吸い
上げられるようになっている。The power steering mechanism 104 is constructed as a hydraulic power steering mechanism which assists the steering force with hydraulic pressure. By supplying hydraulic oil of a predetermined hydraulic pressure to the hydraulic cylinder 104A, the steering force of the driver is increased. It can be reduced. For this reason, this vehicle is provided with an oil pump 110 driven by, for example, an electric motor 122, and the working oil is sucked up from an oil tank 111 by the oil pump 110.
【0058】そして、このオイルポンプ110から吐出
された作動油は、分流弁112により2方向に分岐する
ようになっている。このうち一方の油路は、例えばEP
Sバルブ115等の公知のパワーステアリングバルブに
接続されており、EPSバルブ115を通じて油圧シリ
ンダ104Aの油圧状態が調整されるようになってい
る。The hydraulic oil discharged from the oil pump 110 is branched into two directions by the flow dividing valve 112. One of these oil passages is, for example, EP
It is connected to a known power steering valve such as the S valve 115, and the hydraulic pressure state of the hydraulic cylinder 104A is adjusted through the EPS valve 115.
【0059】また、この油圧系には、図19に示すよう
に、自動操舵手段としての自動操舵制御バルブ107が
そなえられており、この自動操舵制御バルブ107に
は、上述した分流弁112の他方の油路が接続されてい
る。この自動操舵制御バルブ107は、自動操舵時の操
舵量を制御するためのバルブであり、このバルブ107
を作動させることにより、自動操舵時に油圧シリンダ1
04Aへ所定の油圧の作動油を供給することができるよ
うになっている。Further, as shown in FIG. 19, the hydraulic system is provided with an automatic steering control valve 107 as an automatic steering means, and the automatic steering control valve 107 is provided with the other of the flow dividing valve 112 described above. Oil passage is connected. The automatic steering control valve 107 is a valve for controlling the steering amount during automatic steering.
To operate the hydraulic cylinder 1 during automatic steering.
04A can be supplied with hydraulic oil of a predetermined hydraulic pressure.
【0060】また、この車両には、パワーステアリング
機構104の作動する状態と自動操舵状態とを切り替え
るためのモード切替バルブ装置106が設けられてお
り、このモード切替バルブ装置106と自動操舵制御バ
ルブ107と油圧シリンダ104Aとから操舵アクチュ
エータ2Aが構成されている。このモード切替バルブ1
06は、パワーステアリング機構104による操舵を行
なうか、又は自動操舵を行なうかを切り替えるものであ
って、上述の自動操舵制御バルブ107と油圧シリンダ
104Aとの間、及びEPSバルブ115と油圧シリン
ダ104Aとの間に介設されている。Further, this vehicle is provided with a mode switching valve device 106 for switching between the operating state of the power steering mechanism 104 and the automatic steering state. The mode switching valve device 106 and the automatic steering control valve 107 are provided. The steering actuator 2A is composed of the hydraulic cylinder 104A and the hydraulic cylinder 104A. This mode switching valve 1
Reference numeral 06 is for switching between steering by the power steering mechanism 104 and automatic steering. Between the automatic steering control valve 107 and the hydraulic cylinder 104A, and between the EPS valve 115 and the hydraulic cylinder 104A. Is installed between.
【0061】モード切替バルブ106は、通常はパワー
ステアリング機構104により操舵されるモードになっ
ており、EPSバルブ115に供給された作動油はこの
モード切替バルブ106を通って油圧シリンダ104A
に供給され、操舵力をアシストするようになっている。
また、オイルポンプ110と分流弁112との間には、
リリーフバルブ113が設けられている。このリリーフ
バルブ113は、自動操舵制御バルブ107やEPSバ
ルブ115に所定の油圧よりも高圧の作動油が供給され
ると、弁が開いて作動油をオイルタンク111へ戻すよ
うになっている。The mode switching valve 106 is normally in a mode in which it is steered by the power steering mechanism 104, and the hydraulic fluid supplied to the EPS valve 115 passes through the mode switching valve 106 and the hydraulic cylinder 104A.
Is supplied to the vehicle to assist the steering force.
Further, between the oil pump 110 and the flow dividing valve 112,
A relief valve 113 is provided. The relief valve 113 is designed to return the hydraulic oil to the oil tank 111 when the hydraulic oil having a pressure higher than a predetermined hydraulic pressure is supplied to the automatic steering control valve 107 and the EPS valve 115.
【0062】また、この操舵機構には、コントローラ5
が設けられており、コントローラ5で設定された制御指
令値によりリリーフバルブ113の開閉状態が制御され
るようになっており、自動操舵制御バルブ107及びモ
ード切替バルブ106についてもコントローラ5により
制御されるようになっている。これにより、自動操舵時
は、コントローラ5の制御指令値に基づいてモード切替
バルブ106が自動操舵モードに切り替えられるととも
に、この制御指令値に基づいて自動操舵制御バルブ10
7が制御されて、油圧シリンダ104Aに所要の作動油
が供給される。そして、この作動油の油圧により車両1
の操舵輪2が操舵される。Further, the steering mechanism includes a controller 5
Is provided, and the opening / closing state of the relief valve 113 is controlled by the control command value set by the controller 5. The controller 5 also controls the automatic steering control valve 107 and the mode switching valve 106. It is like this. As a result, during automatic steering, the mode switching valve 106 is switched to the automatic steering mode based on the control command value of the controller 5, and the automatic steering control valve 10 is based on this control command value.
7 is controlled to supply the required hydraulic oil to the hydraulic cylinder 104A. The vehicle 1 is driven by the hydraulic pressure of this hydraulic oil.
The steered wheels 2 are steered.
【0063】また、ラック102には、ラック102の
位置を検出するラック位置検出センサ120が設けられ
ており、このラック位置検出センサ120からの検出情
報がコントローラ5にフィードバックされるようになっ
ている。また、自動操舵時は、油圧シリンダ104Aに
作動油を供給することにより操舵車輪(以下、操舵輪と
いう)を制御しているが、この作動油圧よりも大きな入
力でステアリングホイール20を操舵すると、作動油圧
に打ち勝って操舵輪を操舵することができるようになっ
ている。Further, the rack 102 is provided with a rack position detecting sensor 120 for detecting the position of the rack 102, and the detection information from the rack position detecting sensor 120 is fed back to the controller 5. . Further, during automatic steering, the steering wheel (hereinafter referred to as the steering wheel) is controlled by supplying hydraulic oil to the hydraulic cylinder 104A, but if the steering wheel 20 is steered with an input larger than this hydraulic pressure, the steering wheel 20 operates. It is possible to overcome the hydraulic pressure and steer the steered wheels.
【0064】なお、操舵力伝達系103としては、上述
の構成はその一例にすぎず、このような構成に限られる
ものではない。例えば、作動油の油圧供給源としては、
電動モータ122に限らず、エンジンの駆動力を利用し
たものであってもよい。本発明の一実施例としての車両
用自動操舵装置は、上述のように構成されているので、
図1に矢印で示すような信号の流れで操舵角δ0 ,操舵
開始距離D,操舵速度δv の設定が周期的に行なわれ、
これに基づいて、操舵アクチュエータ2Aが周期的に制
御されて車両1の操舵が行なわれる。The above-mentioned configuration of the steering force transmission system 103 is only an example, and the present invention is not limited to such a configuration. For example, as a hydraulic pressure source of hydraulic oil,
Not limited to the electric motor 122, the driving force of the engine may be used. Since the vehicle automatic steering device as one embodiment of the present invention is configured as described above,
The steering angle δ 0 , the steering start distance D, and the steering speed δ v are set periodically by a signal flow as shown by the arrow in FIG.
Based on this, the steering actuator 2A is periodically controlled to steer the vehicle 1.
【0065】つまり、カメラ3で撮像された画像に基づ
いて、偏角算出手段6により車両1の偏角βが算出さ
れ、これとともに、横偏差算出手段7により車両1の横
偏差が算出される。そして、この偏角βに応じて、偏角
βを0に近づけるための制御指令値としてs0 が設定さ
れ、横偏差に応じて、横偏差を0に近づけるための制御
指令値としてs1 が設定される。That is, based on the image picked up by the camera 3, the deviation angle calculating means 6 calculates the deviation angle β of the vehicle 1, and the lateral deviation calculating means 7 also calculates the lateral deviation of the vehicle 1. . Then, according to the deviation angle beta, is set s 0 declination beta as a control command value for close to zero, depending on the lateral deviation is s 1 a lateral deviation as a control command value for close to 0 Is set.
【0066】そして、直走路や定常円状の曲走路の走行
時(定常走行時)は、コントローラ5により設定された
指令値s0 ,s1 に基づいて、横偏差や偏角が0に近づ
くように操舵アクチュエータ2Aが制御されることによ
り、車両1が道路の走行レーンを正確に走行することが
できる。特に、操舵角δ0 が車両1の前方のカーブ半径
Rや偏角βをフィードフォワードされて設定されるの
で、フィードバック制御のような小刻みな設定値の変更
がなく、車両1は前方のカーブを予測制御しながら走行
することができる。When the vehicle is running on a straight road or a steady circular curved road (at the time of steady running), the lateral deviation and the deflection angle approach 0 based on the command values s 0 and s 1 set by the controller 5. By controlling the steering actuator 2A in this manner, the vehicle 1 can travel accurately on the traveling lane on the road. In particular, since the steering angle δ 0 is set by feed-forwarding the curve radius R and the declination β in front of the vehicle 1, there is no need to change the setting value in small increments such as feedback control, and the vehicle 1 can change the curve ahead. It is possible to drive with predictive control.
【0067】これにより、自然な操舵制御を行なうこと
ができ、車両1が走行レーンの方向に沿うような方向に
調整されながら走行する。ところで、操舵角は偏角ゲイ
ンK1とこれを補足するような横偏差ゲインK0とによ
り設定されるが、ここでは、横偏差ゲインK0が比較的
小さくなって、主として偏角ゲインK1により操舵角δ
0 が設定されているので、これにより外乱が入力された
時の横偏差ゲインK0による車両1への影響を極力小さ
なものにすることができる。As a result, natural steering control can be performed, and the vehicle 1 travels while being adjusted in the direction along the traveling lane. By the way, the steering angle is set by the declination gain K1 and the lateral deviation gain K0 that complements the declination gain K1, but here, the lateral deviation gain K0 becomes relatively small, and the steering angle δ mainly depends on the declination gain K1.
Since 0 is set, it is possible to minimize the influence of the lateral deviation gain K0 on the vehicle 1 when a disturbance is input.
【0068】また、本装置では、ドライバの操舵特性に
基づいて、偏角βを算出するための前方注視距離Kを車
速に応じて変化させ、偏角βを車速に応じて算出するこ
とにより、車速に応じた操舵を実現することができ、ド
ライバ操舵の運転特性に近づけることができる。さら
に、操舵開始距離設定部5Bでは、横ジャークJが所定
値を越えないように考慮しながら、車速Vに応じて操舵
を開始するタイミング(操舵開始距離D)を設定する。
これは、実際には車速Vに応じた前方位置のカーブの検
出し、カーブの検出とともに操舵を開始することで、操
舵開始距離Dの設定と同時に操舵開始距離Dによる制御
が行なわれることになる。Further, in this device, the forward gaze distance K for calculating the deviation angle β is changed according to the vehicle speed based on the steering characteristic of the driver, and the deviation angle β is calculated according to the vehicle speed. The steering according to the vehicle speed can be realized, and the driving characteristics of the driver steering can be approximated. Further, the steering start distance setting unit 5B sets a timing (steering start distance D) at which steering is started in accordance with the vehicle speed V while taking into consideration that the lateral jerk J does not exceed a predetermined value.
This is because the curve at the front position according to the vehicle speed V is actually detected, and the steering is started together with the detection of the curve, whereby the steering start distance D is set and the steering start distance D is simultaneously controlled. .
【0069】また、この時の操舵速度δV は、操舵開始
距離Dに対応して決まるが、これも、実際には操舵開始
距離Dを反映して設定される操舵角δ0 の中に操舵速度
δVが含まれた形で制御に用いられる。これにより、カ
ーブ進入時において、舵角を増していく場合にも、図1
7に示すように、横ジャークに対応するように横加速度
のピークが抑制され、ドライバ操舵とほぼ同様なフィー
リングで、比較的ゆったりとした走行感覚を実現するこ
とができる。このように、直走路と曲走路との過渡領域
や、道路の曲率の変化する領域等で乗り心地のよい滑ら
かな走行を実現することができるのである。Further, the steering speed δ V at this time is determined corresponding to the steering start distance D, but this is also the steering angle δ 0 actually set by reflecting the steering start distance D. It is used for control in a form that includes the velocity δ V. As a result, even when the steering angle is increased when entering a curve,
As shown in FIG. 7, the peak of the lateral acceleration is suppressed so as to correspond to the lateral jerk, and it is possible to realize a relatively loose running sensation with a feeling almost similar to that of driver steering. In this way, it is possible to realize smooth running with a comfortable ride in a transitional area between a straight road and a curved road, an area in which the curvature of the road changes, and the like.
【0070】また、上述したような自動操舵によって図
15に示すような屈曲路を走行した場合、図16に示す
ような操舵特性を得ることができる。ここで、図16
(a)に示す線aは、前方注視距離Dを固定した場合の
自動操舵の操舵角特性、線bは、前方注視距離Dを車速
に応じて変化させた場合の自動操舵の操舵角特性、線c
は、ドライバ操舵による操舵特性である。また、図16
(a),(b)における、A,B,Cは、図15におけ
るA,B,Cに対応している。Further, when the vehicle travels on the curved road as shown in FIG. 15 by the automatic steering as described above, the steering characteristic as shown in FIG. 16 can be obtained. Here, in FIG.
A line a shown in (a) is a steering angle characteristic of automatic steering when the front gaze distance D is fixed, and a line b is a steering angle characteristic of automatic steering when the front gaze distance D is changed according to the vehicle speed, Line c
Is a steering characteristic by driver steering. In addition, FIG.
A, B, and C in (a) and (b) correspond to A, B, and C in FIG.
【0071】図16(a)に示すように、前方注視距離
Dを車速に応じて変化させることにより、自動操舵の操
舵角特性(線b)がドライバ操舵(線c)とほぼ同じ特
性となり、前方注視距離Dを固定(線a)の場合よりも
さらに自然な操舵特性とすることができるのである。ま
た、図16(b)に示すように、操舵により発生する横
加速度(横G)もドライバ操舵とほぼ同じ特性とするこ
とができ、乗員に違和感を与えることなく、自然な操舵
感を得ることができる。As shown in FIG. 16 (a), by changing the forward gaze distance D according to the vehicle speed, the steering angle characteristic of automatic steering (line b) becomes almost the same as the driver steering (line c). This makes it possible to provide a steering characteristic that is more natural than the case where the forward gaze distance D is fixed (line a). Further, as shown in FIG. 16B, the lateral acceleration (lateral G) generated by steering can be made to have substantially the same characteristics as the driver steering, and a natural steering feeling can be obtained without giving an occupant an uncomfortable feeling. You can
【0072】また、道路白線12が、道路上の輝度の変
化量に基づいて推定されるとともに、カメラ3からの画
像情報のうち画面中心に近いものを道路白線12として
推定しているので、図18(a)に示すように、前回の
画像情報が処理されて道路白線12が認識されると、図
18(b)に示すように次の周期でマンホール等の外乱
(ノイズ)が入力されても、道路白線12を正しく認識
することができる。Since the road white line 12 is estimated based on the amount of change in luminance on the road, and the image information from the camera 3 that is close to the center of the screen is estimated as the road white line 12, As shown in FIG. 18 (a), when the previous image information is processed and the road white line 12 is recognized, a disturbance (noise) such as a manhole is input in the next cycle as shown in FIG. 18 (b). Also, the road white line 12 can be correctly recognized.
【0073】つまり、このような白線認識の作業を所要
の周期で継続して行ないその都度白線12の認識を更新
することにより、図18(c)に示すように道路上にマ
ンホール等の外乱(ノイズ)が存在しても、道路白線1
2の誤認識を防止することができるのである。また、こ
のように白線12が検出されると、車両1では横偏差及
び偏角βが算出されるが、このうち横偏差は、画像情報
から得られる路面情報のうち車両1に最も近い地点の基
準線位置情報を用いて算出されるので、車両1の現在位
置での横偏差に近い値が算出され制御精度が高められる
のである。In other words, such white line recognition work is continuously performed at a required cycle, and the recognition of the white line 12 is updated each time, so that the disturbance (such as a manhole) on the road as shown in FIG. Even if noise exists, the road white line 1
It is possible to prevent erroneous recognition of item 2. Further, when the white line 12 is detected in this way, the lateral deviation and the deviation angle β are calculated in the vehicle 1. Among these, the lateral deviation is the point closest to the vehicle 1 in the road surface information obtained from the image information. Since the value is calculated using the reference line position information, a value close to the lateral deviation at the current position of the vehicle 1 is calculated and the control accuracy is improved.
【0074】[0074]
【発明の効果】以上詳述したように、請求項1記載の本
発明の車両用自動操舵装置によれば、車両の操舵輪を転
舵する操舵アクチュエータと、該車両前方の道路を撮像
する撮像手段と、該撮像手段からの画像情報を処理する
画像情報処理手段と、該画像情報処理手段からの処理情
報に基づいて目標操舵角を設定しこの目標操舵角が得ら
れるように該操舵アクチュエータの駆動を制御する制御
手段とをそなえ、該画像情報処理手段が、該画像情報に
基づいて、該道路の基準線に対する該車両の横偏差を算
出する横偏差算出手段と、該画像情報に基づいて、該車
両前方の道路方向に対する該車両の偏角を算出する偏角
算出手段とをそなえるとともに、該制御手段が、該横偏
差算出手段及び該偏角算出手段からの情報に基づいて、
該横偏差及び該偏角がいずれも減少していくように、該
目標操舵角を設定するという構成により、曲率半径の小
さなカーブから直線路まで道路の曲率状態に応じて、自
然なフィーリングの自動操舵を実現することができる。As described in detail above, according to the vehicle automatic steering apparatus of the present invention as set forth in claim 1, the steering actuator for steering the steered wheels of the vehicle and the imaging for imaging the road ahead of the vehicle. Means, an image information processing means for processing image information from the imaging means, and a target steering angle is set based on the processing information from the image information processing means. And a control means for controlling driving, wherein the image information processing means calculates lateral deviation of the vehicle with respect to a reference line of the road based on the image information, and lateral deviation calculation means based on the image information. And a deviation angle calculating means for calculating a deviation angle of the vehicle with respect to a road direction ahead of the vehicle, and the control means based on the information from the lateral deviation calculating means and the deviation angle calculating means,
By setting the target steering angle so that both the lateral deviation and the deflection angle decrease, a natural feeling can be obtained from a curve with a small radius of curvature to a straight road depending on the curvature state of the road. It is possible to realize automatic steering.
【0075】また、請求項2記載の本発明の車両用自動
操舵装置によれば、該横偏差算出手段が、該画像情報か
ら得られる路面情報のうちの該車両に最も近い地点の基
準線位置情報を用いて該横偏差を算出し、該偏角算出手
段が、該画像情報から得られる路面情報を用いて該車両
から所定距離だけ離れた地点における該偏角を算出する
ように設定されるという構成により、車両の横偏差に対
する応答性が向上するとともに、車両の前方の偏角をフ
ィードフォワードすることで人為的な操舵に近い操舵特
性を得ることができる。According to another aspect of the vehicle automatic steering apparatus of the present invention, the lateral deviation calculating means sets the reference line position of the point closest to the vehicle in the road surface information obtained from the image information. The lateral deviation is calculated using information, and the deviation angle calculating means is set to calculate the deviation angle at a point distant from the vehicle by a predetermined distance using road surface information obtained from the image information. With this configuration, the responsiveness to the lateral deviation of the vehicle is improved, and the steering characteristic close to artificial steering can be obtained by feeding forward the declination angle of the front of the vehicle.
【0076】また、請求項3記載の本発明の車両用自動
操舵装置によれば、該車両の車速を検出する車速検出手
段をそなえ、該偏角算出手段が、該車速検出手段からの
情報を受けて、該車両から該車速に応じた距離だけ離れ
た地点における該偏角を算出するように設定されるとい
う構成により、カーブ進入時の操舵開始時期を人為的な
操舵とほぼ同じにすることができる。これにより、やは
り自然な操舵感の自動操舵走行を実現することができ
る。According to the vehicle automatic steering apparatus of the present invention as defined in claim 3, the vehicle speed detecting means for detecting the vehicle speed of the vehicle is provided, and the deviation angle calculating means receives the information from the vehicle speed detecting means. The steering start timing at the time of entering a curve is made substantially the same as the artificial steering by a configuration in which the deviation angle is calculated at a point distant from the vehicle by a distance corresponding to the vehicle speed. You can As a result, it is possible to realize automatic steering traveling with a natural steering feeling.
【0077】車両の走行軌跡も人為的な操舵による走行
軌跡に近いものになり、自然な操舵感の自動操舵走行を
実現することができる。また、請求項4記載の本発明の
車両用自動操舵装置によれば、該偏角算出手段が、該画
像情報から得られる路面情報のうち該車両から所定距離
だけ離れた第1の地点における基準線位置情報と、該第
1の地点よりもさらに該車両から離れた第2の地点にお
ける基準線位置情報とから該偏角を算出するように設定
されるという構成により、偏角が第1の地点と第2の地
点とを結ぶ線と車両の中心線とがなす角として算出さ
れ、この偏角を確実に検出することができる。The traveling locus of the vehicle is also close to the traveling locus by artificial steering, and automatic steering traveling with a natural steering feeling can be realized. Further, according to the vehicle automatic steering apparatus of the present invention as set forth in claim 4, the declination calculation means is a reference at a first point apart from the vehicle by a predetermined distance in the road surface information obtained from the image information. With the configuration in which the deviation angle is set to be calculated from the line position information and the reference line position information at the second point farther from the vehicle than the first point, the deviation angle is set to the first angle. It is calculated as an angle formed by the line connecting the point and the second point and the center line of the vehicle, and this declination can be reliably detected.
【0078】また、請求項5記載の本発明の車両用自動
操舵装置によれば、該第1の地点が、該画像情報から得
られる路面情報のうちの該車両に最も近い地点であると
いう構成により、車両の横偏差及び偏角の検出精度が向
上し、正確な操舵制御を行なうことができる。また、請
求項6記載の本発明の車両用自動操舵装置によれば、該
車両の車速を検出する車速検出手段をそなえ、該第2の
地点が、該車速検出手段からの情報に基づいて、該車両
から該車速に応じた距離だけ離れた地点であるという構
成により、偏角が車速に応じた地点において算出され
る。Further, according to the vehicle automatic steering apparatus of the present invention, the first point is the point closest to the vehicle in the road surface information obtained from the image information. As a result, the accuracy of detecting the lateral deviation and declination of the vehicle is improved, and accurate steering control can be performed. Further, according to the vehicle automatic steering apparatus of the present invention according to claim 6, the vehicle speed detecting means for detecting the vehicle speed of the vehicle is provided, and the second point is based on the information from the vehicle speed detecting means. The declination is calculated at the point corresponding to the vehicle speed by the configuration that the point is away from the vehicle by the distance corresponding to the vehicle speed.
【0079】また、請求項7記載の本発明の車両用自動
操舵装置によれば、車両の操舵輪を転舵する操舵アクチ
ュエータと、該車両前方の道路を撮像する撮像手段と、
該撮像手段からの画像情報を処理する画像情報処理手段
と、該車両の車速を検出する車速検出手段と、該画像情
報処理手段からの処理情報に基づいて目標操舵角を設定
し、この目標操舵角が得られるように該操舵アクチュエ
ータの駆動を制御する制御手段とをそなえ、該画像情報
処理手段が、該画像情報から得られる路面情報を用いて
該車両から所定距離Kだけ離れた地点における偏角βを
算出する偏角算出手段をそなえ、該制御手段が、予め記
憶された車両のスタビリティファクタA及びホイールベ
ースWBと、該車速検出手段から得られる車速Vと、該
距離Kと、該偏角βとから、δ=(1+AV2 )・(W
B/K)・βの関係式に基づいて、目標操舵角δを設定
するという構成により、操舵アクチュエータへの制御信
号である操舵ゲインを可変に設定することができ、曲率
半径の小さなカーブから直線路まで道路の曲率状態に応
じて、自然なフィーリングの自動操舵を実現することが
できる。According to the vehicle automatic steering apparatus of the present invention, a steering actuator for steering the steered wheels of the vehicle, and an image pickup means for picking up an image of a road ahead of the vehicle are provided.
An image information processing means for processing the image information from the image pickup means, a vehicle speed detecting means for detecting the vehicle speed of the vehicle, and a target steering angle are set based on the processing information from the image information processing means. And a control means for controlling the drive of the steering actuator so as to obtain the angle, and the image information processing means uses the road surface information obtained from the image information to determine the deviation at a point separated from the vehicle by a predetermined distance K. The control means includes a declination calculation means for calculating the angle β, and the control means stores a vehicle stability factor A and a wheel base WB stored in advance, a vehicle speed V obtained from the vehicle speed detection means, the distance K, and From the deviation angle β, δ = (1 + AV 2 ) · (W
B / K) .beta., The target steering angle .delta. It is possible to realize automatic steering with a natural feeling according to the curvature state of the road to the road.
【0080】また、請求項8記載の本発明の車両用自動
操舵装置によれば、該所定距離Kが、該車両の車速の関
数として与えられるという構成により、自動操舵による
操舵感を人為的な操舵感に近づけることができる。According to the vehicle automatic steering apparatus of the present invention as defined in claim 8, the predetermined distance K is given as a function of the vehicle speed of the vehicle. The steering feeling can be approximated.
【図1】本発明の一実施例としての車両用自動操舵装置
における機能構成をドライバの操舵操作時の各機能と対
応させるように整理して示す機能ブロック図である。FIG. 1 is a functional block diagram schematically showing the functional configuration of an automatic vehicle steering system as an embodiment of the present invention so as to correspond to each function during a steering operation of a driver.
【図2】本発明の一実施例としての車両用自動操舵装置
における要部構成を示す模式的な構成図である。FIG. 2 is a schematic configuration diagram showing a main configuration of an automatic vehicle steering system as one embodiment of the present invention.
【図3】本発明の一実施例としての車両用自動操舵装置
における曲率半径と偏角との関係を模式的に示す図であ
って、車両上方から見た模式図である。FIG. 3 is a diagram schematically showing the relationship between the radius of curvature and the declination in the vehicle automatic steering device as one embodiment of the present invention, as seen from above the vehicle.
【図4】本発明の一実施例としての車両用自動操舵装置
における車両の偏角と道路のカーブ半径との関係を示す
グラフである。FIG. 4 is a graph showing the relationship between the vehicle declination and the road curve radius in the vehicle automatic steering apparatus as one embodiment of the present invention.
【図5】本発明の一実施例としての車両用自動操舵装置
におけるドライバ操舵による車両の偏角と操舵角との関
係を示すグラフである。FIG. 5 is a graph showing a relationship between a vehicle declination angle and a steering angle due to driver steering in the vehicle automatic steering apparatus as one embodiment of the present invention.
【図6】本発明の一実施例としての車両用自動操舵装置
におけるドライバ操舵によるカーブを走行中の横加速度
のピーク値と横ジャーク(単位時間当りの横加速度の変
化量)のピーク値との関係を示すグラフである。FIG. 6 shows a peak value of lateral acceleration and a peak value of lateral jerk (amount of change in lateral acceleration per unit time) during traveling on a curve by driver steering in the vehicle automatic steering apparatus as one embodiment of the present invention. It is a graph which shows a relationship.
【図7】本発明の一実施例としての車両用自動操舵装置
における操舵開始距離と操舵速度との関係を示すグラフ
である。FIG. 7 is a graph showing the relationship between the steering start distance and the steering speed in the vehicle automatic steering apparatus as one embodiment of the present invention.
【図8】本発明の一実施例としての車両用自動操舵装置
における白線認識方法を説明するための模式図である。FIG. 8 is a schematic diagram for explaining a white line recognition method in the vehicle automatic steering device as one embodiment of the present invention.
【図9】本発明の一実施例としての車両用自動操舵装置
における車速と操舵開始距離との関係を示すグラフであ
る。FIG. 9 is a graph showing a relationship between a vehicle speed and a steering start distance in an automatic vehicle steering system as one embodiment of the present invention.
【図10】本発明の一実施例としての車両用自動操舵装
置における自動操舵の前方注視距離特性をドライバ操舵
と対比して示すグラフである。FIG. 10 is a graph showing a front gaze distance characteristic of automatic steering in a vehicle automatic steering apparatus as one embodiment of the present invention in comparison with driver steering.
【図11】本発明の一実施例としての車両用自動操舵装
置における偏角の変動を説明するための模式的な図であ
って、車両上方から見た模式図である。FIG. 11 is a schematic diagram for explaining a variation of a deviation angle in the vehicle automatic steering device as one embodiment of the present invention, and is a schematic diagram seen from above the vehicle.
【図12】本発明の一実施例としての車両用自動操舵装
置における車両旋回時における車両中心と道路中心との
偏差を示す模式的な図であって、車両上方から見た図で
ある。FIG. 12 is a schematic view showing a deviation between a vehicle center and a road center when the vehicle is turning in the vehicle automatic steering apparatus as one embodiment of the present invention, as viewed from above the vehicle.
【図13】本発明の一実施例としての車両用自動操舵装
置における偏角検出点を車速対応にした場合におけるゲ
インの設定を説明する模式的なブロック図である。FIG. 13 is a schematic block diagram illustrating setting of a gain in a case where a declination detection point corresponds to a vehicle speed in an automatic vehicle steering system as an embodiment of the invention.
【図14】本発明の一実施例としての車両用自動操舵装
置における偏角検出点を固定式にした場合のゲインの設
定を説明する模式的なブロック図であって、図13に対
応する図である。FIG. 14 is a schematic block diagram illustrating gain setting when the declination detection points are fixed in the vehicle automatic steering apparatus as one embodiment of the present invention, and is a diagram corresponding to FIG. 13; Is.
【図15】本発明の一実施例としての車両用自動操舵装
置における効果を説明するための図であって、屈曲路の
一例を示す図である。FIG. 15 is a diagram for explaining an effect in the vehicle automatic steering device as one embodiment of the present invention, and is a diagram showing an example of a curved road.
【図16】本発明の一実施例としての車両用自動操舵装
置における効果を説明するための図であって、(a)は
自動操舵時とドライバ操舵時とにおける屈曲路走行時の
操舵角特性を示すグラフ、(b)は自動操舵時とドライ
バ操舵時とにおける屈曲路走行時の車両の横加速度の特
性を示すグラフである。FIG. 16 is a diagram for explaining the effect of the vehicle automatic steering apparatus as one embodiment of the present invention, in which (a) is a steering angle characteristic during traveling on a curved road during automatic steering and driver steering. And (b) is a graph showing the characteristics of the lateral acceleration of the vehicle during traveling on a curved road during automatic steering and driver steering.
【図17】本発明の一実施例としての車両用自動操舵装
置における効果を説明するための図であって、自動操舵
時とドライバ操舵時とにおける横加速度のピーク値と横
ジャークのピーク値との関係を示すグラフである。FIG. 17 is a diagram for explaining the effect of the vehicle automatic steering apparatus as one embodiment of the present invention, which is the peak value of lateral acceleration and the peak value of lateral jerk during automatic steering and driver steering. It is a graph which shows the relationship of.
【図18】本発明の一実施例としての車両用自動操舵装
置における道路の基準線の認識の一例を説明するための
図であって、(a)は基準線の認識のために取り込まれ
た画像情報を示す図、(b)は(a)に基づいて基準線
を正しく認識した場合の一例を示す図、(c)は(a)
に基づいて基準線を正しく認識できなかった場合の一例
を示す図である。FIG. 18 is a diagram for explaining an example of recognition of a road reference line in the vehicle automatic steering apparatus as one embodiment of the present invention, in which (a) is incorporated for recognition of the reference line. The figure which shows image information, (b) is a figure which shows an example at the time of correctly recognizing a reference line based on (a), (c) is (a)
It is a figure which shows an example in case the reference line was not correctly recognized based on.
【図19】本発明の一実施例としての車両用自動操舵装
置における操舵アクチュエータの全体構成の一例を示す
模式図である。FIG. 19 is a schematic diagram showing an example of the overall configuration of a steering actuator in an automatic vehicle steering system as one embodiment of the present invention.
【図20】本発明の一実施例としての車両用自動操舵装
置における前方注視距離の他の設定例について説明する
ためのグラフであって、図10に対応するグラフであ
る。20 is a graph for explaining another example of setting the forward gaze distance in the vehicle automatic steering device as one embodiment of the present invention, and is a graph corresponding to FIG.
【図21】本発明の一実施例としての車両用自動操舵装
置における偏角ゲインの設定について説明するための図
である。FIG. 21 is a diagram for explaining setting of a declination gain in the vehicle automatic steering device as one embodiment of the present invention.
1 車両 2 操舵輪 2A 操舵アクチュエータ 3 撮像手段としてのカメラ 3A 車両中心 4 画像情報処理手段 4A 原画像 4B 平面視画像 4C 画像変換手段 5 制御手段としてのコントローラ 5A 操舵角設定部 5B 操舵開始距離設定部 5C 操舵速度設定部 5D 加算器 6 偏角算出手段 7 横偏差算出手段 8 道路中心 9 曲率状態推定手段 10 白線探索エリア 11 水平線 12 道路基準線としての白線 14 ガードレール 15,15A〜15D 白線候補点 16 車速検出手段 20 ステアリングホイール 103 操舵力伝達系 104 パワーステアリング機構 104A 油圧シリンダ 106 モード切替バルブ装置 107 自動操舵制御バルブ 110 オイルポンプ 111 オイルタンク 112 分流弁 113 リリーフバルブ 115 EPSバルブ 122 電動モータ 120 ラック位置検出センサ DESCRIPTION OF SYMBOLS 1 vehicle 2 steering wheel 2A steering actuator 3 camera as imaging means 3A vehicle center 4 image information processing means 4A original image 4B planar view image 4C image conversion means 5 controller as control means 5A steering angle setting section 5B steering start distance setting section 5C Steering speed setting unit 5D Adder 6 Declination calculation means 7 Lateral deviation calculation means 8 Road center 9 Curvature state estimation means 10 White line search area 11 Horizontal line 12 White line as road reference line 14 Guardrail 15, 15A to 15D White line candidate point 16 Vehicle speed detecting means 20 Steering wheel 103 Steering force transmission system 104 Power steering mechanism 104A Hydraulic cylinder 106 Mode switching valve device 107 Automatic steering control valve 110 Oil pump 111 Oil tank 112 Dividing valve 113 Relief valve 115 EPS Lube 122 electric motor 120 position detecting sensor
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.6 識別記号 庁内整理番号 FI 技術表示箇所 G06T 1/00 H04N 7/18 K // B62D 101:00 113:00 117:00 137:00 (72)発明者 真保 俊也 東京都港区芝五丁目33番8号 三菱自動車 工業株式会社内 (72)発明者 山田 喜一 東京都港区芝五丁目33番8号 三菱自動車 工業株式会社内─────────────────────────────────────────────────── ─── Continuation of the front page (51) Int.Cl. 6 Identification code Office reference number FI Technical display location G06T 1/00 H04N 7/18 K // B62D 101: 00 113: 00 117: 00 137: 00 ( 72) Inventor Toshiya Maho 5-3-8, Shiba, Minato-ku, Tokyo Mitsubishi Motors Corporation (72) Inventor, Kiichi Yamada 5-33-8, Shiba, Minato-ku, Tokyo Mitsubishi Motors Corporation
Claims (8)
ータと、 該車両前方の道路を撮像する撮像手段と、 該撮像手段からの画像情報を処理する画像情報処理手段
と、 該画像情報処理手段からの処理情報に基づいて目標操舵
角を設定しこの目標操舵角が得られるように該操舵アク
チュエータの駆動を制御する制御手段とをそなえ、 該画像情報処理手段が、 該画像情報に基づいて、該道路の基準線に対する該車両
の横偏差を算出する横偏差算出手段と、 該画像情報に基づいて、該車両前方の道路方向に対する
該車両の偏角を算出する偏角算出手段とをそなえるとと
もに、 該制御手段が、該横偏差算出手段及び該偏角算出手段か
らの情報に基づいて、該横偏差及び該偏角がいずれも減
少していくように、該目標操舵角を設定することを特徴
とする、車両用自動操舵装置。1. A steering actuator for steering steered wheels of a vehicle, an imaging means for imaging a road ahead of the vehicle, an image information processing means for processing image information from the imaging means, and the image information processing means. And a control means for controlling the drive of the steering actuator so as to obtain this target steering angle, and the image information processing means, based on the image information, A lateral deviation calculating means for calculating a lateral deviation of the vehicle with respect to a reference line of the road, and a deviation angle calculating means for calculating a deviation angle of the vehicle with respect to a road direction ahead of the vehicle based on the image information are provided. The control means sets the target steering angle such that both the lateral deviation and the deflection angle decrease based on the information from the lateral deviation calculation means and the deflection angle calculation means. Features and That, automatic steering apparatus for a vehicle.
られる路面情報のうちの該車両に最も近い地点の基準線
位置情報を用いて該横偏差を算出し、 該偏角算出手段が、該画像情報から得られる路面情報を
用いて該車両から所定距離だけ離れた地点における該偏
角を算出するように設定されていることを特徴とする、
請求項1記載の車両用自動操舵装置。2. The lateral deviation calculating means calculates the lateral deviation using the reference line position information of a point closest to the vehicle in the road surface information obtained from the image information, and the deviation angle calculating means , The road surface information obtained from the image information is used to calculate the declination at a point separated by a predetermined distance from the vehicle,
The vehicle automatic steering apparatus according to claim 1.
そなえ、 該偏角算出手段が、該車速検出手段からの情報を受け
て、該車両から該車速に応じた距離だけ離れた地点にお
ける該偏角を算出するように設定されていることを特徴
とする、請求項2記載の車両用自動操舵装置。3. A vehicle speed detecting means for detecting a vehicle speed of said vehicle, wherein said declination calculating means receives information from said vehicle speed detecting means and at a point away from said vehicle by a distance corresponding to said vehicle speed. 3. The vehicle automatic steering device according to claim 2, wherein the automatic steering device is set so as to calculate the declination angle.
れる路面情報のうち該車両から所定距離だけ離れた第1
の地点における基準線位置情報と、該第1の地点よりも
さらに該車両から離れた第2の地点における基準線位置
情報とから、該偏角を算出するように設定されているこ
とを特徴とする、請求項2記載の車両用自動操舵装置。4. The first deviation of the road surface information obtained from the image information from the vehicle by a predetermined distance.
Is set so as to calculate the declination from the reference line position information at the point and the reference line position information at the second point further away from the vehicle than the first point. The automatic steering apparatus for a vehicle according to claim 2.
る路面情報のうちの該車両に最も近い地点であることを
特徴とする、請求項4記載の車両用自動操舵装置。5. The vehicle automatic steering apparatus according to claim 4, wherein the first point is a point closest to the vehicle in road surface information obtained from the image information.
そなえ、 該第2の地点が、該車速検出手段からの情報に基づい
て、該車両から該車速に応じた距離だけ離れた地点であ
ることを特徴とする、請求項5記載の車両用自動操舵装
置。6. A vehicle speed detecting means for detecting a vehicle speed of the vehicle is provided, wherein the second point is a point distant from the vehicle by a distance corresponding to the vehicle speed based on the information from the vehicle speed detecting means. The automatic steering apparatus for a vehicle according to claim 5, wherein
ータと、 該車両前方の道路を撮像する撮像手段と、 該撮像手段からの画像情報を処理する画像情報処理手段
と、 該車両の車速を検出する車速検出手段と、 該画像情報処理手段からの処理情報に基づいて目標操舵
角を設定し、この目標操舵角が得られるように該操舵ア
クチュエータの駆動を制御する制御手段とをそなえ、 該画像情報処理手段が、該画像情報から得られる路面情
報を用いて該車両から所定距離Kだけ離れた地点におけ
る偏角βを算出する偏角算出手段をそなえ、 該制御手段が、予め記憶された車両のスタビリティファ
クタA及びホイールベースWBと、該車速検出手段から
得られる車速Vと、該距離Kと、該偏角βとから、δ=
(1+AV2 )・(WB/K)・βの関係式に基づい
て、目標操舵角δを設定することを特徴とする、車両用
自動操舵装置。7. A steering actuator for steering steered wheels of a vehicle, an image pickup means for picking up an image of a road ahead of the vehicle, an image information processing means for processing image information from the image pickup means, and a vehicle speed of the vehicle. A vehicle speed detecting means for detecting the vehicle speed; and a control means for setting a target steering angle based on the processing information from the image information processing means and controlling the drive of the steering actuator so as to obtain the target steering angle, The image information processing means includes a deviation angle calculating means for calculating a deviation angle β at a point separated from the vehicle by a predetermined distance K using road surface information obtained from the image information, and the control means is stored in advance. From the stability factor A and the wheel base WB of the vehicle, the vehicle speed V obtained from the vehicle speed detecting means, the distance K, and the deviation angle β, δ =
An automatic steering device for a vehicle, wherein a target steering angle δ is set based on a relational expression of (1 + AV 2 ) · (WB / K) · β.
して与えられることを特徴とする、請求項7記載の車両
用自動操舵装置。8. The automatic vehicle steering system according to claim 7, wherein the predetermined distance K is given as a function of the vehicle speed of the vehicle.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23056093A JP3246119B2 (en) | 1993-09-16 | 1993-09-16 | Automatic steering device for vehicles |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23056093A JP3246119B2 (en) | 1993-09-16 | 1993-09-16 | Automatic steering device for vehicles |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH0781602A true JPH0781602A (en) | 1995-03-28 |
JP3246119B2 JP3246119B2 (en) | 2002-01-15 |
Family
ID=16909672
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP23056093A Expired - Fee Related JP3246119B2 (en) | 1993-09-16 | 1993-09-16 | Automatic steering device for vehicles |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3246119B2 (en) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11115554A (en) * | 1997-10-21 | 1999-04-27 | Fuji Heavy Ind Ltd | Vehicle motion control device |
JPH11189166A (en) * | 1997-12-25 | 1999-07-13 | Mitsubishi Motors Corp | Lane deviation preventing device |
JP2003026017A (en) * | 2001-07-19 | 2003-01-29 | Nissan Motor Co Ltd | Steering controller for vehicle |
JP2005125853A (en) * | 2003-10-22 | 2005-05-19 | Aisin Seiki Co Ltd | Lane travel support device for vehicle |
JP2005170327A (en) * | 2003-12-15 | 2005-06-30 | Nissan Motor Co Ltd | Automatic steering control device for vehicle |
JP2007022431A (en) * | 2005-07-20 | 2007-02-01 | Toyota Motor Corp | Traveling support device |
JP2009137410A (en) * | 2007-12-05 | 2009-06-25 | Toyota Motor Corp | Travel track generation method and travel track generation device |
JP2009161100A (en) * | 2008-01-09 | 2009-07-23 | Fuji Heavy Ind Ltd | Traffic lane following control device and traffic lane following control method |
JP2013111985A (en) * | 2011-11-24 | 2013-06-10 | Jtekt Corp | Vehicle attitude controller |
CN113009412A (en) * | 2021-01-06 | 2021-06-22 | 武汉理工大学 | Positioning system and method based on RFID digital pavement |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03113513A (en) * | 1989-09-27 | 1991-05-14 | Nissan Motor Co Ltd | Speed-sensitive steering controller for self-traveling vehicle |
JPH04273301A (en) * | 1991-02-28 | 1992-09-29 | Toyota Motor Corp | Automatic vehicle driving device |
-
1993
- 1993-09-16 JP JP23056093A patent/JP3246119B2/en not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03113513A (en) * | 1989-09-27 | 1991-05-14 | Nissan Motor Co Ltd | Speed-sensitive steering controller for self-traveling vehicle |
JPH04273301A (en) * | 1991-02-28 | 1992-09-29 | Toyota Motor Corp | Automatic vehicle driving device |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11115554A (en) * | 1997-10-21 | 1999-04-27 | Fuji Heavy Ind Ltd | Vehicle motion control device |
JPH11189166A (en) * | 1997-12-25 | 1999-07-13 | Mitsubishi Motors Corp | Lane deviation preventing device |
JP2003026017A (en) * | 2001-07-19 | 2003-01-29 | Nissan Motor Co Ltd | Steering controller for vehicle |
JP4639545B2 (en) * | 2001-07-19 | 2011-02-23 | 日産自動車株式会社 | Vehicle steering control device |
JP2005125853A (en) * | 2003-10-22 | 2005-05-19 | Aisin Seiki Co Ltd | Lane travel support device for vehicle |
JP4599835B2 (en) * | 2003-12-15 | 2010-12-15 | 日産自動車株式会社 | Automatic steering control device for vehicle |
JP2005170327A (en) * | 2003-12-15 | 2005-06-30 | Nissan Motor Co Ltd | Automatic steering control device for vehicle |
JP4595725B2 (en) * | 2005-07-20 | 2010-12-08 | トヨタ自動車株式会社 | Driving support device |
JP2007022431A (en) * | 2005-07-20 | 2007-02-01 | Toyota Motor Corp | Traveling support device |
JP2009137410A (en) * | 2007-12-05 | 2009-06-25 | Toyota Motor Corp | Travel track generation method and travel track generation device |
JP2009161100A (en) * | 2008-01-09 | 2009-07-23 | Fuji Heavy Ind Ltd | Traffic lane following control device and traffic lane following control method |
JP2013111985A (en) * | 2011-11-24 | 2013-06-10 | Jtekt Corp | Vehicle attitude controller |
CN113009412A (en) * | 2021-01-06 | 2021-06-22 | 武汉理工大学 | Positioning system and method based on RFID digital pavement |
Also Published As
Publication number | Publication date |
---|---|
JP3246119B2 (en) | 2002-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3201094B2 (en) | Automatic steering device for vehicles | |
US6961661B2 (en) | Vehicle surroundings monitoring apparatus and traveling control system incorporating the apparatus | |
JP5359085B2 (en) | Lane maintenance support device and lane maintenance support method | |
JP3246428B2 (en) | Lane departure prevention device | |
CN107914767B (en) | Steering assist device | |
JP5569631B2 (en) | Lane maintenance support method and lane maintenance support device | |
US20040098196A1 (en) | Vehicle surroundings monitoring apparatus and traveling control system incorporating the apparatus | |
US20100256910A1 (en) | Vehicle surroundings monitoring apparatus and traveling control system incorporating the apparatus | |
JP3186662B2 (en) | Lane departure prevention device | |
JP5012849B2 (en) | Vehicle travel control device | |
JP2005508781A (en) | Driver assist system and driving method thereof | |
CN108454624A (en) | Driving assist system in track | |
JP3201323B2 (en) | Lane departure prevention device | |
JP2007261449A (en) | Traveling target point setting device, lane following support device and lane deviation prevention device | |
JPH0781604A (en) | Automatic travel vehicle | |
JP3314698B2 (en) | Steering force assist device | |
JP2007269312A (en) | Driving operation auxiliary device for vehicle | |
JP7348775B2 (en) | Vehicle lane departure prevention control device | |
JPH0781602A (en) | Automatic steering gear for vehicle | |
JPH11147481A (en) | Lane deviation prevention system | |
JP3566802B2 (en) | Vehicle steering system | |
JP2004243783A (en) | Lane deviation preventing device | |
JP7005757B2 (en) | Vehicle control device | |
JPH0785249A (en) | Method for recognizing white line on road | |
CN113260553A (en) | Steering control device and steering control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20011002 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20071102 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081102 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091102 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091102 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101102 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111102 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111102 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121102 Year of fee payment: 11 |
|
LAPS | Cancellation because of no payment of annual fees |