JPH1191609A - 車両の自動操舵装置 - Google Patents

Abstract

(57)【要約】 【課題】非常に正確な舵角フィードバック制御が要求さ
れる自動操舵において、検出される舵角のずれ，舵角中
立値ずれを高精度に検出する。 【解決手段】車速ｖや車線曲率ρ等から車両が達成すべ
き横変位ｙを、その他の状態量と共に推定するカルマン
フィルタ等の状態推定器に、本来、固定値である舵角中
立値ずれδ_fofst を外乱ｗで変化する一次遅れ系の状態
変数として組み込み、車両の走行中、随時推定すると共
に、推定される横変位ｙと検出される横変位ｙとの誤差
εに応じて補正することで真値に近づけてゆく。また、
推定回数の増加と共に、前記一次遅れ系の時定数τを大
きくするか、又は前記横変位誤差εに係るフィードバッ
クゲインベクトルＫ_e を小さくすることで、外乱ｗの影
響が舵角中立値ずれδ_fofst に及ぼす影響を小さくし、
次第に定数化する。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、例えば車両を車線
に沿って走行させるために当該車両の操舵を自動的に行
う車両の自動操舵装置に関するものである。

【０００２】

【従来の技術】このような従来の車両の自動操舵装置と
しては、例えば特開平７−８１６０２号公報に記載され
るものがある。この従来例に記載される車両の自動操舵
装置は、操舵に係る種々の条件，特にカーブに沿って走
行するときに、より人為的な操舵が行われるように操舵
特性を規定するものである。これにより、乗員に、より
自然な走行感や快適な乗心地を与えるようにしている。

【０００３】この従来技術は、カメラ等からの画像情報
から車線に対する車両の横変位を検出するものである
が、その一方で、磁気ネイルと呼ばれる磁石などの磁力
源を車線に沿って埋設し、これを車両に取付けた磁気セ
ンサで検出して、当該車両の横変位（磁力源に対する横
位置情報であり、つまり車線に対する自車位置情報であ
る）を検出し、この検出される横変位が例えば目標とす
る横変位に一致するように、前輪又は後輪をアクチュエ
ータで操舵制御することが考えられている。しかしなが
ら、前記従来技術の自動操舵装置を実際の車両に搭載し
て、この磁気ネイルによる車線追従式の自動操舵を行わ
せると、制御の正確性が低下してしまう恐れがある。こ
れは、検出される横変位のノイズが車両の走行状態に応
じて変化することに起因することや、こうした自動操舵
装置が離散化されたシステムで構築されていることが関
与しているためである。

【０００４】そこで、本出願人は、この車両の横変位を
舵角制御の単純な結果とは考えないで、例えば車速や車
線曲率を含む車両モデルで発生する種々の状態変数の一
部と考えるものとし、これに基づいて行われる自動操舵
装置を提案した。そして、それらの状態変数をカルマン
フィルタ等のオブザーバ，即ち状態推定器（状態推定手
段）で推定しながら、既に追従していると考える現在の
定常舵角に対して補正すべき舵角を算出する。そして、
この補正すべき舵角と定常舵角との和からなる目標舵角
に実際の舵角を一致させるようにフィードバック制御す
る構成とし、これにより磁気ネイルによる安定した車線
追従式自動操舵を行うことができるようになる。ちなみ
に、カルマンフィルタは、夫々が独立してフィードバッ
ク制御される種々の状態変数をモデル化して組み込み、
結果的にそれらの連鎖的な応答をなくして、単独の状態
量のフィードバック制御を容易化，正確化するものであ
る。また、更に出力される推定状態変数と検出された状
態変数との出力誤差に応じてモデル，即ち推定される状
態量を補正可能としたものである。

【０００５】

【発明が解決しようとする課題】ところで、このような
車線追従式自動操舵装置を始めとする舵角のフィードバ
ック制御では、当然ながら検出される舵角と、真の舵角
との誤差について考慮しなければならない。特に自動操
舵装置では、非常に正確な舵角のフィードバック制御が
要求される。より具体的には、例えば舵角センサがエン
コーダ等で構成されている場合にあって、例えば平坦な
路面で車両を直進走行させるに足る舵角の中立状態を真
の舵角の中立値と定義すると、この真の舵角の中立値に
対して検出される舵角の中立値とのずれが、例えばドリ
フト成分として重畳されて検出される。従って、検出さ
れる舵角と真の舵角との誤差については、この舵角中立
値ずれを検出すればよいことになる。このような舵角中
立値ずれは、例えば舵角センサの個体差のみならず、組
付け誤差なども含まれているので、少なくともその検出
は、実際に車両を走行してみなければならない。

【０００６】この舵角中立値ずれを検出する手法は種々
に開発されており、その一つとして、例えばエンジンを
始動した後、所定の時間間隔で舵角センサからの検出値
の平均値を算出し、それを舵角中立値ずれと見なすもの
もある。しかしながら、この手法では、例えば螺旋式の
駐車場等のようにエンジン始動後にカーブが連続するよ
うな状態では、ステアリングホイールを切った状態での
検出値を舵角中立値ずれと誤認識してしまうし、例え直
線路であっても操舵入力によって前記所定時間内の平均
値が真の舵角中立値ずれにならない恐れもある。勿論、
前記所定時間を長く設定すれば、舵角中立値ずれを真値
に近づけることも可能であるが、その間は舵角フィード
バック制御を行えないというトレードオフもある。ま
た、実際には直進走行に見合う車速以下のときや横加速
度を伴うときには舵角中立値ずれを算出しないようにす
ることで精度を高めてもいるが、何れの手法でも、前述
のような自動操舵装置に要求される高い精度には及ばな
い。

【０００７】本発明はこれらの諸問題に鑑みて開発され
たものであり、自動操舵に要求されるような舵角中立値
ずれを高い精度で検出して、舵角のフィードバック制御
を可能とする車両の自動操舵装置を提供することを目的
とするものである。

【０００８】

【課題を解決するための手段】上記目的を達成するため
に、本発明のうち請求項１に係る車両の自動操舵装置
は、状態推定手段で車両の種々の状態変数を推定しなが
ら、車両を自動操舵するにあたり、車両を直進走行させ
る真の舵角の中立値と、検出される操舵輪の舵角の中立
値との舵角中立値ずれを、車両の状態変数の一つとして
モデル化して前記状態推定手段に組み込み、当該状態推
定手段で前記舵角中立値ずれを推定することを特徴とす
るものである。

【０００９】また、本発明のうち請求項２に係る車両の
自動操舵装置は、前記請求項１に係る発明において、前
記舵角中立値ずれを外乱で変化する変数とし、次第に外
乱の影響を受けにくくして定数化することを特徴とする
ものである。

【００１０】また、本発明のうち請求項３に係る自動操
舵装置は、前輪又は後輪を操舵する操舵アクチュエータ
と、この操舵アクチュエータによって操舵される前輪又
は後輪の舵角を検出する舵角検出手段と、走行車線に対
する車両の横変位を検出する横変位検出手段と、少なく
とも走行車線に対する車両の横変位を含む車両の状態変
数を車両モデルから推定する状態推定手段と、この推定
された車両の状態変数を用いて、前記検出された車両の
横変位と推定された車両の横変位との誤差が目標とする
値になるように、前記舵角検出手段で検出された舵角を
フィードバック制御しながら、前記操舵アクチュエータ
を制御する操舵制御手段とを備えた車両の自動操舵装置
において、前記状態推定手段は、車両を直進走行させる
真の舵角の中立値と、前記舵角検出手段で検出される舵
角の中立値との舵角中立値ずれを、モデル化された車両
の状態変数の一つとして推定し、前記操舵制御手段は、
この状態推定手段で推定された舵角の中立値とのずれを
用いて前記舵角をフィードバック制御することを特徴と
するものである。

【００１１】また、本発明のうち請求項４に係る車両の
自動操舵装置は、前記請求項３に係る発明において、前
記状態推定手段は、直線又は略直線の車線を走行してい
るときに前記舵角中立値ずれを推定又は更新するもので
あることを特徴とするものである。

【００１２】また、本発明のうち請求項５に係る車両の
自動操舵装置は、前記請求項３に係る発明において、前
記状態推定手段は、車両の走行状態情報を検出する手段
として、少なくとも車線曲率を検出する車線曲率検出手
段を備え、この車線曲率検出手段で検出された車線曲率
を用いて前記舵角中立値ずれを推定するものであること
を特徴とするものである。

【００１３】また、本発明のうち請求項６に係る車両の
自動操舵装置は、前記請求項３乃至５に係る発明におい
て、前記状態推定手段は、車両の走行状態情報を検出す
る手段として、車速を検出する車速検出手段を備え、こ
の車速検出手段で検出された車速を用いて前記車両モデ
ルを補正しながら前記舵角中立値ずれを含む車両の状態
変数を推定するものであることを特徴とするものであ
る。

【００１４】この発明では、車両モデルが車速依存の変
数を有する場合に、車速を検出してモデルを補正するこ
とにより、推定される状態変数の精度を向上させること
を目的としている。

【００１５】また、本発明のうち請求項７に係る車両の
自動操舵装置は、前記請求項３乃至６に係る発明におい
て、前記舵角中立値ずれを外乱で変化する一次遅れ系と
してモデル化し、前記状態推定手段は、前記舵角中立値
ずれの推定回数の増加に伴って、前記外乱の分散を小さ
くするように補正することを特徴とするものである。

【００１６】この発明で、外乱の分散を小さくするよう
にという表現は、外乱の変動によって受ける影響を小さ
くするようにという意味である。また、本発明のうち請
求項８に係る車両の自動操舵装置は、前記請求項３乃至
７に係る発明において、前記舵角中立値ずれを外乱で変
化する一次遅れ系としてモデル化し、前記状態推定手段
は、前記舵角中立値ずれの推定回数の増加に伴って、前
記一次遅れ系の時定数を大きくするように補正すること
を特徴とするものである。

【００１７】また、本発明のうち請求項９に係る車両の
自動操舵装置は、前記請求項３乃至８に係る発明におい
て、前記操舵制御手段が、前記検出された車両の横変位
と推定された車両の横変位との誤差を目標とする値に最
適化する最適レギュレータを含んで構成されることを特
徴とするものである。

【００１８】また、本発明のうち請求項１０に係る車両
の自動操舵装置は、前記請求項１乃至９に係る発明にお
いて、前記状態推定手段がカルマンフィルタで構成され
ることを特徴とするものである。

【００１９】

【発明の効果】而して、本発明のうち請求項１に係る車
両の自動操舵装置によれば、検出される舵角中立値と真
の舵角中立値との舵角中立値ずれを、車両の状態変数の
一つとしてモデル化して状態推定手段に組み込んで推定
する構成としたため、その車両モデルが実際の車両走行
を適切に反映しているものであれば、例え操舵中であっ
ても舵角中立値ずれを高い精度で検出できる。勿論、状
態推定手段は、自動操舵装置の必須構成要件であるか
ら、格別に装置を追加したりする必要もなく、簡潔でコ
スト的にも有利である。

【００２０】また、本発明のうち請求項２に係る車両の
自動操舵装置によれば、舵角中立値ずれを外乱で変化す
る変数とし、次第に外乱の影響を受けにくくして定数化
する構成としたため、例えば推定開始直後には外乱の影
響を受け易くすることで真値への収束性を早め、次第に
定数化して舵角フィードバック制御を安定化させること
ができる。

【００２１】また、本発明のうち請求項３に係る車両の
自動操舵装置によれば、検出される舵角中立値と真の舵
角中立値との舵角中立値ずれを、車両の状態変数の一つ
としてモデル化して状態推定手段に組み込んで推定する
構成としたため、その車両モデルが実際の車両走行を適
切に反映しているものであれば、例え操舵中であっても
舵角中立値ずれを高い精度で検出でき、正確な舵角フィ
ードバック制御によって適正な自動操舵を行うことがで
きる。勿論、状態推定手段は、自動操舵装置の必須構成
要件であるから、格別に装置を追加したりする必要もな
く、簡潔でコスト的にも有利である。

【００２２】また、本発明のうち請求項４に係る車両の
自動操舵装置によれば、直線又は略直線の車線を走行し
ているときに舵角中立値ずれを推定又は更新する構成と
したため、得られる車線曲率情報が曖昧なものであると
きに、それに基づいて不正確な舵角中立値ずれを推定し
たり更新したりすることがなく、その分だけ、制御性を
向上することができる。

【００２３】また、本発明のうち請求項５に係る車両の
自動操舵装置によれば、検出された車線曲率を用いて舵
角中立値ずれを推定する構成としたため、車両が曲線車
線を走行しているときでも舵角中立値ずれを推定し続け
ることができ、これにより、舵角中立値ずれの定常化を
早めて制御性を早期に向上することができる。

【００２４】また、本発明のうち請求項６に係る車両の
自動操舵装置によれば、検出された車速を用いて車両モ
デルを補正しながら車両の状態変数を推定する構成とし
たため、車両モデルの車速依存性を是正して、舵角中立
値ずれを含む推定される状態変数の精度を向上させるこ
とができる。

【００２５】また、本発明のうち請求項７に係る車両の
自動操舵装置によれば、舵角中立値ずれを外乱で変化す
る一次遅れ系としてモデル化すると共に、その推定回数
の増加に伴って外乱の分散を小さくするように補正する
構成としたため、推定を重ねる度に、舵角中立値ずれの
推定値が外乱の変動の影響を受けにくくなって定数化さ
れ、例えば推定開始直後には外乱の影響を受け易くする
ことで真値への収束性を早め、次第に定数化して舵角フ
ィードバック制御を安定化させることができるようにな
る。

【００２６】また、本発明のうち請求項８に係る車両の
自動操舵装置によれば、舵角中立値ずれを外乱で変化す
る一次遅れ系としてモデル化すると共に、その推定回数
の増加に伴って一次遅れ系の時定数を大きくするように
補正する構成としたため、推定を重ねる度に、舵角中立
値ずれの推定値が外乱の変動の影響を受けにくくなって
定数化され、例えば推定開始直後には外乱の影響を受け
易くすることで真値への収束性を早め、次第に定数化し
て舵角フィードバック制御を安定化させることができる
ようになる。

【００２７】また、本発明のうち請求項９に係る車両の
自動操舵装置によれば、最適レギュレータによって、検
出された車両の横変位と推定された車両の横変位との誤
差を目標とする値に最適化する構成としたため、種々に
変動する車両の状態変数を適正な状態にしながら、車両
の横変位を目標とする推定横変位に一致させることが可
能となる。

【００２８】また、本発明のうち請求項１０に係る車両
の自動操舵装置によれば、前記状態推定手段をカルマン
フィルタで構成したため、当該カルマンフィルタには出
力誤差から車両モデルや状態変数を補正する作用がある
から、その作用を用いて舵角中立値ずれを次第に適正化
したり安定化したりすることができる。

【００２９】

【発明の実施の形態】以下、本発明の実施の形態を図面
に基づいて説明する。ここでは、前輪を主として操舵す
る自動操舵装置について説明する。

【００３０】図１は、本発明の第１実施形態の自動操舵
装置を示す概略構成図である。同図の符号１２は前左右
輪、１５は後左右輪を示し、前左右輪１２にはごく一般
的なラックアンドピニオン式の操舵機構が付加されてい
る。この操舵機構は、前左右輪１２の操舵軸（タイロッ
ド）に接続されるラック１１と、これに噛合するピニオ
ン１０と、このピニオン１０をステアリングホイール１
４に与えられる操舵トルクで回転させるステアリングシ
ャフト９とを備えている。

【００３１】また、前記ステアリングシャフト９には、
前左右輪１２を自動操舵するための自動操舵機構も付加
されている。この自動操舵機構は、前記ステアリングシ
ャフト９に同軸に取付けられたドリブンギヤ８と、これ
に噛合するドライブギヤ７と、このドライブギヤ７を回
転駆動するモータ５である。なお、モータ５とドライブ
ギヤ７との間にはクラッチ機構６が介装されており、自
動操舵制御時にのみクラッチ機構６が接続され、そうで
ないときにはクラッチ機構６が離間してモータ５の回転
力がステアリングシャフト９に入力されないようにして
いる。そして、前記モータ５を含む自動操舵機構は、後
述する自動操舵コントロールユニット１３からの制御信
号で制御される。

【００３２】一方、本実施形態では、後左右輪１５を補
助操舵するための補助操舵機構も付加されている。この
補助操舵機構は、後左右輪１５を連結する操舵杆２０と
同軸に取付けられたラック１９と、このラック１９に噛
合し且つモータ１７の回転駆動力でラック１９を往動さ
せて後左右輪１５を補助操舵するギヤ１８とを備えてな
る。このモータ１７を含む補助操舵機構も、後述する自
動操舵コントロールユニット１３からの制御信号で制御
される。

【００３３】また、この車両には種々のセンサ類が取付
けられている。符号３は舵角センサであり、ステアリン
グシャフト９の回転角から前左右輪１２の実前輪舵角δ
_f を割出して自動操舵コントロールユニット１３に出力
する。また、図中の符号４は車速センサであり、例えば
変速機の出力軸の回転速度から車両の移動速度（車速）
ｖを割出して自動操舵コントロールユニット１３に出力
する。また、図中の符号１６は車線の曲率を検出する車
線曲率検出装置であり、例えば車線脇から無線送信され
る車線曲率情報を得て、その車線曲率ρを自動操舵コン
トロールユニット１３に出力する。なお、この車線曲率
検出装置は、コントロールユニット１３内で実行される
演算処理によって構成されるようにソフト化してもよ
く、その簡潔な内容については後述する。また、図中の
符号２１は補助舵角センサであり、前記操舵杆２０の移
動量から後左右輪１５の実後輪舵角δ_r を割出して自動
操舵コントロールユニット１３に出力する。

【００３４】一方、磁力源として車線に沿って埋設され
た磁石の磁力は、車両の前方下部に取付けられた磁気セ
ンサ１で検出される。この磁気センサ１は、単に磁石の
磁力の大きさだけでなく、その磁力ベクトルを、車両上
下方向に相当する縦成分と、車両幅方向に相当する横成
分とに分解して、その夫々の方向と大きさとを検出する
ことができる。

【００３５】この磁気センサ１の検出信号は、横変位検
出手段を構成する横変位検出装置２に出力される。この
横変位検出装置２は、後述する原理に基づいて、検出さ
れる磁力ベクトルの縦横成分比から車両（厳密には磁気
センサ１）の車線（厳密には磁石）に対する横変位の方
向と大きさとを検出（算出）する。なお、この横変位検
出装置２は、図示されないマイクロコンピュータ等の離
散化したディジタルシステムで構成されているため、前
述したような横変位のサンプリングは、予め設定された
サンプリングタイミングでしか行われない。この横変位
検出装置２で検出された車両の横変位ｙは、制御手段を
構成し且つ自動操舵制御を司る自動操舵コントロールユ
ニット１３に出力される。

【００３６】前記自動操舵コントロールユニット１３
は、マイクロコンピュータのような離散化されたディジ
タルシステムで構成されている。このディジタルシステ
ムは、既存のマイクロコンピュータと同様に、前記各セ
ンサ類からの検出信号を読込むための入力インタフェー
ス回路や、必要なプログラムや演算結果等を記憶するＲ
ＯＭ，ＲＡＭ等の記憶装置や、実際に演算処理を行うと
共に或る程度のバッファ機構を備えたマイクロプロセサ
ユニット等の演算処理装置や、この演算処理装置で設定
した制御信号を前記自動操舵機構のモータ５や補助操舵
機構のモータ１７に出力するための出力インタフェース
回路等を備えている。なお、本実施形態では、前記自動
操舵コントロールユニット１３内のマイクロコンピュー
タ等のディジタルシステム中に、状態推定器（状態推定
手段）としてのカルマンフィルタが構築されている。こ
のカルマンフィルタの構成や作用については後段に詳述
する。

【００３７】次に、前記コントロールユニット１３内で
実行される本実施形態の演算処理について図２のフロー
チャートを用いて説明する。なお、このフローチャート
では、特に情報の授受のためのステップを設けていない
が、演算処理装置で読込まれた情報や物理量或いは演算
された演算結果は随時記憶装置に更新記憶されるし、演
算処理に必要なプログラムやマップ，テーブル等は随時
記憶装置から演算処理装置のバッファに読込まれる。ま
た、この演算処理中、舵角中立値ずれδ_fofst及び中立
値算出カウンタＣＮＴは、イグニッションスイッチのＯ
Ｎ／ＯＦＦに係わらず、リセットされたりクリアされた
りしない不揮発性メモリに更新記憶される。

【００３８】この演算処理は、例えば１０msec. といっ
た予め設定されたサンプリング時間ΔＴ毎にタイマ割込
処理として実行され、まずステップＳ１で前記車速セン
サ４からの車速ｖを読込む。

【００３９】次にステップＳ２に移行して、前記読込ま
れた車速ｖが予め設定された低速所定値ｖ₀ 以上である
か否かを判定し、当該車速ｖが所定値ｖ₀ 以上である場
合にはステップＳ３に移行し、そうでない場合にはメイ
ンプログラムに復帰してしまう。なお、この低速所定値
ｖ₀ については後段に説明する。

【００４０】前記ステップＳ３では、前記車線曲率検出
装置１６からの情報を取り込むことによって車線曲率ρ
を検出する。次にステップＳ４に移行して、下記１式に
従って定常前輪舵角δ_f0を算出する。なお、下記１式の
算出原理については後段に詳述する。

【００４１】 次にステップＳ５に移行して、下記２式に従って定常後
輪舵角δ_r0を算出する。なお、下記２式の算出原理につ
いては後段に詳述する。

【００４２】 次にステップＳ６に移行して、前記舵角センサ３からの
前輪舵角δ_f 及び補助舵角センサ２１からの後輪舵角δ
_r を読込む。

【００４３】次にステップＳ７に移行して、下記３式に
従って、実前輪舵角δ_f ，定常前輪舵角δ_f0及び記憶装
置に更新記憶されている舵角中立値ずれδ_fofst を用い
て前輪舵角偏差Δδ_f を算出する。なお、舵角中立値ず
れδ_fofst の導出原理については後段に詳述する。

【００４４】 Δδ_f ＝δ_f −δ_f0＋δ_fofst ……… (3) 次にステップＳ８に移行して、後述する１２式に従っ
て、車速ｖ，車線曲率ρから、後述する平衡点周りに相
当する定常横変位ｙ₀ を算出する。

【００４５】次にステップＳ９に移行して、前記横変位
検出装置２からの横変位ｙを読込む。次にステップＳ１
０に移行して、下記４式に従って、前記検出された実横
変位ｙ，定常横変位ｙ₀ から横変位偏差Δｙを算出す
る。なお、既に状態推定による前輪自動操舵が開始され
ている場合には、前記ステップＳ８で算出される定常横
変位ｙ₀ は略零であり、検出される横変位ｙは、前述し
たモデル誤差を補正すべきフィードバック分でしかない
ことから、検出される横変位ｙをそのまま横変位偏差Δ
ｙに直接設定してもよい。

【００４６】 Δｙ＝ｙ−ｙ₀ ……… (4) 次にステップＳ１１に移行して、後述する図３の制御マ
ップ等に従って中立値算出カウンタＣＮＴから時定数τ
を設定する。この図３の制御マップで設定される時定数
τは、後述する中立値算出カウンタ（回数）ＣＮＴの増
加に伴って増加傾きが次第に小さくなる単純増加関数と
して設定される。

【００４７】次にステップＳ１２に移行して、後述する
１１式から構成されるカルマンフィルタによって状態推
定を行って、前記舵角中立値ずれδ_fofst を含む状態推
定ベクトルｘを算出（推定）する。

【００４８】次にステップＳ１３に移行して、前記車線
曲率ρが予め設定された近似直線所定値ρ₀ 以下である
か否かを判定し、当該車線曲率ρが所定値ρ₀ 以下であ
る場合にはステップＳ１４に移行し、そうでない場合に
はステップＳ１６に移行する。

【００４９】前記ステップＳ１４では、前記ステップＳ
１２で推定された舵角中立値ずれδ _fofst を新たな舵角
中立値ずれδ_fofst として記憶装置に更新記憶してから
ステップＳ１５に移行する。

【００５０】前記ステップＳ１５では、前記中立値算出
カウンタＣＮＴをインクリメントしてから前記ステップ
Ｓ１６に移行する。前記ステップＳ１６では、後述する
１４式から補正前輪舵角Δδ_fdを算出するための補正状
態ベクトルΔｘを算出する。

【００５１】次にステップＳ１７に移行して、後述する
１８式乃至２１式から補正前輪舵角Δδ_fdを算出する。
次にステップＳ１８に移行して、下記５式及び６式に従
って、前記算出された補正前輪舵角Δδ_fd，定常前輪舵
角δ_f0から目標前輪舵角δ_fdを、或いは定常前輪舵角δ
_r0から目標後輪舵角δ_rdを、夫々算出する。

【００５２】 δ_fd＝δ_f0＋Δδ_fd ……… (5) δ_rd＝δ_r0 ……… (6) 次にステップＳ１９に移行して、前記設定された目標前
輪舵角δ_fdに真の前輪舵角δ_fRを一致させるフィードバ
ック制御の制御信号を創成し出力する。なお、真の前輪
舵角δ_fRとは、前記舵角センサ３からの前輪舵角δ_f と
舵角中立値ずれδ_fofst との和であって、その導出原理
については後段に詳述する。

【００５３】次にステップＳ２０に移行して、前記設定
された目標後輪舵角δ_rdに前記後輪舵角δ_r を一致させ
るフィードバック制御の制御信号を創成し出力してから
メインプログラムに復帰する。

【００５４】次に、前記カルマンフィルタについて説明
する。カルマンフィルタは、現代制御理論に基づいた状
態量（本発明で言う状態変数であり、物理量とのバラン
スをとって状態量と記す）を、予め設定されたモデルに
従って幾つか推定し、その夫々にフィードバック制御を
行うことを前提として、結果的に種々の連鎖的な応答を
なくして、単独の状態量のフィードバック制御を容易
化，正確化する場合に、出力される推定状態量と検出さ
れた状態量との出力誤差に応じてモデル，即ち推定され
る状態量を補正可能としたものである。具体的には図４
ａに示す構成となる。

【００５５】ここで、本実施形態のカルマンフィルタ中
のモデルは、車両の二輪モデルであるから、これを状態
空間表現を用いて下記１１’式に示す。但し、この１
１’式に示す二輪モデルは、後輪を操舵可能とし、更に
後輪のトラクションによってヨーモーメントを制御可能
としたものであるから、本実施形態のように前輪を主と
して操舵して車両の横変位を制御する共に、後輪を補助
操舵して、前記磁気センサ１２の位置における対磁石横
方向速度，つまりセンサ横滑り速度を低減するだけのも
のの場合にはヨーモーメントＴ_r を零に設定すればよ
い。また、前記図２の演算処理のステップＳ１２で用い
られる１１式からなるカルマンフィルタは、この１１’
式に、更に個別の外乱モデルを加えたものであって、そ
れについては更に後段に詳述する。

【００５６】 但し、 ａ₁₁＝−（Ｃ_r ＋Ｃ_f ）／（ｍ・ｖ） ………(11-1) ａ₁₂＝（−１＋（Ｃ_r ・ｂ−Ｃ_f ・ａ))／（ｍ・ｖ² ） ………(11-2) ａ₂₁＝（Ｃ_r ・ｂ−Ｃ_f ・ａ）／Ｉ ………(11-3) ａ₂₂＝−（Ｃ_r ・ｂ² ＋Ｃ_f ・ａ² ）／（Ｉ・ｖ） ………(11-4) ｂ₁₁＝Ｃ_f ／（ｍ・ｖ） ………(11-5) ｂ₁₂＝Ｃ_r ／（ｍ・ｖ） ………(11-6) ｂ₂₁＝Ｃ_f ・ａ／Ｉ ………(11-7) ｂ₂₂＝−Ｃ_r ・ｂ／Ｉ ………(11-8) ｂ₂₃＝１／Ｉ ………(11-9) である。また、 β ：車両重心点の横滑り角 ｒ ：ヨーレイト Δψ：車線を基準とするヨー角 Ｌ_s ：磁気センサと車両重心点との平面視における距離 Ｃ_r ：後左右二輪のコーナリングスティフネス Ｃ_f ：前左右二輪のコーナリングスティフネス ｍ ：車両質量 ｂ ：後輪軸と車両重心点との平面視における距離 ａ ：前輪軸と車両重心点との平面視における距離 Ｉ ：車両の慣性モーメント である。

【００５７】ここで、各係数中の分母に車速ｖが介在し
ていることから、これらが車速依存性のモデルであるこ
とが分かり、同時に車速ｖが“０”ではモデルが成立し
ないことから、前述のように車速ｖが低速所定値ｖ₀ 以
上であるときに限って、状態推定を行うことが分かる。

【００５８】そして、前記１１式で、定常的な走行状態
では左辺，つまり車両重心点の横滑り角速度β' （’は
時間微分値を示す）も、ヨー角加速度ｒ' も、ヨーレイ
トΔψ' も、横変位速度ｙ' も全て零になると考えられ
るから、このときの各物理量，或いは状態量に添字
“０”を付けて下記１２式を得る。なお、このような定
常走行状態における各状態量を平衡点周りの状態量と定
義する。

【００５９】 すると、実際に必要な舵角やヨーモーメントは、この平
衡点周りの定常的な舵角やヨーモーメントを与えたとき
に、更にモデル誤差等によって発生する補正分をフィー
ドバックした値になるから、下記１３−１〜３式が与え
られ、更に同様のことが他の各状態量にも言えることか
ら、ヨー角や横変位等の状態量についても下記１４−１
〜４式が成立する。

【００６０】 δ_f ＝δ_f0＋Δδ_f ………(13-1) δ_r ＝δ_r0＋Δδ_r ………(13-2) Ｔ_r ＝Ｔ_r0＋ΔＴ_r ………(13-3) β＝β₀ ＋Δβ ………(14-1) ｒ＝ｒ₀ ＋Δｒ ………(14-2) Δψ＝Δψ₀ ＋Δ² ψ ………(14-3) ｙ＝ｙ₀ ＋Δｙ ………(14-4) これらから下記１３式，１４式で表れる二つの補正ベク
トルΔｕ，Δｘを得ることができる。

【００６１】 次に、車線曲率ρには補正分がないことから、Δρが実
質的に零である（即ちρ₀ ＝ρ）ことを考慮して以上を
総合して解くと、下記１５式を得る。つまり、ここで得
られる状態量の補正ベクトルｘ（補正横滑り角Δβ，補
正ヨーレイトΔｒ，補正ヨー角Δ² ψ、補正横変位Δ
ｙ）が正確なものであるとすると、このベクトルから補
正すべき前輪舵角，つまり補正前輪舵角Δδ_fdや、補正
後輪舵角Δδ_rdや補正ヨーモーメントΔＴ_rd等を算出可
能となる。なお、前述と同様に、ヨーモーメントを補正
しない本実施形態のような場合には、前記定常ヨーモー
メントＴ_r0或いは補正ヨーモーメントΔＴ_rd等を全て
“０”に設定すればよいだけである。

【００６２】 この１５式を、例えば前記図４ａのカルマンフィルタの
構成図に合わせて略記すると下記１６’式のように表れ
る。

【００６３】 ｄΔｘ／ｄｔ＝Ａ’Δｘ＋Ｂ’Δｕ ……… (16') なお、この１６式で用いられる各ベクトル，Ａ’，Ｂ’
は夫々、以下のように纏められる。

【００６４】 ここで、一旦、カルマンフィルタの構成の説明から離れ
て、前記状態量の補正ベクトルΔｘから車線追従，つま
り補正横変位Δｙ＝０を実現するための補正前輪舵角Δ
δ_fdや、補正後輪舵角Δδ_rdや補正ヨーモーメントΔＴ
_rdを設定するために、最適レギュレータを用いた最適化
制御を考える。ここで、拘束条件は前記１６’式であ
り、評価関数Ｊは下記１７式で与えられる。

【００６５】 Ｊ＝∫（Δｘ^T ＱΔｘ＋Δｕ^T ＲΔｕ）ｄｔ ………(17) なお、Δｘ^T は補正ベクトルΔｘの転置ベクトルを、Δ
ｕ^T は補正ベクトルΔｕの転置ベクトルを示す。また、
Ｑは対称非負定行列、Ｒは対称正定行列で、一般に重み
と呼ばれる。補正ベクトルΔｘにおける補正横変位Δｙ
は４行目であるので、当該補正横変位Δｙを小さくする
ためには、前記対称非負定行列Ｑの４行４列要素を大き
くすればよい。但し、ゲインを上げれば、その分だけノ
イズを拾い易くなるというトレードオフを考慮しなけれ
ばならないことは言うまでもない。

【００６６】結論として得られるフィードバック則は、
図４ｂに示すブロック図に合わせて下記１８式で表さ
れ、各要素を列記すると１９式が得られる。なお、Ｋ_R
は定数行列である。

【００６７】 Δｕ＝−Ｋ_R ・Δｘ ………(18) ここで、目標横変位をΔｙ_d とすると、ΔｙをΔｙ_d と
するためには、 となる。

【００６８】つまり、本実施形態では、制御可能な後輪
舵角δ_r であっても、このフィードバック分までは補正
しない，つまり目標後輪舵角δ_rdは前記定常後輪舵角δ
_r0に設定されるため、推定される補正横滑り角Δβ、補
正ヨーレイトΔｒ、補正ヨー角Δ² ψ、補正横変位Δｙ
に対して、補正前輪舵角Δδ_fdは下記２１式で端的に与
えられることになる。

【００６９】 Δδ_fd＝ｋ₁₁・Δβ＋ｋ₁₂・Δｒ＋ｋ₁₃・Δ² ψ＋ｋ₁₄・（Δｙ−Δｙ_d ） ………(21) なお、前述の状態推定器で補正横変位Δｙを除く補正横
滑り角Δβ、補正ヨーレイトΔｒ、補正ヨー角Δ² ψが
検出できない場合には、逆に補正横変位Δｙと補正前輪
舵角Δδ_f を用いて状態推定器を構成すれば、それらの
状態量を推定することができる。

【００７０】一方、再びカルマンフィルタの説明に戻っ
て、本実施形態では、前述したような舵角センサ３で検
出される前輪舵角δ_f と真の前輪舵角δ_fRとの誤差を両
者の舵角の中立値のずれ，即ち舵角中立値ずれδ_fofst
と表し、三者の関係を下記２２式で定義する。

【００７１】 δ_fR＝δ_f ＋δ_fofst ………(22) また、本実施形態では、前記舵角中立値ずれδ_fofst は
外乱ｗによって変化する一次遅れ系の状態量（状態変
数）と見なし、下記２３式で、その挙動を定義する。な
お、式中のτは一次遅れ系の遅れ時間を設定する時定数
である。

【００７２】 ｄδ_fofst ／ｄｔ＝−δ_fofst ／τ＋ｗ ………(23) この２３式の関係を、前記二輪運動モデルを表す１１’
式に組み込んで、新たなカルマンフィルタを構築する
と、それは下記１１式で表される。

【００７３】 この１１式を、前記図４ａのカルマンフィルタの構成図
に合わせて略記すると下記２４式のように表れる。

【００７４】 ｄｘ／ｄｔ＝Ａｘ＋Ｂｕ＋Ｇｗ ………(24) そして、この２４式で用いられる各ベクトル，ｘ，Ａ，
Ｂ，ｕ，Ｇ（外乱係数）は夫々、以下のように纏められ
る。

【００７５】 このようにして車両の各種の状態量を同時に推定するこ
とができるのであるが、前述したモデルと実際の車両と
は、必ず誤差がある。そこで、図４ａに示すように、こ
の推定された横変位ｙと検出された横変位ｙとの偏差
（以下、単に出力誤差とも記す）εを求め、この出力誤
差εに出力誤差フィードバックゲインベクトルＫ_e をか
けて、前記状態推定器内のモデルを補正する。ここで
は、理解を容易化するために、モデルを補正するという
表記を用いるが、実質的には各状態量を直接補正しても
何ら問題がないことから、広義には状態量を補正すると
して取扱う。また、前記出力であるベクトルｘから推定
された横変位ｙを抽出するために図４ａの構成図に合わ
せて下記２５式を設定し、ベクトルＣを下記２５−１式
で定義する。

【００７６】 ｙ＝Ｃｘ ………(25) 前記出力誤差フィードバックゲインベクトルＫ_e は、ベ
クトルの特性上、単純に大小の比較ができないが、以上
の説明から明瞭なように、そのゲイン特性が大きければ
状態量の補正を速やかにして制御の応答性を高めること
ができるが、その反面、ノイズ成分の影響を受け易いこ
とが分かる。逆に、出力誤差フィードバックゲインベク
トルＫ_e のゲイン特性が小さければ、状態量の補正効果
は低下するが、ノイズ成分の影響を抑制防止して制御の
正確性が向上可能であることが分かる。本実施形態で
は、この出力誤差フィードバックゲインベクトルＫ_e に
よって、特に前記舵角中立値ずれδ_fofst をフィードバ
ック補正するものとし、他のモデル構成については補正
しない。従って、本実施形態の出力誤差フィードバック
ゲインベクトルＫ_e は、外乱の変動或いはその分散とい
ったものの影響を、補正される舵角中立値ずれδ_fofst
に如何に与えるかを規定するものであると言える。な
お、このような出力誤差フィードバックゲインベクトル
Ｋ_e の設計法については一般の制御理論で提示されてい
る。

【００７７】次に、前記１式及び２式の算出原理につい
て説明する。本実施形態のように後輪を操舵する場合の
運動方程式は、二輪モデルを用いて下記２６式及び２７
式で表される。

【００７８】 ｍ・ｖ・（ｒ＋β' ）＝Ｃ_f ・（δ_f −（ａ・ｒ＋ｖ・β）／ｖ） ＋Ｃ_r ・（δ_r −（ｖ・β−ｂ・ｒ）／ｖ） ………(26) Ｉ・ｒ' ＝ａ・Ｃ_f ・（δ_f −（ａ・ｒ＋ｖ・β）／ｖ） −ｂ・Ｃ_r ・（δ_r −（ｖ・β−ｂ・ｒ）／ｖ） ………(27) 但し、 β' ：車両重心点の横滑り角速度 ｒ' ：ヨー角加速度 である。

【００７９】また、旋回運動の定常状態におけるヨーレ
イトｒは車線曲率ρと車速ｖとから下記２８式で表され
る。 ｒ＝ρ・ｖ ………(28) また、旋回運動の定常状態では車両重心点の横滑り角速
度β' もヨー角加速度ｒ' も共に零であるから、それを
下記２９式で表す。

【００８０】 β' ＝ｒ' ＝０ ………(29) また、磁気センサ位置での横滑り速度ｖ_s は、ヨーレイ
トψ' 及び横滑り角βを用いて下記２０式で与えられる
ものである。

【００８１】 ｖ_s ＝Ｌ_s ・ｒ＋ｖ・β ………(30) 前記２６式及び２７式の前輪舵角δ_f を前記定常状態に
おける定常前輪舵角δ _f0とすると共に、後輪舵角δ_r を
前記定常状態における定常後輪舵角δ_r0とし、これらの
夫々について前記２６式乃至３０式を解けば前記１式及
び２式を得る。このような算出原理は、前記変更点周り
の状態量，つまり定常状態における各状態量を導出する
ための原理と同じであるから、前記１２式の定常前輪舵
角δ_f0や定常後輪舵角δ_r0と１式や２式のそれらとが夫
々等価であることが理解できる。これは車両の線形性に
よるものである。

【００８２】なお、補正前輪舵角Δδ_fdについては、前
記定常前輪舵角δ_f0を与えたときの横変位ｙのフィード
バック制御による補正分と考えて、古典制御理論にいう
所謂ＰＩＤ制御に応じて設定してもよい。

【００８３】次に、本実施形態の作用について説明す
る。ここで、車線に沿って埋設する磁力源として磁石を
用いた場合、当該磁石からの磁力に基づいて車線に対す
る車両の横変位を検出する原理について簡潔に説明す
る。磁石からの磁力線が図１０のように発生していると
き、磁気センサのレベル（高さ）は一定であるから、検
出される磁力ベクトルの縦横成分の比が分かれば、磁気
センサ，つまり車両は磁石，つまり車線に対してどの程
度横方向にずれているかが分かる。即ち、磁気センサが
磁石の真上にあれば、検出される磁力ベクトルの縦横成
分の比は１：０になるし、それが横方向にずれればずれ
るほど、検出される磁力ベクトルの横成分が大きくな
り、縦成分は小さくなる。また、磁力ベクトルの横成分
の発生方向から、磁気センサ，つまり車両が磁石，つま
り車線に対して、どちらにずれているかも分かる。

【００８４】次に、この原理を用いて車線に対する車両
の横変位を検出するタイミングについて簡潔に説明す
る。今、車両に取付けられた磁気センサが、図１０で説
明したように磁石に対して横方向にずれていないとした
とき（ずれていても横変位が同じなら結局は同じ）、図
１１ａに示すように磁気センサと磁石との距離をＤとす
ると、距離Ｄと磁力との関係は図１１ｂのように表れ
る。つまり、磁気センサが磁石に最も接近したときに、
検出される磁力も最大になる。従って、検出される磁力
が最大になったとき、その磁力ベクトルの縦横成分比か
ら車両の横変位を正確に検出することが可能となる。

【００８５】そこで、この検出された横変位を用いて前
述のように目標とする横変位に一致するように操舵アク
チュエータを制御する場合に、本実施形態では、前述の
ように出力誤差を補正できるカルマンフィルタのような
オブザーバ（状態推定器）を用いてノイズ成分を除去す
る。

【００８６】次に、前述のようにして検出される横変位
ｙのノイズ成分について説明する。このような車線に沿
って埋設された磁石等の磁力源の磁力を磁気センサで検
出して車線に対する車両の横変位を検出する手法では、
実際の車両で検出される横変位にノイズ（誤差成分を含
む）が多い。これについては、例えば図１２に示すよう
に、車線の幅を示す二本の白線の中央に相当する車線中
央に磁石等の磁力源が正確に埋設されていないせいだと
考えられてきた。つまり、本来、車線中央にあるべき磁
石等の磁力源が横方向にずれて埋設されていれば、検出
される横変位は図１３に示すように、車両（正確には磁
気センサ）が仮に車線中央に沿って移動したとしても、
恰も横方向にずれているかのように誤認識してしまう。

【００８７】しかしながら、この検出される横変位ｙの
ノイズ成分には、この他に、以下のようなノイズ成分も
ある。即ち、前述のような車両の自動操舵装置は、一般
に高度な演算処理を必要とすることから離散化したディ
ジタルシステムで構成される。従って、例えば前述のよ
うに磁気センサで磁石の磁力を検出する，そのサンプリ
ングタイミングと、実際に磁気センサが磁石に最も近づ
くタイミングとがずれてしまう可能性がある。この可能
性は、磁石と磁気センサ，つまり車両との相対速度が大
きくなればなるほど大きくなる。

【００８８】これを実際の車両で再現すると、例えば車
速ｖが大きくなるほど、或いは車線曲率ρが大きくなる
ほど、検出される横変位のノイズ成分が大きくなり、結
果的に自動操舵制御の正確性が低下する。このうち、車
線曲率ρが大きくなるということは、車線中心線に沿っ
て移動しようとする車両の移動方向と実際に車両が向い
ている方向との角度，つまりヨー角が大きいということ
であり、それは同時に磁気センサの横滑り速度が大きい
ということである。定常的な旋回運動中であれば、両者
は互いに等価であると評価できるが、前述した磁力のサ
ンプリングタイミングと磁気センサの最接近タイミング
とのずれは、磁石と磁気センサ，つまり車両との相対速
度に起因すると考えると、磁気センサの横滑り速度が大
きくなるほど、検出される横変位のノイズ成分が大きく
なる。

【００８９】こうした磁石と磁気センサ，つまり車両と
の相対速度のうち、車両の前後方向，つまり前記センサ
横滑り速度と直交する方向の速度成分であって、所謂車
速に相当する成分は、車両が所望する速度移動するため
に変更できない、或いは変更すべきでない速度成分であ
る。そこで、本実施形態では、前記センサ横滑り速度を
低減し、望ましくは零として、検出される横変位のノイ
ズ成分を低減しようとする。ところが、通常の車両のよ
うに、前輪のみを操舵する車両にあっては、車両特性に
よっては、磁気センサの位置におけるセンサ横滑り速度
を制御することができない。つまり、センサ横滑り速度
（車両の横滑り速度と同じ）は、舵角と車速が与えられ
ると、車両特性によって一意に決まってしまう（勿論、
路面μや路面の形状等の外乱要素は個別の要素であ
る）。

【００９０】そこで、本実施形態では、主として操舵さ
れる前輪が、あくまでも車線追従制御を司り、更に後輪
を補助操舵することで、前記センサ横滑り速度を低減
し、好ましくは零とする。このとき、補助操舵される後
輪の目標とする舵角には、前記定常後輪舵角δ_r0を用い
て前記センサ横滑り速度を零に近づけながら車両の挙動
を安定させ、一方で前輪には定常前輪舵角δ_f0を与えて
車線に大まかに追従できるようにしながら、更に補正前
輪舵角Δδ_fdを与えて微小横変位Δｙを補正して完全な
車線追従を達成する。つまり、本実施形態の車両では、
図５に示すように一般的な車両とはやや異なる車両旋回
運動が達成される。勿論、センサ横滑り速度は零又は略
零となるために、その分だけ、検出される横変位ｙのノ
イズ成分が低減し、結果的に自動操舵制御の正確性が向
上する。

【００９１】一方、本実施形態では、前記カルマンフィ
ルタで推定する状態量の一つとして舵角センサ３からの
舵角中立値ずれδ_fofst を、車両の走行中に随時推定し
続ける。ここでは、車両の走行そのものを二輪モデルと
して同時並行的に推定しているので、それと共に推定さ
れる舵角中立値ずれδ_fofst は、例えば操舵しようとす
まいと，或いは曲線路面であろうとなかろうと、車両挙
動に伴う変動が補正されながら、あらゆる走行状態で正
確な値であろうとし続ける。これは、前記出力誤差フィ
ードバックゲインベクトルＫ_e の影響によるものであ
る。即ち、推定される状態量の一つである横変位ｙと検
出される横変位ｙとの誤差εに応じて、出力誤差フィー
ドバックゲインベクトルＫ_e の影響によって舵角中立値
ずれδ_{fofs t} が補正されるので、例えば車両の走行開始
直後には、推定される舵角中立値ずれδ_fofst が真値か
ら大きく離れていたとしても、横変位ｙの誤差εでこれ
を補正する度に舵角中立値ずれδ_fofst は真値に近づい
てゆくのである。

【００９２】しかも本実施形態では、舵角中立値ずれδ
_fofst を推定する度に、即ち前記中立値算出カウンタＣ
ＮＴが大きくなるにつれて、当該舵角中立値ずれδ
_fofst を外乱ｗに対する一次遅れ系に規定する時定数τ
が次第に大きくなるので、舵角中立値ずれδ_fofst は次
第に外乱の影響を受けにくくなることになる。つまり、
一次遅れ系の時定数τが大きくなれば、外乱ｗによって
到達する目標値までの到達所要時間が長くなることにな
るから、次の外乱ｗを考えれば，即ち次回のサンプリン
グ時刻までの変化量を考えれば、舵角中立値ずれδ
_fofst は次第に安定化又は定常化，或いは数値的には定
数化してゆくことになる。従って、例えば車両の走行開
始直後には、推定される舵角中立値ずれδ_fofst が真値
から大きく離れているものとするならば、この一次遅れ
系の時定数τを小さくすることによって、推定サンプリ
ング時刻毎の真値への収束性を高め、次第に時定数τを
大きくすることによって、これを真値に向けて定数化
し、制御の正確性を得ることができるようになる。

【００９３】また、本実施形態では、各サンプリング時
刻毎に舵角中立値ずれδ_fofst を推定するものの、実際
の演算処理に用いられる舵角中立値ずれδ_fofst は、前
記図２の演算処理のステップＳ１３乃至ステップＳ１５
において、車線曲率ρが近似直線所定値ρ₀ 以下のと
き，即ちほぼ直線車線を走行しているときにしか更新さ
れない。即ち、少なくとも現段階で、例えば車線脇から
の無線情報として得られる車線曲率ρは比較的曖昧なも
のが多く、車両の自動操舵そのものは、あくまでも磁
石，即ち車線に対する横変位ｙをフィードバック補正し
ながら行われるので、車線曲率ρの情報が曖昧でもさほ
ど問題はないが、前述のように非常に正確な舵角フィー
ドバック制御が要求される中での舵角中立値ずれδ
_fofst は、曖昧な車線曲率ρでは不完全なものとなり易
い。そこで、本実施形態では、車線曲率ρが近似直線所
定値ρ₀ 以下の略直線車線走行時にのみ、演算処理に用
いられる舵角中立値ずれδ_fofst を更新することで、制
御の正確性を確保するようにしている。

【００９４】また、前述のようにカルマンフィルタを構
成する各パラメータは車速ｖに依存しており、実際のカ
ルマンフィルタの駆動時には、車速ｖで各パラメータを
補正しながら状態量の推定を行うので、舵角中立値ずれ
δ_fofst を含む，推定される各状態量をより正確なもの
とすることができる。

【００９５】以上より、前記自動操舵機構が本発明の操
舵アクチュエータを構成し、以下同様に、前記舵角セン
サ３及び図２の演算処理のステップＳ６が舵角検出手段
を構成し、前記横変位検出装置２及び図２の演算処理の
ステップＳ９が横変位検出手段を構成し、図２の演算処
理のステップＳ１２乃至ステップＳ１５がカルマンフィ
ルタを含む状態推定手段を構成し、図２の演算処理のス
テップＳ１６乃至ステップＳ２０が最適レギュレータを
含む操舵制御手段を構成し、車線曲率検出装置１６及び
図２の演算処理のステップＳ３が車線曲率検出手段及び
走行状態情報検出手段を構成し、車速センサ４及び図２
の演算処理のステップＳ１が車速検出手段及び走行状態
情報検出手段を構成している。

【００９６】なお、前記第１実施形態では、後輪を補助
操舵する機構を持ち、更に前記図２の演算処理では、横
変位偏差に対する当該後輪の補正後輪舵角まで算出可能
としながら、横変位偏差の補正に対しては後輪舵角を制
御せず、センサ横滑り速度を零とするための定常後輪舵
角のみを目標後輪舵角に設定したが、勿論、横変位を補
正するために後輪舵角を補正してもよい。但し、この場
合には、定常後輪舵角がセンサ横滑り速度を零とするた
めの値に設定されたのに対して、更に横変位を補正する
ためにこれを補正するのであるから、センサ横滑り速度
の収束性が低下する虞れがあることに留意したい。この
場合には、センサ横滑り速度の出力誤差に対する状態量
の補正か、若しくはセンサ横滑り速度に対する最適レギ
ュレータが必要となろう。

【００９７】次に、本発明の第２実施形態の自動操舵装
置について説明する。まず、車両に設けられた自動操舵
装置としての概要は、前記第１実施形態の後輪の補助操
舵機構に代えて、横運動量調整手段を構成するトラクシ
ョン調整機構が取付けられている。このトラクション調
整機構は、図６に示すように、例えば各車輪に設けられ
たトラクションコントロールアクチュエータ２２によっ
て構成され、各車輪のトラクション（駆動及び制動力）
を調整することで車両に発生するヨーモーメントを調整
するものである。より具体的には、本出願人が先に提案
した特開平６−３２１０８７号公報に記載される制動力
制御装置や、特開平８−１２７２５８号公報に記載され
る後左右輪の駆動力制御装置や、或いは公知の前後輪間
駆動力配分制御装置等を単独で或いは適宜に組み合わせ
て用いることができる。これらのトラクションコントロ
ールアクチュエータ２２の具体的な制御の詳細について
は、これらの文献を参照されるものとして、ここでは目
標とするヨーモーメントＴ _rdを達成するための制御信号
が、前記コントロールユニット１３から各トラクション
コントロールアクチュエータ２２に供給されると、各ア
クチュエータは単独で或いは相互に作動して、当該目標
とするヨーモーメントＴ_rdを達成するものとする。それ
以外の構成は、前記第１実施形態のものと同様又は略同
様であり、同等の構成部材には同等の符号を附してその
詳細な説明を省略する。

【００９８】また、本実施形態でも、前記第１実施形態
と同様に、前記自動操舵コントロールユニット１３内の
マイクロコンピュータ等のディジタルシステム中に、状
態推定器としてのカルマンフィルタが構築されている。
但し、前記１１式に示す二輪モデルは、後輪を操舵可能
とし、更にヨーモーメントを制御可能としたものである
から、本実施形態のように前輪を主として操舵して車両
の横変位を制御する共に、ヨーモーメントを制御して、
前記磁気センサ１２の位置における対磁石横方向速度，
つまりセンサ横滑り速度を低減するだけのものの場合に
は前記１１式中の後輪舵角δ_r を零に設定すればよい。
また、後輪舵角を補正しない本実施形態のような場合に
は、前記１２式，１４式，１５式，１７式等における定
常後輪舵角δ_r0や補正後輪舵角Δδ_rd等を全て“０”に
設定すればよいだけである。また、本実施形態では、前
記最適レギュレータ及びカルマンフィルタの説明と同様
に、前記１１式からなる状態推定器によって、横変位ｙ
と前輪舵角Δδ_fdとからヨーモーメントＴ_r を推定可能
な構成となっている。

【００９９】次に、前記自動操舵コントロールユニット
１３内で実行される本実施形態の演算処理について図７
のフローチャートを用いて説明する。なお、このフロー
チャートでも、特に情報の授受のためのステップを設け
ていないが、第１実施形態と同様に、情報の授受は随時
実行される。また、この演算処理は、第１実施形態と同
様に、例えば１０msec. といった予め設定されたサンプ
リング時間ΔＴ毎にタイマ割込処理として実行される。

【０１００】この実施形態の演算処理は、前記図３に示
す第１実施形態の演算処理のステップＳ１３が削除さ
れ、同じくステップＳ４，Ｓ５，Ｓ６，Ｓ１１，Ｓ１
８，Ｓ２０の夫々が、ステップＳ４’，Ｓ５’，Ｓ
６’，Ｓ１１’，Ｓ１８’，Ｓ２０’に代わっている他
は、全て第１実施形態と同様であるので、同等のステッ
プには同等の符号を附してその詳細な説明を省略する。

【０１０１】この変更になったステップのうち、ステッ
プＳ４’では、下記３１式に従って定常前輪舵角δ_f0を
算出する。なお、下記３１式の算出原理については後段
に詳述する。また、この定常前輪舵角δ_f0は、車両の線
形性により、定常後輪舵角δ _r0＝０としたときの前記１
２式で表れる平衡点周りの状態量と等価である。

【０１０２】 また、ステップＳ５’では、下記３２式に従って定常ヨ
ーモーメントＴ_r0を算出する。なお、下記３２式の算出
原理についても後段に詳述する。また、この定常ヨーモ
ーメントＴ_r0は、車両の線形性により、定常後輪舵角δ
_r0＝０としたときの前記１２式で表れる平衡点周りの状
態量と等価である。

【０１０３】 Ｔ_r0＝（ａ＋ｂ）・ρ・Ｃ_r （ｂ＋Ｌ_s ）＋ａ・ｍ・ρ・ｖ² ………(32) また、ステップＳ６’では、単に、前記舵角センサ３か
らの前輪舵角δ_f のみを読込む。

【０１０４】また、ステップＳ１１’では、後述する図
８の制御マップ等に従って中立値算出カウンタＣＮＴか
ら前記出力誤差フィードバックゲインベクトルＫ_e を設
定する。この図３の制御マップで設定される出力誤差フ
ィードバックゲインベクトルＫ_e は、それ自身が複数の
要素からなるベクトルであることから単純な１変数では
ないが、各要素の変化の様子を示しており、全要素は前
記中立値算出カウンタ（回数）ＣＮＴの増加に伴って減
少傾きが次第に小さくなる単純減少関数として設定され
る。

【０１０５】また、ステップＳ１８’では、前記２４式
に従って目標前輪舵角δ_fdを算出すると共に、下記３３
式に従って目標ヨーモーメントＴ_rdを算出する。 Ｔ_rd＝Ｔ_r0 ………(33) また、ステップＳ２０’では、前記設定された目標ヨー
モーメントＴ_rdに実ヨーモーメントＴ_r を一致させるフ
ィードバック制御の制御信号を創成し出力してからメイ
ンプログラムに復帰する。

【０１０６】次に、前記３１式及び３２式の算出原理に
ついて説明する。本実施形態のように車両のヨーモーメ
ントを制御する場合の運動方程式は、二輪モデルを用い
て下記３４式及び３５式で表される。

【０１０７】 ｍ・ｖ・（ｒ＋β' ）＝Ｃ_f ・（δ_f −（ａ・ｒ＋ｖ・β）／ｖ） ＋Ｃ_r ・（−（ｖ・β−ｂ・ｒ）／ｖ） ………(34) Ｉ・ｒ' ＝ａ・Ｃ_f ・（δ_f −（ａ・ｒ＋ｖ・β）／ｖ） −ｂ・Ｃ_r ・（−（ｖ・β−ｂ・ｒ）／ｖ）＋Ｔ_r ………(35) 但し、 Ｔ_r ：車両に発生する四輪分のヨーモーメント である。

【０１０８】次に、本実施形態の作用について説明す
る。まず、検出される横変位ｙのノイズ成分について
は、前記第１実施形態での説明と同様であるために、こ
こでの説明を省略する。

【０１０９】本実施形態では、主として操舵される前輪
で車線追従制御を行い、更に各車輪のトラクションを調
整して車両に発生するヨーモーメントを調整すること
で、前記センサ横滑り速度を低減し、好ましくは零とす
る。このとき、目標とするヨーモーメントＴ_rdには、前
記定常ヨーモーメントＴ_r0を用いて前記センサ横滑り速
度を零に近づけながら車両の挙動を安定させ、一方で前
輪には定常前輪舵角δ_f0を与えて車線に大まかに追従で
きるようにしながら、更に補正前輪舵角Δδ_fdを与えて
微小横変位Δｙを補正して完全な車線追従を達成する。
つまり、本実施形態の車両でも、理想的な旋回運動とし
て、図９に示すように磁気センサの横滑り速度もヨー角
速度も零であり、一定のヨー角を保ったまま、車両は旋
回する。勿論、センサ横滑り速度は零又は略零となるた
めに、その分だけ、検出される横変位ｙのノイズ成分が
低減し、結果的に自動操舵制御の正確性が向上する。

【０１１０】一方、前記カルマンフィルタでは、前記第
１実施形態と同様に、正確な舵角中立値ずれδ_fofst が
推定されるが、本実施形態では、前記時定数τに代えて
出力誤差フィードバックゲインベクトルＫ_e を変更して
いる。前述のように、この出力誤差フィードバックゲイ
ンベクトルＫ_e は、検出される横変位ｙと推定された横
変位ｙとの出力誤差に応じて、外乱ｗの影響を補正され
る舵角中立値ずれδ_{fo fst} に如何に与えるかを規定する
ものであるから、そのゲインが大きければ舵角中立値ず
れδ_fofst は外乱ｗの影響を受け易く、小さければ受け
にくい。ここでは、舵角中立値ずれδ_fofst を推定する
度に、即ち前記中立値算出カウンタＣＮＴが大きくなる
につれて、当該出力誤差フィードバックゲインベクトル
Ｋ_e が次第に小さくなるので、舵角中立値ずれδ_fofst
は次第に外乱の影響を受けにくくなることになる。つま
り、舵角中立値ずれδ_fofst は次第に安定化又は定常
化，或いは数値的には定数化してゆくことになる。従っ
て、例えば車両の走行開始直後には、推定される舵角中
立値ずれδ_fofst が真値から大きく離れているものとす
るならば、この出力誤差フィードバックゲインベクトル
Ｋ_e を大きくすることによって、推定サンプリング時刻
毎の真値への収束性を高め、次第に出力誤差フィードバ
ックゲインベクトルＫ_e を小さくすることによって、こ
れを真値に向けて定数化し、制御の正確性を得ることが
できるようになる。

【０１１１】また、本実施形態では、第１実施形態と異
なり、各サンプリング時刻毎に推定された舵角中立値ず
れδ_fofst を、実際の演算処理に用いられる舵角中立値
ずれδ_fofst として、そのまま更新する。現段階におけ
る車線曲率ρ情報が比較的曖昧であることは否めない
が、前述のように舵角中立値ずれδ_fofst は次第に真値
に近づくように補正され続けるのであるし、自動操舵そ
のものは、車線に対する横変位ｙをフィードバック補正
しながら行われるので、ここでは舵角中立値ずれδ
_fofst のサンプリング数をできるだけ増やして自動操舵
制御の正確性を向上させることを目的としている。ま
た、将来的に得られる車線曲率ρ情報が正確なものとな
れば、舵角中立値ずれδ_fofst のサンプリング数を早め
ることは、それ自身を速やかに真値に近づけることに繋
がる。

【０１１２】また、第１実施形態と同様に、カルマンフ
ィルタ中の各パラメータを車速ｖで補正することによ
り、推定される各状態量を正確なものとすることができ
る。以上より、前記自動操舵機構が本発明の操舵アクチ
ュエータを構成し、以下同様に、前記舵角センサ３及び
図７の演算処理のステップＳ６’が舵角検出手段を構成
し、前記横変位検出装置２及び図７の演算処理のステッ
プＳ９が横変位検出手段を構成し、図７の演算処理のス
テップＳ１２乃至ステップＳ１５がカルマンフィルタを
含む状態推定手段を構成し、図７の演算処理のステップ
Ｓ１６乃至ステップＳ２０’が最適レギュレータを含む
操舵制御手段を構成し、車線曲率検出装置１６及び図７
の演算処理のステップＳ３が車線曲率検出手段及び走行
状態情報検出手段を構成し、車速センサ４及び図７の演
算処理のステップＳ１が車速検出手段及び走行状態情報
検出手段を構成している。

【０１１３】なお、前記第２実施形態では、横運動量と
してヨーモーメントを調整する機構を持ち、更に前記図
７の演算処理では、横変位偏差に対する補正ヨーモーメ
ントまで算出可能としながら、横変位偏差の補正に対し
てはヨーモーメントを制御せず、センサ横滑り速度を零
とするための定常ヨーモーメントのみを目標ヨーモーメ
ントに設定したが、勿論、横変位を補正するためにヨー
モーメントを補正してもよい。但し、この場合には、前
記定常ヨーモーメントがセンサ横滑り速度を零とするた
めの値に設定されたのに対して、更に横変位を補正する
ためにこれを補正するのであるから、センサ横滑り速度
の収束性が低下する虞れがあることに留意したい。この
場合には、センサ横滑り速度の出力誤差に対する状態量
の補正か、若しくはセンサ横滑り速度に対する最適レギ
ュレータが必要となろう。

【０１１４】また、上記二つの実施形態を組合わせて車
両運動を制御することも勿論可能であるが、制御すべき
状態量が二つだとしたら、制御する入力も二つにしてお
いたほうが、所謂連鎖的な反応を回避して制御の正確性
を確保し易い。

【０１１５】また、前記第１及び第２実施形態では、共
に車線曲率ρを、外部からの情報として読込む場合につ
いてのみ詳述したが、この車線曲率ρは、前述した横変
位やヨーレート，ヨー角，車速等の運動方程式で表れる
ことは周知であるから、これらを用いて推定することも
可能である。

【図面の簡単な説明】

【図１】本発明の車両の自動操舵装置の第１実施形態を
示す車両概略構成図であり、（ａ）は側面図、（ｂ）は
平面図である。

【図２】図１の車両の自動操舵装置で実行される演算処
理を示すフローチャートである。

【図３】図２の演算処理で用いられる制御マップであ
る。

【図４】（ａ）はカルマンフィルタの一例を示すブロッ
ク図、（ｂ）は推定された状態量から制御量を出力する
演算装置の一例を示すブロック図である。

【図５】図１の車両で達成される横滑り速度の説明図で
ある。

【図６】本発明の車両の自動操舵装置の第２実施形態を
示す車両概略構成図であり、（ａ）は側面図、（ｂ）は
平面図である。

【図７】図６の車両の自動操舵装置で実行される演算処
理を示すフローチャートである。

【図８】図７の演算処理で用いられる制御マップであ
る。

【図９】図６の車両で達成される横滑り速度の説明図で
ある。

【図１０】車線に埋設された磁石からの磁力ベクトルの
説明図である。

【図１１】車両に取付けられた磁気センサで磁石の磁力
を検出する説明図である。

【図１２】車線に埋設された磁石の説明図である。

【図１３】検出された磁力に応じて得られる車両横変位
の説明図である。

【符号の説明】

１は磁気センサ ２は横変位検出装置（横変位検出手段） ３は舵角センサ（舵角検出手段） ４は車速センサ（車速検出手段） ５はモータ ６はクラッチ機構 ７はドライブギヤ ８はドリブンギヤ ９はステアリングシャフト １０はピニオン １１はラック １２は前左右輪 １３は自動操舵コントロールユニット １４はステアリングホイール １５は後左右輪 １６は車線曲率検出装置（車線曲率検出手段） １７はモータ １８はギヤ １９はラック ２０は操舵杆 ２１は補助舵角センサ ２２はトラクションコントロールアクチュエータ

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.⁶ 識別記号 ＦＩ Ｂ６２Ｄ 113:00

Claims (10)

【特許請求の範囲】
1. 【請求項１】 状態推定手段で車両の種々の状態変数を
   推定しながら、車両を自動操舵するにあたり、車両を直
   進走行させる真の舵角の中立値と、検出される操舵輪の
   舵角の中立値との舵角中立値ずれを、車両の状態変数の
   一つとしてモデル化して前記状態推定手段に組み込み、
   当該状態推定手段で前記舵角中立値ずれを推定すること
   を特徴とする車両の自動操舵装置。
2. 【請求項２】 前記舵角中立値ずれを外乱で変化する変
   数とし、次第に外乱の影響を受けにくくして定数化する
   ことを特徴とする請求項１に記載の自動操舵装置。
3. 【請求項３】 前輪又は後輪を操舵する操舵アクチュエ
   ータと、この操舵アクチュエータによって操舵される前
   輪又は後輪の舵角を検出する舵角検出手段と、走行車線
   に対する車両の横変位を検出する横変位検出手段と、少
   なくとも走行車線に対する車両の横変位を含む車両の状
   態変数を車両モデルから推定する状態推定手段と、この
   推定された車両の状態変数を用いて、前記検出された車
   両の横変位と推定された車両の横変位との誤差が目標と
   する値になるように、前記舵角検出手段で検出された舵
   角をフィードバック制御しながら、前記操舵アクチュエ
   ータを制御する操舵制御手段とを備えた車両の自動操舵
   装置において、前記状態推定手段は、車両を直進走行さ
   せる真の舵角の中立値と、前記舵角検出手段で検出され
   る舵角の中立値との舵角中立値ずれを、モデル化された
   車両の状態変数の一つとして推定し、前記操舵制御手段
   は、この状態推定手段で推定された舵角の中立値とのず
   れを用いて前記舵角をフィードバック制御することを特
   徴とする車両の自動操舵装置。
4. 【請求項４】 前記状態推定手段は、直線又は略直線の
   車線を走行しているときに前記舵角中立値ずれを推定又
   は更新するものであることを特徴とする請求項３に記載
   の車両の自動操舵装置。
5. 【請求項５】 前記状態推定手段は、車両の走行状態情
   報を検出する手段として、少なくとも車線曲率を検出す
   る車線曲率検出手段を備え、この車線曲率検出手段で検
   出された車線曲率を用いて前記舵角中立値ずれを推定す
   るものであることを特徴とする請求項３に記載の車両の
   自動操舵装置。
6. 【請求項６】 前記状態推定手段は、車両の走行状態情
   報を検出する手段として、車速を検出する車速検出手段
   を備え、この車速検出手段で検出された車速を用いて前
   記車両モデルを補正しながら前記舵角中立値ずれを含む
   車両の状態変数を推定するものであることを特徴とする
   請求項３乃至５の何れかに記載の車両の自動操舵装置。
7. 【請求項７】 前記舵角中立値ずれを外乱で変化する一
   次遅れ系としてモデル化し、前記状態推定手段は、前記
   舵角中立値ずれの推定回数の増加に伴って、前記外乱の
   分散を小さくするように補正することを特徴とする請求
   項３乃至６の何れかに記載の車両の自動操舵装置。
8. 【請求項８】 前記舵角中立値ずれを外乱で変化する一
   次遅れ系としてモデル化し、前記状態推定手段は、前記
   舵角中立値ずれの推定回数の増加に伴って、前記一次遅
   れ系の時定数を大きくするように補正することを特徴と
   する請求項３乃至７の何れかに記載の車両の自動操舵装
   置。
9. 【請求項９】 前記操舵制御手段が、前記検出された車
   両の横変位と推定された車両の横変位との誤差を目標と
   する値に最適化する最適レギュレータを含んで構成され
   ることを特徴とする請求項３乃至８の何れかに記載の車
   両の自動操舵装置。
10. 【請求項１０】 前記状態推定手段がカルマンフィルタ
    で構成されることを特徴とする請求項１乃至９の何れか
    に記載の車両の自動操舵装置。