JPH09183383A - 自動ステアリング制御装置 - Google Patents

Abstract

(57)【要約】 【課題】天候条件や道路形状等によらずに車両の高速走
行を可能としつつ車両を所要の走行経路に確実且つ的確
に沿わせつつ自動走行を行うことができる自動ステアリ
ング制御装置を提供する。 【解決手段】磁気ネイルＣが配列された走行経路Ｂに沿
って車両Ａが走行するように車両Ａの自動操舵を行う自
動ステアリング制御装置において、車両Ａの現在の車速
Ｖと、磁気ネイルＣの検出に基づく車両Ａの走行経路Ｂ
に対する現在の位置関係と、ＬＣＸケーブルＤとの通信
や車両Ａに備えた地図データを基に取得した車両前方の
走行経路Ｂの曲率情報とに基づき、車両Ａの操舵制御量
を決定する。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、一般道路や高速道
路において、ドライバーの運転をアシストし、車両を所
要の走行経路に沿って走行させるように自動操舵を行う
自動ステアリング制御装置に関する。

【０００２】

【従来の技術】近年、道路の車両を走行させるべき走行
経路に沿って磁気ネイル等の経路マーカを配列しておく
と共に、その経路マーカを検出するマーカセンサを車両
に設け、走行時にマーカセンサによる経路マーカの検出
出力に基づき車両の時々刻々の現在位置における走行経
路との位置関係（車両の走行経路に対する横ずれ量等）
を把握しつつ、車両を走行経路に沿って走行させるよう
に車両の自動操舵を行って自動走行を行うシステムが提
案されている。

【０００３】この場合、従来のシステムでは、車両の操
舵制御量（ステアリングの操舵角の値）をδ、現在の走
行位置における車両の走行経路からの横方向のずれ量を
ε_y、車両の現在の車速をＶとした場合、次式により操
舵制御量δを決定し、その決定した制御量δに従ってス
テアリング操作をアクチュエータにより行うようにして
いた。

【０００４】δ＝Ｐ（Ｖ）・ε_y ＋Ｉ（Ｖ）・∫ε_y dt ここで、Ｐ（Ｖ）・ε_y は比例積分制御の比例項を示
し、係数Ｐ（Ｖ）は、車速Ｖに応じてあらかじめ定めた
関数値である。また、Ｉ（Ｖ）・∫ε_y dtは積分項を示
す、係数Ｉ（Ｖ）は、車速Ｖに応じてあらかじめ定めた
関数値である。

【０００５】このような操舵制御によって、車両の走行
経路からの横方向のずれ量ε_y が解消するようにステア
リング操舵がなされる。

【０００６】しかしながら、このような制御手法では、
車両の現在の車速Ｖや、走行経路に対する現在の横ずれ
量ε_y によってのみ、車両の操舵量を決定するため、そ
の誤差が蓄積し易く、所要の走行経路から車両が逸脱し
たり、走行経路に対して車両が大きく蛇行する等の不都
合を生じやすい。特に、６０ｋｍ／ｈ以上、望ましくは
１００ｋｍ／ｈ以上の高速で車両を走行させようとした
場合に、カーブの入口付近では、車両を走行経路に沿わ
せるための車両の操舵制御の追従性が低下し、所要の走
行経路に車両を的確に沿わせることが困難となるばかり
か、隣の車線に車両がはみ出してしまうというような事
態も生じる虞れがある。また、カーブの入口付近では、
車両の走行経路に対する横ずれ量ε_y が急激に大きくな
るため、操舵制御量が急変し、ステアリング操作の急変
を生じる虞れもある。

【０００７】このような不都合を解決するため、ＣＣＤ
カメラを車両に搭載して車両の前方の道路形状（道路の
曲がり具合等）を認識し、その認識した道路形状に合わ
せた操舵制御を行って、高速での自動走行を可能としよ
うとするシステムが提案されている。

【０００８】しかしながら、この手法では、操舵制御を
的確に行うためには、ＣＣＤカメラにより、いかに正確
に車両前方の道路形状を認識できるかに依存するもの
の、雨や雪等の悪天候の下では、ＣＣＤカメラの撮像能
力は著しく低下し、これに伴って、車両前方の道路形状
を正しく認識することが困難となる。従って、雨や雪等
の悪天候の下では、的確な操舵制御を行うことが困難と
なる。

【０００９】この場合、悪天候においても、前方の道路
形状を精度よく認識するために赤外線カメラを用いるこ
とが考えられるが、赤外線カメラは一般に高価であると
共に、システムが大がかりなものとなりやすく、このよ
うな赤外線カメラシステムを車両に備えることは適切で
ない。

【００１０】

【発明が解決しようとする課題】本発明はかかる背景に
鑑み、天候条件や道路形状等によらずに車両の高速走行
を可能としつつ車両を所要の走行経路に確実且つ的確に
沿わせつつ自動走行を行うことができる自動ステアリン
グ制御装置を提供することを目的とする。

【００１１】

【課題を解決するための手段】かかる目的を達成するた
めに本発明の第１の態様は、あらかじめ経路マーカが付
設された所定の走行経路に沿って車両が走行するよう該
車両の自動操舵を行う自動ステアリング制御装置におい
て、前記走行経路の地図データを保持する手段と、車両
に備えたマーカセンサにより前記経路マーカを検出し、
その検出出力に基づき車両の現在の走行位置における前
記走行経路との位置関係を逐次求める手段と、少なくと
も該車両の前記走行経路との時々刻々の位置関係及び前
記地図データとに基づき該地図データ上における車両の
走行位置を逐次把握する手段と、前記地図データ上にお
ける走行経路の各所の曲率情報を車両外部に設けられた
走行情報提供設備との通信により取得する手段と、該走
行情報提供設備から与えられる走行経路の曲率情報に基
づき、前記把握した車両の現在の走行位置の前方におけ
る走行経路の曲率情報を取得する手段と、少なくともそ
の取得した車両の前方の走行経路の曲率情報、車両の現
在の車速及び車両の前記走行経路との現在の位置関係に
基づき車両の操舵制御量を決定する手段とを備えたこと
を特徴とする。

【００１２】かかる本発明の第１の態様によれば、前記
マーカセンサによる前記経路マーカの検出出力により得
られる車両の走行経路に対する時々刻々の位置関係のデ
ータを用いて、車両で保持した地図データ上における車
両の現在の走行位置を逐次把握する。また、前記走行情
報提供設備から、前記走行経路の各所の曲率情報が通信
により車両側に与えられる。そして、この与えられた曲
率情報に基づいて、前記把握した車両の現在の走行位置
の前方における走行経路の曲率情報を取得し、この取得
した曲率情報と、車両の現在の車速、車両の走行経路と
の現在の位置関係に基づき、車両の操舵制御量を決定す
る。これにより、車両の現在の車速や車両の走行経路と
の現在の位置関係のみならず、車両前方の走行経路の曲
率（曲がり具合）を考慮した車両の操舵制御が行われる
こととなる。

【００１３】この場合、この操舵制御に際して必要な車
両の走行経路との現在の位置関係は、車両の走行位置に
おける前記マーカセンサによる経路マーカの検出出力に
基づいて求められるので、比較的精度よく車両の走行経
路との位置関係を求めることが可能であり、さらに、こ
の位置関係の時々刻々のデータと車両に保持した走行経
路の地図データとを用いて、車両の走行位置も比較的精
度よく把握することが可能となる。また、車両前方の曲
率情報は、走行情報提供設備との通信によって得られる
ものであるため、天候条件等の影響を受けずに精度のよ
い曲率情報を取得することが可能となる。

【００１４】従って、本発明の第１の態様によれば、天
候条件や道路形状等によらずに車両の高速走行を可能と
しつつ車両を所要の走行経路に確実且つ的確に沿わせつ
つ自動走行を行うことが可能となる。

【００１５】尚、前記走行情報提供設備は、例えば前記
走行経路に沿って道路に設置された漏洩同軸ケーブルで
ある。

【００１６】また、本発明の第２の態様は、前記の目的
を達成するために、あらかじめ経路マーカが付設された
所定の走行経路に沿って車両が走行するよう該車両の自
動操舵を行う自動ステアリング制御装置において、前記
走行経路の地図データを保持する手段と、車両に備えた
マーカセンサにより前記経路マーカを検出し、その検出
出力に基づき車両の現在の走行位置における前記走行経
路との位置関係を逐次求める手段と、少なくとも該車両
の前記走行経路との時々刻々の位置関係及び前記地図デ
ータとに基づき該地図データ上における車両の走行位置
を逐次把握する手段と、その把握した車両の現在の走行
位置の前方における走行経路の曲率情報を前記地図デー
タから取得する手段と、少なくともその取得した車両の
前方の走行経路の曲率情報、車両の現在の車速及び車両
の前記走行経路との現在の位置関係に基づき車両の操舵
制御量を決定する手段とを備えたことを特徴とする。

【００１７】かかる本発明の第２の態様によれば、前記
第１の態様と全く同様に、車両に保持した地図データ上
で、車両の現在の走行位置が逐次把握される。そして、
その把握した車両の現在の走行位置の前方における走行
経路の曲率情報を前記地図データから取得し、この取得
した曲率情報と、車両の現在の車速、車両の走行経路と
の現在の位置関係に基づき、車両の操舵制御量を決定す
る。これにより、車両の現在の車速や車両の走行経路と
の現在の位置関係のみならず、車両前方の走行経路の曲
率（曲がり具合）を考慮した車両の操舵制御が行われる
こととなる。

【００１８】この場合、第１の態様と同様に、この操舵
制御に際して必要な車両の走行経路との現在の位置関係
は、車両の走行位置における前記マーカセンサによる経
路マーカの検出出力に基づいて求められるので、比較的
精度よく車両の走行経路との位置関係を求めることが可
能であり、さらに、この位置関係の時々刻々のデータと
車両に保持した走行経路の地図データとを用いて、車両
の走行位置も比較的精度よく把握することが可能とな
る。また、車両前方の曲率情報は、車両に保持した地図
データに基づいて得られるものであるため、天候条件等
の影響を受けずに精度のよい曲率情報を取得することが
可能となる。

【００１９】従って、本発明の第２の態様によっても、
天候条件や道路形状等によらずに車両の高速走行を可能
としつつ車両を所要の走行経路に確実且つ的確に沿わせ
つつ自動走行を行うことが可能となる。

【００２０】かかる本発明の第１及び第２の態様では、
前記経路マーカは前記走行経路に沿って間隔を存して道
路に配列された磁気発生源であり、前記マーカセンサは
磁気センサであることが好ましい。このようにすること
で、磁気発生源の検出を天候条件のみならず、道路の汚
れ等の影響も受けずに行うことが可能となり、ひいて
は、車両の走行啓夫に対する位置関係をより確実に把握
することが可能となる。

【００２１】また、本発明の第１及び第２の態様では、
前記車両の走行経路との位置関係は、車両の中心部の走
行経路に対する横方向偏差と、車両の進行方向の走行経
路に対する方位角偏差とを含む。

【００２２】また、前記車両の走行位置を把握する手段
は、より具体的には、車両の車速及びヨーレートに基づ
き車両の走行軌跡を逐次求める手段を含み、その求めた
走行軌跡と、前記車両の前記走行経路との時々刻々の位
置関係と、該走行経路の前記地図データとから該地図デ
ータ上における車両の現在の走行位置を把握する。

【００２３】さらに、本発明の第１及び第２の態様で
は、好ましくは、車両の現在の走行位置から現在の走行
状態で走行した場合における所定時間後の車両の進行方
位と、該所定時間後の車両の走行位置に対応する走行経
路上の地点における該走行経路の方位との偏差角度を予
見角度として求める手段を具備し、前記操舵制御量を決
定する手段は、前記予見角度と、車両の前方の走行経路
の曲率情報と、車両の現在の車速と、車両の前記走行経
路との現在の位置関係とに基づき車両の操舵制御量を決
定する。

【００２４】このように所定時間後の将来的な車両の進
行方位と走行経路の方位との偏差角度を予見角度として
予測し、これを車両の操舵制御量を決定する際にさらに
加味することで、より円滑に走行経路に沿った車両の走
行を行うことが可能となる。

【００２５】

【発明の実施の形態】以下、図を参照しつつ本発明の実
施形態を説明する。

【００２６】本実施形態における操舵制御アルゴリズム
は、複数の車両が適正な車間距離を保持しつつ追従走行
を行う所謂プラトーン走行において、各車両の操舵制御
を行う場合のみならず、さらには、一台の車両が単独で
走行する場合の操舵制御にも用いることができるもので
ある。

【００２７】図１は本実施形態における車両の走行状態
を示している。

【００２８】本実施形態の走行システムでは、同図に示
すように、道路の車両Ａを走行させるべき経路としてあ
らかじめ定められた所要の走行経路Ｂ上において、経路
マーカとしての磁気ネイルＣが等間隔で埋め込まれて配
列され、また、路側には走行情報提供設備としての漏洩
同軸ケーブルＤ（ＬＣＸケーブル）が設置されている。
この漏洩同軸ケーブルＤは、走行経路Ｂ上を走行する車
両Ａに、例えば走行経路Ｂの各所における曲率情報や路
面状態情報、速度指令情報等を送信する。また、車両Ａ
には、その前部及び後部の下面部に、それぞれその下方
に位置した磁気ネイルＣの磁気を検出する磁気センサ
１，１が備えられている。車両Ａは、これらの磁気セン
サ１，１の検出データや漏洩同軸ケーブルＤから与えら
れる情報等に基づいて、車両Ａの車速制御や操舵制御を
行いつつ走行経路Ｂに沿って自動走行する。尚、各磁気
センサ１は、その下方に磁気ネイルＣが位置したとき、
車両Ａの車幅方向の中心線Ｘに対する該磁気ネイルＣの
車幅方向での変位量ｄf ，ｄr に応じた信号、換言すれ
ば、車両Ａの前部及び後部のそれぞれの箇所での走行経
路Ｂに対する車両Ａの横方向の変位量ｄf ，ｄr に応じ
た信号を出力する。

【００２９】上記のような走行経路Ｂ上を走行する車両
Ａは、その走行を行うために図３のブロック図に示すシ
ステム構成を具備している。

【００３０】すなわち、車両Ａは、前記磁気センサ１，
１の他、ＬＣＸケーブルＤから送信される走行経路Ｂの
曲率情報等を受信するＬＣＸ情報受信機２と、車両Ａに
生じたヨーレートを検出するヨーレートセンサ３と、車
両Ａの進行方向の加速度を検出する加速度センサ４と、
車両Ａの車速や走行距離を検出するための車輪回転速度
センサ５と具備する。

【００３１】また、車両Ａは、自車の走行軌跡や走行経
路Ｂに対する位置関係を逐一計算して、後述の地図デー
タ上における自車の走行位置を求めるナビゲーション装
置６と、自車の制御計画を演算する制御計画処理装置７
と、ＬＣＸ情報送受信機２を介したＬＣＸケーブルＤと
の通信や、走行経路Ｂ上を走行する車両間での各車両の
走行状態を示す情報の通信を制御する通信制御装置８
と、ナビゲーション装置６の出力データ等に基づき自車
のステアリングの操舵制御量を演算する横方向制御装置
９と、横方向制御装置９が演算した操舵制御量に従って
車両の操舵を行う電子制御パワーステアリング・アクチ
ュエータ１０とを具備する。尚、制御計画処理装置７
は、走行経路Ｂ上における自車の車速計画を作成する車
速計画装置１１と、この作成された車速計画等に従って
自車の速度制御量を演算する車速制御装置１２とを具備
し、車速制御装置１２は、演算した速度制御量により、
ブレーキ制御アクチュエータ１３やスロットル制御アク
チュエータ１４を制御する。また、ナビゲーション装置
６、通信制御装置８、横方向制御装置９、車速計画装置
１１、及び車速制御装置１２は、いずれも各々に演算処
理装置（ＣＰＵ）を具備し、適宜、相互にデータの授受
がなされるようになっている。

【００３２】次に、このようなシステム構成を有する車
両Ａの操舵制御アルゴリズムの第１の実施形態を図３乃
至図６を参照して説明する。図３は操舵制御のフローチ
ャート、図４乃至図６は動作説明図を示している。図４
においては、ａは時刻ｔ＝０（今現在）における車両Ａ
の実際の走行位置、ｂは現在の走行状態で走行した場合
にあらかじめ定めた予見時間Ｔpre （１．３秒）後に到
達すると推定される車両Ａの走行位置、ｃは走行経路Ｂ
上における予見時間Ｔpre （１．３秒）後の車両Ａの予
定走行位置、ａ’は今現在の車両Ａの実際の進行方向、
ａ''はａ’との平行線、ｂ’は予見時間Ｔpre （１．３
秒）の車両Ａの推定位置ｂにおける予想進行方向、ｂ''
はｂ’との平行線である。さらに、ｃ’は予見時間Ｔpr
e 後の走行経路Ｂ上の予定走行位置ｃにおける進行方向
（予定走行位置ｃにおける走行経路Ｂの接線）、ｃ''は
ｃ’との平行線である。また、Ｒｎは例えば０．８〜
１．２秒の範囲で定められた所定時間Ｔ（例えば１秒）
後の車両Ａの走行位置における走行経路Ｂの旋回半径
（曲率の逆数）、Ｒn+1 は予見時間Ｔpre 後の走行経路
Ｂ上の予定走行位置ｃにおける走行経路Ｂの旋回半径
（曲率の逆数）である。またεy は車両Ａの中心部の走
行経路Ｂに対する横方向の変位量（横方向偏差）、θは
車両Ａの現在位置において車両Ａの進行方向と走行経路
Ｂとのなす角度誤差（方位角偏差）である。尚、第１の
実施形態では、前記予見時間Ｔpre や、その予見時間Ｔ
pre 後の走行経路Ｂの旋回半径Ｒn+1 は使用せず、これ
らは、後述の第２の実施形態において使用するものであ
る。

【００３３】図３を参照して本実施形態では、時刻ｔ＝
０における車両Ａの現在位置では、まず、ステップ１に
おいて、前記通信制御装置８により、ＬＣＸケーブルＤ
からＬＣＸ情報送受信機２を介して車両Ａの前方を含む
走行経路Ｂの所要の区間の各所における曲率情報を受信
して、それを図示しないメモリに記憶保持する。

【００３４】ステップ２においては、車両Ａの前後の各
磁気センサ１により検出される該磁気センサ１の下方に
位置した磁気ネイルＣの検出データをメモリに記憶保持
する。この検出データは、各磁気センサ１の箇所におけ
る車両Ａの走行経路Ｂに対する横方向の変位量を示すデ
ータであり、前記ナビゲーション装置６に与えられる。

【００３５】ステップ３においては、ナビゲーション装
置６が、ステップ２において取り込まれた車両Ａの前後
の両磁気センサ１，１の検出データから、車両Ａの中心
部の走行経路Ｂに対する横方向の変位量εy と、車両Ａ
の進行方向と走行経路Ｂとのなす角度誤差θ（図１及び
図４参照）とを求める。これらの変位量εy や角度誤差
θは、各磁気センサ１，１の箇所における車両Ａの走行
経路Ｂに対する横方向の変位量ｄf ，ｄr （各磁気セン
サ１，１の検出データ。図１参照）から、磁気センサ
１，１の間隔、該磁気センサ１，１と車両中心部との位
置関係等に応じた幾何学的な所定の演算により算出され
る。

【００３６】具体的には、例えば図１を参照して、車両
Ａの進行方向に向かって車両中心線Ｘよりの左側を各磁
気センサ１，１により検出される変位量ｄf ，ｄr の正
方向、車両中心線Ｘよりも右側を負方向としたとき、図
１の状態では、ｄf ＞０、ｄr ＜０で、このとき、角度
誤差θは磁気センサ１，１の間隔をＬとすると、次式に
より算出される。

【００３７】θ＝ｔａｎ^-1［（ｄf −ｄr ）／Ｌ］ また、車両Ａの中心部（本実施形態では、磁気センサ
１，１の間の中央点）の変位量εy は、次式により算出
される。

【００３８】εy ＝（ｄf ＋ｄr ）／２ ステップ４では、前記車輪回転速度センサ５の出力によ
り、現在の車速が制御計画処理装置７により演算され、
その演算された車速と、ヨーレートセンサ３により検出
された車両Ａのヨーレートとがナビゲーション装置６に
取り込まれてメモリに記憶保持される。

【００３９】ステップ５では、ナビゲーション装置６に
おいて、ステップ４で取り込まれた車両Ａの車速とヨー
レートとを用いて自車の走行軌跡が算出され、さらにス
テップ３で求められた車両Ａの中心部の変位量εy に基
づき、自車の走行軌跡に対する走行経路Ｂの位置関係が
算出される。

【００４０】さらに詳細には、図５を参照して、本実施
形態では、例えば車両Ａの自動走行を開始したスタート
地点を基準としてｘ−ｙ座標（ｘ軸：スタート地点にお
ける車幅方向、ｙ軸：スタート地点における車長方向）
が設定され、そのスタート地点から検出されたヨーレー
トが前記ステップ４で取り込まれる毎に積分していくこ
とで、このｘ−ｙ座標における車両Ａの進行方位角θx
（車両の進行方向とｘ軸とのなす角度）を逐一算出す
る。尚、この進行方位角θx を算出するに際しては、車
両Ａの操舵量が比較的大きい場合に生じる所謂、横滑り
角（車両の実際の進行方向と車両の前後方向とのなす角
度）を加味してもよい。

【００４１】そして、この進行方位角θx と、ステップ
４でヨーレートと共に取り込まれた車速Ｖとから次の積
分演算を行っていくことで、ｘ−ｙ座標における車両Ａ
の座標成分（ｘt ，ｙt ）を逐一算出し、それにより、
図５に示すような自車の走行軌跡Ｋを求める。

【００４２】ｘt ＝∫Ｖ・ｃｏｓθx dt ｙt ＝∫Ｖ・ｓｉｎθx dt さらに、ステップ３で取り込まれた車両Ａの中心部の変
位量εy により、走行軌跡Ｋ上の各車両位置（ｘt ，ｙ
t ）に対応する走行経路Ｂの座標成分（ｘb ，ｙb ）を
走行軌跡Ｋの算出と並行して逐一求め、それにより、ｘ
−ｙ座標における走行経路Ｂの位置を求める。この場
合、走行経路Ｂの座標成分（ｘb ，ｙb ）は、走行軌跡
Ｋ上の各車両位置（ｘt ，ｙt ）から車幅方向に変位量
εy だけずらした点の座標成分である。

【００４３】次いで、ステップ６では、ナビゲーション
装置６においてあらかじめＣＤ−ＲＯＭ等の電子地図媒
体に保持された走行経路Ｂの地図データ（磁気ネイルＣ
の点列データ）と、ステップ５で前述の如くｘ−ｙ座標
で求められた車両Ａの走行軌跡Ｋ及び走行経路Ｂとを照
合してマップマッチングを行うことにより、地図データ
上での車両Ａの現在の走行位置を求める。

【００４４】さらに詳細には、図６を参照して、上記地
図データは、例えば地図上の特定の地点（例えば走行経
路Ｂの開始地点）、あるいは特定の経度・緯度の値を有
する地点を基準とした設定されたＸ−Ｙ座標における走
行経路Ｂの位置データ（磁気ネイルＣの点列の位置デー
タ）として表されている。そして、この地図データの走
行経路Ｂとｘ−ｙ座標で求められた走行経路Ｂとが一致
するようにして、ｘ−ｙ座標で求められた走行軌跡Ｋを
地図データのＸ−Ｙ座標に座標変換し、これにより地図
データ上における（Ｘ−Ｙ座標における）車両Ａの現在
位置（Ｘt ，Ｙt ）を特定する。

【００４５】尚、上記のような地図データは、例えば走
行経路Ｂの所定の区域毎に、ＬＣＸケーブルＤとの通信
により該ＬＣＸケーブルＤから受け取って、適宜の記憶
装置に保持しておくようにしてもよい。

【００４６】ステップ７では、ナビゲーション装置６に
より、上記のように地図データ上で特定された車両Ａの
現在位置（Ｘt ，Ｙt ）に基づいて、その前方の走行経
路Ｂの地図データを例えば現在位置から前方５００ｍま
での範囲で切り出し、それをメモリに保持する。

【００４７】ステップ８では、車両Ａの現在位置（Ｘt
，Ｙt ）と、前記ステップ１においてＬＣＸケーブル
Ｄとの通信により取得した走行経路Ｂの各所における曲
率情報とを基に、車両Ａが現在の走行状態で走行した場
合に前記所定時間Ｔ秒（例えば１秒）後に到達すると予
測される地点に対応した箇所（現在位置に対応する走行
経路Ｂ上の地点からＶ・Ｔの距離だけ走行経路Ｂ上を前
方に進行した地点）での走行経路Ｂの曲率１／Ｒｎ（図
４参照）を特定する。

【００４８】ステップ９では、ナビゲーション装置６
は、前記ステップ３で求めた車両中心部の横方向の変位
量εy と角度誤差θとの二つの値をそれぞれ前回値と比
較し、それぞれの前回値との差が所定のしきい値を越え
ているか否かを判断する。そして、所定のしきい値を越
えている場合には、ステップ３で求めた現在の変位量ε
y と角度誤差θとの値をそれぞれ前回値に対してあらか
じめ設定された範囲内に収まるように強制的に変更する
（ステップ９ａ）。

【００４９】このような処理を行うのは次の理由によ
る。すなわち、変位量εy と角度誤差θとの大きな変化
が生じた場合に、ステップ３で求められた変位量εy と
角度誤差θとの値をそのまま使用して後述の如く車両Ａ
の操舵制御量を求めて操舵を行うと、車両Ａの挙動が急
変して車両Ａの乗り心地を著しく損なう虞れがある。そ
こで、ステップ９、９ａの処理を行うことで、操舵制御
を行うために必要な変位量εy と角度誤差θとの値の変
化量を制限することで、上記のような不都合を回避す
る。

【００５０】ステップ１０は本実施形態では省略され
る。

【００５１】ステップ１１では、前記横方向制御装置９
により、操舵制御量（ステアリングの操舵角値) δを、
前記ステップ３で求められた現在の車両Ａの走行経路Ｂ
に対する変位量εy 及び角度誤差θ（但し、ステップ９
ａを経た場合には、前述の通り制限された変位量及び角
度誤差）と、現在の車速Ｖと、ステップ８で得られた所
定時間Ｔ後の走行経路Ｂの曲率１／Ｒｎとを用いて下記
の式（２）により求める。そして、横方向制御装置９
は、求めた操舵制御量（ステアリングの操舵角値) δで
車両Ａのステアリング操作を行うべく、前記電子制御パ
ワーステアリングアクチュエータ１０に命令を送り、該
アクチュエータ１０により実際に車両Ａのステアリング
を操作する（ステップ１２）。

【００５２】 δ＝Ｐ（Ｖ，１／Ｒｎ）・εy ＋Ｉ（Ｖ，１／Ｒｎ）∫εy dt ＋Ｐ’（Ｖ，１／Ｒｎ）・θ ……（１） ここで、式（１）において、Ｐ（Ｖ，１／Ｒｎ）は車速
Ｖと曲率１／Ｒｎのあらかじめ定められた関数で、車速
Ｖが大きくなる程、Ｐ（Ｖ，１／Ｒｎ）の値が減少し、
曲率１／Ｒｎが大きくなる程、Ｐ（Ｖ，１／Ｒｎ）の値
が大きくなるように設定されている。具体的には、例え
ばＰ（Ｖ，１／Ｒｎ）は、車速Ｖ及び曲率１／Ｒｎを用
いた次式により設定することで、上記のようなＰ（Ｖ，
１／Ｒｎ）の傾向が得られるようになっている。

【００５３】Ｐ（Ｖ，１／Ｒｎ）＝Ｐ0 ・（Ｖ0 ／Ｖ）
・［１＋（１／Ｒｎ）・ｋ］ 但し、上式において、Ｐ0 、ｋは実験的に定められた定
数であり、Ｖ0 は、本実施形態では６０ｋｍ／ｈ（＝１
６．６ｍ／ｓ）の車速を標準車速として、Ｖ0＝１６．
６とされている。

【００５４】また、式（１）において、Ｉ（Ｖ，１／Ｒ
ｎ）は車速Ｖと曲率１／Ｒｎのあらかじめ定められた関
数で、車速Ｖが大きくなる程、Ｉ（Ｖ，１／Ｒｎ）の値
が減少し、曲率１／Ｒｎが大きくなる程、Ｉ（Ｖ，１／
Ｒｎ）の値が大きくなるように設定されている。具体的
には、例えばＩ（Ｖ，１／Ｒｎ）は、車速Ｖ及び曲率１
／Ｒｎを用いた次式により設定することで、上記のよう
なＩ（Ｖ，１／Ｒｎ）の傾向が得られるようになってい
る。

【００５５】 Ｉ（Ｖ，１／Ｒｎ）＝Ｉ0(1/Rn) ・（Ｖ0 ／Ｖ） 但し、上式において、Ｉ0(1/Rn) は、曲率１／Ｒｎか
ら、あらかじめ定められたデータテーブルによって求め
られる値であり、このデータテーブルでは、曲率１／Ｒ
ｎが大きい程、Ｉ0(1/Rn) の値が大きくなり、逆に曲率
１／Ｒｎが小さい程、Ｉ0(1/Rn) の値が小さくなる（約
０になる）ように設定されている。

【００５６】また、式（１）において、Ｐ’（Ｖ，１／
Ｒｎ）は車速Ｖと曲率１／Ｒｎのあらかじめ定められた
関数で、車速Ｖが大きくなる程、Ｐ’（Ｖ，１／Ｒｎ）
の値が減少し、曲率１／Ｒｎが大きくなる程、Ｐ’
（Ｖ，１／Ｒｎ）の値が大きくなるように設定されてい
る。具体的には、例えばＰ’（Ｖ，１／Ｒｎ）は、Ｐ
（Ｖ，１／Ｒｎ）と同様の次式により設定することで、
上記のようなＰ’（Ｖ，１／Ｒｎ）の傾向が得られるよ
うになっている。

【００５７】Ｐ（Ｖ，１／Ｒｎ）＝Ｐ0 ’・（Ｖ0 ／
Ｖ）・［１＋（１／Ｒｎ）・ｋ’］ 但し、上式において、Ｐ0 ’、ｋ’は実験的に定められ
た定数である。

【００５８】このような式（１）により求めた操舵制御
量δ（操舵角値）によりステアリング操作を行うことに
より、車両Ａは、走行経路Ｂの直線部はもちろん、カー
ブにおいても円滑且つ安定に走行経路Ｂに沿って走行す
る。

【００５９】すなわち、操舵制御量δを求める式（１）
の右辺のＰ（Ｖ，１／Ｒｎ）・εy、Ｉ（Ｖ，１／Ｒ
ｎ）∫εy dtは、それぞれ変位量εy の比例項、積分項
であり、基本的には、変位量εy を減少させて車両Ａを
走行経路Ｂ上に追従させる機能を有し、これにより車両
Ａはその中心部が走行経路Ｂ上に変位するように操舵さ
れる。この場合、車速Ｖが比較的大きい状態で、車両Ａ
を走行経路Ｂ上に急激に変位させるようにすると、大き
な横方向加速度が生じるが、比例項の係数Ｐ（Ｖ，１／
Ｒｎ）や積分項の係数Ｉ（Ｖ，１／Ｒｎ）は、それぞれ
前述のように車速Ｖが大きい程、小さくなるので、車両
Ａの急激な変位が抑制され、円滑に走行経路Ｂ上に車両
Ａを変位させることができる。

【００６０】また、車両Ａの前方の曲率１／Ｒｎが大き
くなると、係数Ｐ（Ｖ，１／Ｒｎ）や係数Ｉ（Ｖ，１／
Ｒｎ）が大きくなるため、カーブでの走行経路Ｂへの車
両Ａの追従性が高まり、車両Ａがカーブで外側にはみ出
してしまうような事態が回避される。

【００６１】さらに、走行経路Ｂの直線部（曲率１／Ｒ
ｎが約０の箇所）では、積分項の値が大きいと、車両Ａ
の走行位置が走行経路Ｂに対して振動を生じやすいが、
係数Ｉ（Ｖ，１／Ｒｎ）は十分に小さなものとなるた
め、積分項の値も十分に小さなものとなり、車両Ａの走
行経路Ｂ上への追従性が安定する。

【００６２】また、式（１）の右辺のＰ’（Ｖ，１／Ｒ
ｎ）・θは、角度誤差θの比例項であり、基本的には、
角度誤差θを減少させて、車両Ａの進行方向を走行経路
Ｂの方向に向かわせる機能を有する。この場合、車速Ｖ
が比較的大きい状態では、係数Ｐ’（Ｖ，１／Ｒｎ）が
小さくなるので、車両Ａの過大な進行方向の変化が抑制
され、車両Ａの進行方向の走行経路Ｂへの追従が安定し
て円滑に行われる。

【００６３】さらに走行経路Ｂの曲率１／Ｒｎの大きな
カーブでは、係数Ｐ’（Ｖ，１／Ｒｎ）が大きくなるの
で、車両Ａの進行方向の走行経路Ｂへの追従性が高ま
り、該走行経路Ｂに沿うようにして円滑にカーブを曲が
ることができる。

【００６４】このように本実施形態の操舵制御によれ
ば、車両Ａの現在の車速Ｖや走行経路Ｂに対する変位量
εy だけでなく、車両前方の走行経路Ｂの曲率１／Ｒｎ
や車両Ａの進行方向の走行経路Ｂに対する角度誤差θを
考慮して操舵制御量δを決定し、そのδにより車両Ａを
操舵制御することで、走行経路Ｂの直線部はもちろん、
カーブにおいても円滑且つ安定に走行経路Ｂに追従して
走行することができる。

【００６５】そして、この場合、操舵制御量δを決定す
る上で必要な変位量εy 及び角度誤差θは、磁気センサ
１，１による磁気ネイルＣの磁気的な検出に基づいて求
められ、また、車両前方の走行経路Ｂの曲率１／Ｒｎ
は、ＬＣＸケーブルＤとの通信によって得らるので、そ
れらの変位量εy 、角度誤差θ、曲率１／Ｒｎのデータ
を天候条件等によらずに精度良く取得することができ
る。従って、それらのデータを用いて求めた操舵制御量
δによって車両Ａの操舵を行うことで、天候条件等によ
らずに的確に車両Ａを走行経路Ｂに沿わせて走行するこ
とができる。

【００６６】次に、図２のシステム構成を有する車両Ａ
の操舵制御アルゴリズムの第２の実施形態を図３及び図
４を参照して説明する。

【００６７】本実施形態では、図３のステップ１からス
テップ９，９ａまでの処理が前記第１の実施形態と全く
同様に行われるので、これらの処理の説明は省略する。

【００６８】尚、この場合、ステップ８では、ＬＣＸケ
ーブルＤから与えられた曲率情報を基に、車両の現在位
置における走行経路Ｂの曲率と、車両Ａが現在の走行状
態で走行した場合に前記予見時間Ｔpre （１．３秒）後
に到達すると予測される地点に対応した箇所（現在位置
に対応する走行経路Ｂ上の地点からＶ・Ｔpre の距離だ
け走行経路Ｂ上を前方に進行した地点）での走行経路Ｂ
の曲率１／Ｒn+1 （図４参照）を特定する。

【００６９】本実施形態では、ステップ１０において、
ナビゲーション装置６が、車両Ａの現在位置（図４のａ
地点）から現在の走行状態で走行した場合に前記予見時
間Ｔpre （１．３秒）後に車両Ａが到達すると予想され
る地点（図４のｂ地点）における車両Ａの進行方向（図
４のｂ’線の方向）と、車両Ａを現在の走行状態で現在
位置から走行経路Ｂ上を走行させた場合に、予見時間Ｔ
pre 後に到達すべき走行経路Ｂ上の位置（車両Ａの現在
位置に対応する走行経路Ｂ上の地点から、前方にＶ・Ｔ
pre の距離だけ離間した地点。図４のｃ地点）における
走行経路Ｂの方向（図４のｃ’線の方向）とのなす角度
を予見角度θpre として求める。具体的には、図４を参
照して、車両Ａの進行方向を、現在の進行方向から、予
見時間Ｔpre 後の地点ｃにおける走行経路Ｂの方向に変
化させるのに要する車両Ａの旋回角度（図４のａ’線と
ｃ’線とのなす角度）を目標旋回角度θtar としたと
き、予見角度θpre は、次式により算出する。

【００７０】θpre ＝θtar −（γ・Ｔpre ） ここで、γは前記ステップ４で得られた車両Ａの現在の
ヨーレートであり、（γ・Ｔpre ）の項は、車両Ａが現
在のヨーレートで走行した場合に、予見時間Ｔpre の期
間で車両Ａの進行方向が現在の進行方向から変化する角
度（図４のａ''線とｂ’線とのなす角度）を示してい
る。

【００７１】また、上式中の目標旋回角度θtar は、例
えば次のように求められる。すなわち、前記ステップ７
で得られた車両Ａの前方の走行経路Ｂの地図データを、
車両Ａの現在位置における進行方向（図４のａ’線）を
例えばｙ軸、車幅方向をｘ軸とした座標上に変換する。
すなわち、走行経路Ｂの地図データを車両ａを基準とし
た座標系で表す。そして、その座標上において、車両Ａ
の現在位置に対応する走行経路Ｂ上の地点から、前方に
走行経路Ｂに沿ってＶ・Ｔpre の距離だけ離間した地点
ｃを求め、その地点ｃにおける走行経路Ｂのｙ軸（車両
Ａの進行方向）に対する方位角を走行経路Ｂの座標デー
タにより求めることで、目標旋回角度θtar が得られ
る。

【００７２】尚、本実施形態では予見時間Ｔpre を実験
的データに基づいて１．３秒に設定したが、車両の種類
や性能等によって適切に設定することが好ましい。

【００７３】このようにして求めた予見角度θpre を用
いて、本実施形態ではステップ１１において、次式
（２）により操舵制御量δを求め、さらに、ステップ１
２において、求めた操舵制御量δに従ってステアリング
の操作を行う。

【００７４】 δ＝Ｐ（Ｖ，１／Ｒ0 ）・εy ＋Ｐ’（Ｖ，１／Ｒ0 ）・θ ＋Ｃ（Ｖ）・θpre ＋ａ・（１／Ｒn+1 ）＋ｂ・γ ……（２） ここで、Ｖは現在の車速、１／Ｒ0 は現在位置における
走行経路Ｂの曲率、１／Ｒn+1 は、予見時間Ｔpre 後に
おける走行経路Ｂの曲率であり、Ｐ（Ｖ，１／Ｒ0 ）及
びＰ’（Ｖ，１／Ｒ0 ）は、それぞれ、前記式（１）の
Ｐ（Ｖ，１／Ｒn ）及びＰ’（Ｖ，１／Ｒn ）と同様に
して、車速Ｖ及び現在位置の曲率１／Ｒ0 に応じて定め
られた関数である。

【００７５】また、Ｃ（Ｖ）は、車速Ｖが大きくなる
程、値が小さくなるように定められたに関数で、例えば
Ｃ（Ｖ）＝Ｖ0 ／Ｖ（但し、Ｖ0 は式（１）と同様）と
されている。また、ａは、実験的に定めた正の定数、ｂ
は実験的に定めた負の定数である。このような式（２）
により求めた操舵制御量δ（操舵角値）によりステアリ
ング操作を行うことにより、車両Ａは、前記第１の実施
形態と同様に、走行経路Ｂの直線部はもちろん、カーブ
においても円滑且つ安定に走行経路Ｂに沿って走行す
る。

【００７６】すなわち、式（２）の右辺のＰ（Ｖ，１／
Ｒ0 ）・εy 、Ｐ’（Ｖ，１／Ｒ0）・θはそれぞれ変
位量εy 及び角度誤差θの比例項（フィードバック制御
項）で、前記式（１）の比例項と同様の機能を有し、そ
れぞれ基本的には、変位量εy 及び角度誤差θを減少さ
せるように機能する。この場合、車速Ｖが大きい程、Ｐ
（Ｖ，１／Ｒ0 ）、Ｐ’（Ｖ，１／Ｒ0 ）の値が小さく
なるので、高速走行中の横方向の安定性が高まる。ま
た、車両Ａの現在位置における曲率１／Ｒ0 が大きくな
る程、Ｐ（Ｖ，１／Ｒ0 ）、Ｐ’（Ｖ，１／Ｒ0 ）の値
が大きくなるので、カーブにおける車両Ａの走行経路Ｂ
に対する位置や方向の追従性が高まる。

【００７７】また、式（２）のＣ（Ｖ）・θpre は、予
見時間Ｔpre 後の予見角度θpre 、すなわち、将来的に
予測される車両Ａの進行方向と走行経路Ｂの方向との角
度誤差に基づくフィードフォワード制御項で、車両Ａの
カーブでの走行経路Ｂに対する追従性をより一層向上さ
せると共に、車両Ａの挙動も安定させるという機能を有
する。すなわち、将来的に予測される角度誤差を前もっ
て吸収するように機能する。

【００７８】また、式（２）のａ・（１／Ｒn+1 ）は、
車両Ａの前方の曲率１／Ｒn+1 のカーブを曲がるために
必要な基本的な操舵角を規定するフィードフォワード制
御項である。

【００７９】また、式（２）のｂ・γは、ヨーレートγ
のフィードバック制御項で、過大なヨーレートが発生す
るのを抑制する機能を有する。

【００８０】これにより、本実施形態によれば、車両Ａ
の現在の車速Ｖや走行経路Ｂに対する変位量εy だけで
なく、車両前方の走行経路Ｂの曲率１／Ｒn+1 や車両Ａ
の将来的に予測される走行経路Ｂに対する角度誤差、ヨ
ーレートγ等を考慮して操舵制御量δを決定し、そのδ
により車両Ａを操舵制御することで、走行経路Ｂの直線
部はもちろん、カーブにおいても円滑且つ安定に走行経
路Ｂに追従して走行することができる。

【００８１】そして、この場合、操舵制御量δを決定す
る上で必要な変位量εy 及び角度誤差θは、磁気センサ
１，１による磁気ネイルＣの磁気的な検出に基づいて求
められ、また、車両前方の走行経路Ｂの曲率１／Ｒn+1
及び車両Ａの現在位置における走行経路Ｂの曲率１／Ｒ
0 は、ＬＣＸケーブルＤとの通信によって得らるので、
それらのデータを天候条件等によらずに精度良く取得す
ることができる。従って、それらのデータを用いて求め
た操舵制御量δによって車両Ａの操舵を行うことで、天
候条件等によらずに的確に車両Ａを走行経路Ｂに沿わせ
て走行することができる。

【００８２】図７に本実施形態による操舵制御を用いた
自動走行車を５０ｋｍ／ｈの車速で半径１４０Ｒのカー
ブを実際に走行させた場合に、車両の中心部と所要の走
行経路との間に生じた変位量εy の測定データを示す。
同図に見られるように、所要の走行経路と車両の実際の
走行経路との偏差は十分に小さく（最大で１５ｃｍ程
度）、しかもその大きさも平坦に抑えられている。この
ことから、本実施形態のステアリンング制御を行うこと
で、カーブにおいても車両を円滑且つ安定に所要の走行
経路に追従させて走行させることができることが判る。

【００８３】ところで、以上説明したステアリング制御
の第１及び第２の実施形態では、操舵制御量δを求める
ための走行経路Ｂの曲率をＬＣＸケーブルＤとの通信に
よって得られた曲率情報に基づき特定したが（第１及び
第２の実施形態の本発明の第１の態様に対応する）、Ｌ
ＣＸケーブルＤの曲率情報を用いずに車両Ａに備えた前
記地図データ（図６参照）を用いて、操舵制御量δを求
めるための走行経路Ｂの曲率を求めることも可能である
（これは本発明の第２の態様に対応する）。

【００８４】すなわち、前記地図データの走行経路Ｂは
その各所の地図データ上における位置が判っているの
で、その位置データを用いることで、数学的な演算によ
り走行経路Ｂの各所の曲率を求めることができる。例え
ば、図６のＸ−Ｙ座標系において、走行経路Ｂを表す関
数をＹ＝Ｆ（Ｘ）とし、dY/dX ＝Ｆ’、d²Y/dX² ＝Ｆ''
と定義したとき、走行経路Ｂの各所における曲率１／Ｒ
は数学的に、次式により求められる。

【００８５】１／Ｒ＝Ｆ''／［１＋（Ｆ’）² ］^3/2 従って、操舵制御量δを求めるための走行経路Ｂの曲率
を、地図データから直接的に求めることができる。

【００８６】そこで、この場合には、前記第１及び第２
の実施形態において、図３のステップ１の処理を省略
し、ステップ８において、ステップ７で切り出した地図
データを基に、操舵制御量δを求めるための走行経路Ｂ
の曲率を上記のような演算によって求めて特定する。

【００８７】このようにした場合でも、操舵制御量δを
求めるための走行経路Ｂの曲率は、地図データを用いる
ことで、天候条件等によらずに精度よく求めることがで
きるので、前述のようにＬＣＸケーブルＤの曲率情報を
用いた場合と同様の作用効果を奏する。

【００８８】尚、以上説明した実施形態では、経路マー
カとして磁気ネイルＤを用いたものを示したが、経路マ
ーカとして例えば白線等の色覚的なものを使用し、それ
を車両側に備えた光学的センサにより検出するようにす
ることも可能である。

【００８９】また、前述の第１及び第２の実施形態で
は、走行情報提供設備としてＬＣＸケーブルを用いた
が、例えば道路に沿って間隔を存して設置した通信施設
等を用いるようにしてもよい。

【図面の簡単な説明】

【図１】本発明の実施形態における車両の走行形態を示
す説明図。

【図２】図１の車両のシステム構成図。

【図３】図１の車両の操舵制御を説明するためのフロー
チャート。

【図４】図１の車両の操舵制御を説明するための説明
図。

【図５】図１の車両の操舵制御を説明するための説明
図。

【図６】図１の車両の操舵制御に用いる地図データを示
す説明図。

【図７】実施形態における実験結果を示す線図。

【符号の説明】 Ａ…車両、Ｂ…走行経路、Ｃ…磁気ネイル（経路マー
カ）、Ｄ…漏洩同軸ケーブル（走行情報提供設備）、１
…磁気センサ（マーカセンサ）、２…ＬＣＸ情報受信
機、３…ヨーレートセンサ、５…車輪回転速度センサ、
６…ナビゲーション装置、８…通信制御装置、９…横方
向制御装置、１０…電子制御パワーステアリングアクチ
ュエータ。

Claims (7)

【特許請求の範囲】
1. 【請求項１】あらかじめ経路マーカが付設された所定の
   走行経路に沿って車両が走行するよう該車両の自動操舵
   を行う自動ステアリング制御装置において、前記走行経
   路の地図データを保持する手段と、車両に備えたマーカ
   センサにより前記経路マーカを検出し、その検出出力に
   基づき車両の現在の走行位置における前記走行経路との
   位置関係を逐次求める手段と、少なくとも該車両の前記
   走行経路との時々刻々の位置関係及び前記地図データと
   に基づき該地図データ上における車両の走行位置を逐次
   把握する手段と、前記地図データ上における走行経路の
   各所の曲率情報を車両外部に設けられた走行情報提供設
   備との通信により取得する手段と、該走行情報提供設備
   から与えられる走行経路の曲率情報に基づき、前記把握
   した車両の現在の走行位置の前方における走行経路の曲
   率情報を取得する手段と、少なくともその取得した車両
   の前方の走行経路の曲率情報、車両の現在の車速及び車
   両の前記走行経路との現在の位置関係に基づき車両の操
   舵制御量を決定する手段とを備えたことを特徴とする自
   動ステアリング制御装置。
2. 【請求項２】前記走行情報提供設備は、前記走行経路に
   沿って道路に設置された漏洩同軸ケーブルであることを
   特徴とする請求項１記載の自動ステアリング制御装置。
3. 【請求項３】あらかじめ経路マーカが付設された所定の
   走行経路に沿って車両が走行するよう該車両の自動操舵
   を行う自動ステアリング制御装置において、前記走行経
   路の地図データを保持する手段と、車両に備えたマーカ
   センサにより前記経路マーカを検出し、その検出出力に
   基づき車両の現在の走行位置における前記走行経路との
   位置関係を逐次求める手段と、少なくとも該車両の前記
   走行経路との時々刻々の位置関係及び前記地図データと
   に基づき該地図データ上における車両の走行位置を逐次
   把握する手段と、その把握した車両の現在の走行位置の
   前方における走行経路の曲率情報を前記地図データから
   取得する手段と、少なくともその取得した車両の前方の
   走行経路の曲率情報、車両の現在の車速及び車両の前記
   走行経路との現在の位置関係に基づき車両の操舵制御量
   を決定する手段とを備えたことを特徴とする自動ステア
   リング制御装置。
4. 【請求項４】前記経路マーカは前記走行経路に沿って間
   隔を存して道路に配列された磁気発生源であり、前記マ
   ーカセンサは磁気センサであることを特徴とする請求項
   １乃至３のいずれかに記載の自動ステアリング制御装
   置。
5. 【請求項５】前記車両の走行経路との位置関係は、車両
   の中心部の走行経路に対する横方向偏差と、車両の進行
   方向の走行経路に対する方位角偏差とを含むことを特徴
   とする請求項１乃至４のいずれかに記載の自動ステアリ
   リング制御装置。
6. 【請求項６】前記車両の走行位置を把握する手段は、車
   両の車速及びヨーレートに基づき車両の走行軌跡を逐次
   求める手段を含み、その求めた走行軌跡と、前記車両の
   前記走行経路との時々刻々の位置関係と、該走行経路の
   前記地図データとから該地図データ上における車両の現
   在の走行位置を把握することを特徴とする請求項１乃至
   ５のいずれかに記載の自動ステアリング制御装置。
7. 【請求項７】車両の現在の走行位置から現在の走行状態
   で走行した場合における所定時間後の車両の進行方位
   と、該所定時間後の車両の走行位置に対応する走行経路
   上の地点における該走行経路の方位との偏差角度を予見
   角度として求める手段を具備し、前記操舵制御量を決定
   する手段は、前記予見角度と、車両の前方の走行経路の
   曲率情報と、車両の現在の車速と、車両の前記走行経路
   との現在の位置関係とに基づき車両の操舵制御量を決定
   することを特徴とする請求項１乃至６のいずれかに記載
   の自動ステアリング制御装置。