(57)【要約】      （修正有）【課題】  車線追従制御装置作動中のドライバによる車線変更操作時に、違和感を感じさせないように適切なタイミングで車線追従制御動作を解除し、かつ車線変更時における車両走行安定性を確保する。【解決手段】  車線追従制御装置１において、操舵角δを取得し当該操舵角の時間変化状態が所定条件に該当するか否かを検出し、当該操舵角の時間変化状態が車線変更操作によるものか否かを判断する運転モード判断部１１と、運転モード判断部１１が操舵角の時間変化状態が車線変更操作によらないものと判断したときは車線追従制御用の目標ヨーレートγcを生成し、運転モード判断部１１が前記操舵角の時間変化状態が車線変更操作によるものと判断したきは車線変更制御用の目標ヨーレートγδを生成する制御部１２と、少なくとも制御部１２により取得した目標ヨーレートを制御パラメータとする車両制御信号Ｍを生成する車両運転制御部１３とを備える。【選択図】  図１
2008044561.tif 000002
【特許請求の範囲】
【請求項１】
ヨーレートを制御情報のひとつとして車線追従制御を行う車線追従制御装置において、
操舵角および／または操舵角速度から、現在、車両が車線追従モード下にあるのか、車線変更モード下にあるのか、あるいは、前記車線追従モードまたは前記車線変更モードの一方から他方に遷移する途中の中間モード下にあるのかを判断する運転モード判断部と、
前記運転モード判断部が前記各モードを判定した際に、各モードに対応した制御を行う制御部と、
を備え、
前記制御部は、
前記運転モード判断部が前記車両が前記車線追従モード下にあると判断したときは車線追従運転用のヨーモーメントまたは横方向付勢力の制御信号を生成し、
前記運転モード判断部が前記車両が前記車線変更モード下にあると判断したときは、制御信号を発生せず、または車線変更運転用のヨーモーメントまたは横方向付勢力の制御信号を生成し、
前記運転モード判断部が前記車両が前記中間モード下にあると判断した場合において、直前に前記車線追従運転用の前記制御信号を生成しているときは当該車線追従運転用の制御信号を、直前に前記車線変更運転用の前記制御信号を生成しているときは当該車線変更運転用の制御信号を生成する、
ことを特徴とする車線追従制御装置。
【請求項２】
前記運転モード判断部は、現在、前記車線追従運転モード下、前記車線変更モード下または前記中間モード下のどのモード下にあるかを、観測可能な量を用いて決定することを特徴とする請求項１に記載の車線追従制御装置。
【請求項３】
前記車線追従運転モード、前記車線変更モードおよび前記中間モードが、隠れマルコフモデルにおける遷移する状態であり、前記観測可能な量が隠れマルコフモデルにおける出力シンボルであることを特徴とする請求項２に記載の車線追従制御装置。
【請求項４】
請求項１から３に記載の車線追従制御装置を搭載した自動車であって、後部側または前部側の左右両輪または全輪にそれぞれ独立に駆動されるモータを備え、前記制御部は前記モータを制御することを特徴とする自動車。
【請求項５】
請求項１から３に記載の車線追従制御装置を搭載した自動車であって、後部側または前部側の左右両輪または全輪にそれぞれ独立に制動力を付与する制動機を備え、前記制御部は前記制動機を制御することを特徴とする自動車。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、操舵角情報さらには操舵角速度情報をドライバの操作意図の推定に用いることで当該推定を正確に行い、さらに当該推定結果に適合した車両運動制御を行うことができる車線追従制御装置およびこれを搭載した自動車に関する。
【背景技術】
【０００２】
近年、車線追従制御装置を搭載した車両（自動車）が開発されるようになっている。この種の自動車では、ドライバにより車線変更操作が行われるような場合には、適宜のタイミングで（すなわち、運転中にドライバに違和感を感じさせない適切なタイミングで）車線追従制御を解除している。たとえば、特許文献１の技術では、車線追従制御中に車線変更が行われる場合には、あらかじめ記憶したドライバの運転行動パターンに基づいて、ドライバの車線変更意図を認識し、車線追従制御を解除する。
【特許文献１】特開平１１−３２１６９０号公報
【発明の開示】
【発明が解決しようとする課題】
【０００３】
ところが、上記した特許文献１の技術では、異なるドライバが運転する際には車線変更意図の認識ができない。また、車線変更に際してすべての運転操作にかかる制御が解除されてしまうと、スリップ等が生じた場合に重大事故につながる可能性がある。このため、車線追従制御がなされているときに車線変更があったときは、制御を当該車線変更に対応した制御に切り替えることも考えられる。
【０００４】
車線追従制御が行われている場合に車線変更操作がなされると、車線追従制御と車線変更のための制御とが干渉し、以下のような問題が生じる。すなわち、ドライバが、車線変更意図に基づき車線変更操作をしても、車線追従制御装置が車線追従制御をし続けるために、円滑な車線変更を行うことができない。また、たとえばドラバイの不注意によりハンドルを僅かに回転させてしまった場合に、ドライバに車線変更意図がないにもかかわらず、制御が車線変更運転用の制御に切り替わってしまうこともある。
【０００５】
さらに、運転履歴を考慮してドライバの車線変更意図を推定し、推定結果に基づき制御を行うことも考えられるが、高い安全性に応えることができる制御技術は従来提供されていない。
【０００６】
本発明の目的は、操舵角等の履歴情報をドライバの操作意図の推定に用いることで当該推定を正確に行い、さらに当該推定結果に適合した車両運動制御（車線追従制御の維持や車線変更操作への円滑な移行）を行うことができる車線追従制御装置およびこれを搭載した自動車を提供することにある。
【課題を解決するための手段】
【０００７】
本発明の車線追従制御装置は、（１）〜（３）を要旨とする。
（１）    ヨーレートを制御情報のひとつとして車線追従制御を行う車線追従制御装置において、
操舵角および／または操舵角速度から、現在、車両が車線追従モード下にあるのか、車線変更モード下にあるのか、あるいは、前記車線追従モードまたは前記車線変更モードの一方から他方に遷移する途中の中間モード下にあるのかを判断する運転モード判断部と、
前記運転モード判断部が前記各モードを判定した際に、各モードに対応した制御を行う制御部と、
を備え、
前記制御部は、
前記運転モード判断部が前記車両が前記車線追従モード下にあると判断したときは車線追従運転用のヨーモーメントまたは横方向付勢力の制御信号を生成し、
前記運転モード判断部が前記車両が前記車線変更モード下にあると判断したときは、制御信号を発生せず、または車線変更運転用のヨーモーメントまたは横方向付勢力の制御信号を生成し、
前記運転モード判断部が前記車両が前記中間モード下にあると判断した場合において、直前に前記車線追従運転用の前記制御信号を生成しているときは当該車線追従運転用の制御信号を、直前に前記車線変更運転用の前記制御信号を生成しているときは当該車線変更運転用の制御信号を生成する、
ことを特徴とする車線追従制御装置。
【０００８】
（２）  前記運転モード判断部は、現在、前記車線追従運転モード下、前記車線変更モード下または前記中間モード下のどのモード下にあるかを、観測可能な量（典型的には、前記操舵角または当該操舵角の回転速度（操舵角速度））を用いて決定することを特徴とする（１）に記載の車線追従制御装置。
【０００９】
（３）  前記車線追従運転モード、前記車線変更モードおよび前記中間モードが、隠れマルコフモデルにおける遷移する状態であり、前記観測可能な量が隠れマルコフモデルにおける出力シンボルであることを特徴とする（２）に記載の車線追従制御装置。
【００１０】
本発明の自動車は、（４）および（５）を要旨とする。
（４）  （１）から（３）に記載の車線追従制御装置を搭載した自動車であって、後部側または前部側の左右両輪または全輪にそれぞれ独立に駆動されるモータを備え、前記制御部は前記モータを制御することを特徴とする自動車。たとえば、全輪に独立に駆動されるモータを備えている場合、前記制御部はまたは後輪の何れかの左右両輪のモータを制御するようにできる。
【００１１】
（５）  （１）から（３）に記載の車線追従制御装置を搭載した自動車であって、後部側または前部側の左右両輪または全輪にそれぞれ独立に制動力を付与可能な制動機を備え、前記制御部は前記制動機を制御することを特徴とする自動車。自動車がエンジン自動車の場合には、制動機はブレーキ機構である。また、自動車が電気自動車の場合には、制動機はブレーキ機構であってもよいし、モータの制動システムであってもよい。
【発明の効果】
【００１２】
操舵角（操舵角速度）等をドライバの操作意図の推定に用いることで当該推定を正確に行い、これにより、車線追従制御装置とドライバとの協調を図ることができる。
また、車線追従制御と車線変更操作との干渉がなくなるので、車線変更意図のあるドライバに操舵中に違和感を感じさせることがない。
さらに、車線変更中には横滑り零化制御に切替えることで、急な車線変更に対して車両が安定して走行することが可能となる。
【発明を実施するための最良の形態】
【００１３】
本発明の車線追従制御および自動車は、典型的にはインホイールモータタイプの電気自動車に応用されるが、エンジン自動車のようなホイールシャフト駆動タイプの自動車にも適用できる。
【００１４】
本発明では、通常は、操舵される車輪と車線追従制御装置により制御される車輪とは異なっているが、同じであってもよい。たとえば、通常は、前輪が操舵される場合には後輪（駆動輪）が車線追従制御装置により制御されるが、全輪駆動の場合においては前輪は操舵されとともに車線追従制御装置により制御されるようにしてもよい。
【００１５】
図１は本発明の車線追従制御装置の一実施形態を示す機能ブロック図である。図１において、自動車５（ハンドル１０１，前輪１０２，後輪１０３を含む）に搭載された車線追従制御装置１は、ヨーレートγを制御情報のひとつとして車線追従制御を行うもので、運転モード判断部１１と、制御部１２と、車両運動制御部１３とを備えている。
【００１６】
運転モード判断部１１は、操舵角δ（操舵角速度を含む）または操舵角履歴（操舵角速度履歴を含む）から、現在、自動車５が車線追従モードＳ1下にあるのか、車線変更モードＳ3にあるのか、またはこれらのモードの一方から他方に遷移する途中の中間モード下Ｓ2にあるのかを判断することができる。この判断は、本実施形態では操舵角δまたは操舵角履歴に基づき行っているが、図１において点線ｎで示すように横偏差Δｙ（カメラ等により測定することができる）を参照して（操舵角または操舵角履歴に基づき判断に際して横偏差Δｙを参照して）行うことができる。なお、操舵角または操舵角履歴を用いることなく横偏差Δｙに基づき運転モードを判断することもできるが、この場合には運転モード判断の精度が低下するので、通常は横偏差Δｙのみに基づき運転モードを判断することは行わない。
【００１７】
制御部１２は、車線追従制御用ヨーレート生成手段１２１と車線変更制御用ヨーレート生成手段１２２と切替え手段１２３とを備えている。図１ではヨーレート生成やヨーレートの切り替えはソフトウェアで行っている。
車線追従制御用ヨーレート生成手段１２１は、運転モード判断部１１が、自動車５が車線追従モードＳ1下にあると判断したときは、車線追従制御用ヨーレートγδを生成する。
【００１８】
また、車線変更制御用ヨーレート生成手段１２２は、運転モード判断部１１が、自動車５が車線変更モードＳ3下にあると判断したときは車線変更制御用ヨーレートγcを生成する。
さらに、制御部１２は、運転モード判断部１１が、自動車５が中間モードＳ2下にあると判断した場合において、直前に車線追従制御用ヨーレートγδを生成してしているときは当該車線追従制御用ヨーレートγδを、直前に車線変更制御用ヨーレートγcを生成してしているときは当該車線変更制御用ヨーレートγcを生成する。
【００１９】
運転モード判断部１１は、前述したようにハンドル１０１から操舵角δを取得し、この操舵角δの履歴が所定条件に該当するか否かを検出し、当該操舵角δの履歴が車線変更操作によるものか否かを判断する（なお、この判断は前述したように図１において点線ｎで示すように横偏差Δｙを参照して行うことができる）。
たとえば、運転モード判断部１１は、操舵角δの時間変化を取得し、操舵角δの時間変化状態が所定条件に該当するか否かを判断する。典型的には、「操舵角δの時間変化状態」は、操舵角速度ｄδ／ｄｔであるが、これには限定されず、たとえばｄ2δ／ｄｔ2等を含むことができる。
これにより、ドライバの車線変更意図を推測することができる。
すなわち、運転モード判断部１１は、走行モードとして、（ａ）車線追従モードＳ1、（ｂ）中間モードＳ2および（ｃ）車線変更モードＳ3の３つを設定しており、現在どのモードにあるかの確率を可観測な出力シンボルηに基づき隠れマルコフモデルにより決定することができる。
この場合には、出力シンボルを、操舵角δおよび操舵角速度ｄδ／ｄｔにより決定することができる。
【００２０】
制御部１２は、運転モード判断部１１が、操舵角δの時間変化状態が車線変更操作によるものでないと判断したときは車線追従制御用のヨーレート（第１の目標ヨーレート）γc（ｔ）を生成し、操舵角δの時間変化が車線変更操作によるものであると判断したときは車線変更制御用のヨーレート（第２の目標ヨーレート）γδ（ｓ）を生成する。切替え手段１２３は、γc（ｔ）とγδ（ｓ）とをソフト的に切り替えて車両運動制御部１３に出力する。車両運動制御部１３は、第１の目標ヨーレートγc（ｔ）または第２の目標ヨーレートγδ（ｓ）を取得し、γc（ｔ）およびγδ（ｓ）を制御パラメータとするモーメント制御信号Ｍを生成し、後輪１０３に備えられたモータを制御する。
【００２１】
図２は、図１の車線追従制御装置１のより具体的なブロック図である。  第１の目標ヨーレートγc（ｔ）、第２の目標ヨーレートγδ（ｓ）を重み係数ｗで切り替える手法を採用している。図２の車線追従制御装置１では、車体横方向位置ｙ*の情報と実際の車体横方向位置ｙとの偏差が、ドライバ２１と車線追従制御手段２３１に送出される。そして、ドライバ２１のハンドル操作による操舵角δの情報（操舵角速度の情報を含む）に基づき、運転意図決定手段（図１の運転モード判断部１１に相当する）２２が車線変更を行う。この運転意図決定手段２２による判断に応じて車線追従制御手段２３１、または車線変更制御手段２３２による制御の何れか選択される。車線追従制御手段２３１、車線変更制御手段２３２の何れの手段による制御が行われるかは、確率（ｗ），確率（１−ｗ）により決まる。すなわち、車線追従制御手段２３１、車線変更制御手段２３２の出力の何れかを、運転意図決定手段２２により与えられる確率（符号２４１，２４２）に応じてセレクタ（図１の切替え手段１２３に相当）２５が選択する。セレクタ２５の選択に基づき、車両運運動制御部２６（図１の車両運運動制御部１３に相当）は、電気自動車２７（図１の後輪１０３のホイールに備えられたモータに相当）にモーメント制御信号Ｍを送出する。
【００２２】
以下、図２の車線追従制御装置１の作用を詳細に説明する。図２において、第１の目標ヨーレートγc（ｔ）は、車載カメラシステムを利用した前方横偏差零化のための目標ヨーレートであり、車体前方横偏差ｙsrを用いた二次予測式（１）により、リアルタイムで計算される。
γc（ｔ）＝−（２Ｖ／ｌc2）ｙsr・・・（１）
Ｖ：車体速度，ｌc：カメラの前方注視距離，ｙsr：前方横偏差
図２における第２の目標ヨーレートγδ（ｓ）は、車体横滑り角零化のための目標ヨーレートであり、一次遅れ式（２）により計算される。なお、本実施形態で用いている第２の目標ヨーレートγδ（ｓ）は、定常時の横滑り角を零化するものではない。
γδ（ｓ）＝〔ｋ／（τ0ｓ＋１）〕×δsw（ｓ）・・・（２）
δsw：操舵角，ｋ：ヨーレートゲイン，τ0：時定数，ｓ：ラプラス演算子，
ｋ：２ＣfＶ／〔ｍＶ2＋２（ｌfＣf−ｌrＣr）〕×（１／Ｎ），
τ0：ＩＶ／２（Ｃfｌf2＋Ｃrｌr2）
なお、ｍは車体重量、Ｉは車体の完成モーメント、Ｃf，Ｃrは前輪，後輪のコーナリングパワー、ｌf，ｌrは重心点から前輪，後輪までの長さ、Ｎはステアリングギア比である。式（１），（２）に示す目標ヨーレートに重み係数をかけて、式（３）に従い切り替える。
γd（ｔ）＝ｗ（ｔ）・γc（ｔ）＋〔１−ｗ（ｔ）〕×γδ（ｔ）・・・（３）
重み係数は、ドライバの運転行動により決定することとし、その認識手法については後述する。
【００２３】
また、実ヨーレートを目標ヨーレートに追従させるために、ヨーモーメントＭは車両ダイナミックスの逆モデルを考えることにより、式（４）から算出する。ただし、式（４）の第１項はプロパな制御系ではないので、τを時定数とした一次のローパスフィルタを付加している。
Ｍ（ｓ）＝〔ｓ2−（ａ11+ａ22）ｓ＋ａ11×ａ22−ａ12×ａ21〕
／〔（ｈ2ｓ+ａ21ｈ1−ａ11h2）（τｓ＋１）〕×γd(s)
−〔ｈ2ｓ+ａ211-ａ11ｈ2）／（ｂ2ｓ+ａ21ｂ1-ａ11ｂ2）〕×δf（ｓ）
・・・（４）
ａ11＝−２（Ｃf＋Ｃr）／ｍＶ，
ａ12＝−〔１＋（２Ｃfｌf−２Ｃrｌr）／ｍＶ2〕，
ａ21＝−２（Ｃfｌf−Ｃrｌr）／Ｉ，
ａ22＝−２（Ｃfｌf2＋Ｃrｌr2）／ＩＶ，
ｂ1＝０，ｂ2＝１／Ｉ，ｈ1＝２Ｃfｌf／ｍＶ，ｈ2＝２Ｃfｌf／Ｉ
δfは前輪実舵角であるが、直接計算できないため、ドライバ操舵角を利用し、式（５）より求める。
δf＝δsw／Ｎ・・・（５）
【００２４】
式（４）により決定したヨーモーメント入力を実現するため、本実施形態では対象とする後輪駆動方式の電気自動車の駆動力制御システムによりヨーモーメントを発生させている。左右輪それぞれの駆動力は直進走行時の駆動力Ｆx0から同じ駆動力指令値を増減したものとし、以下のように計算できる。
〔左輪の駆動力〕    Ｆxrl＝Ｆx0−Ｍ／ｄ・・・（６）
〔右輪の駆動力〕    Ｆxrr＝Ｆx0＋Ｍ／ｄ・・・（７）
ｄ：後輪のトレッド
上記の駆動力は、左右輪それぞれのインホイールモータトルクにより発生させる。モータの減速機構により伝達ロスや車輪のスリップを無視すれば、左右の駆動トルク指令値は式（８），式（９）のようになる。
〔左輪の駆動トルク〕    Ｔml＝Ｆxrl×ｒw・・・（８）
〔右輪の駆動トルク〕    Ｔmr＝Ｆxrr×ｒw・・・（９）
ｒw：タイヤの有効半径
ドライバの運転行動認識手段として、隠れマルコフモデルを用いた運転制御を説明する。
隠れマルコフモデルは時系列データに基づ確立モデルであり、一般的な行動認識手法である。
これを用いることで、ドライバの車線変更行動を認識することができる。
【００２５】
本例では、図３の状態遷移モデルを示すように、ドライバの運転状態として、Ｓ1：車線追従状態、Ｓ2：待機状態、Ｓ3：車線変更状態の３つのパターンを設置した。
これらのドライバの運転状態は観測可能な状態（可視状態）にないため、これらの運転状態を可視のシンボルηdに置き換えることで、現在の運転状態を推定することとする。
可視のシンボルηdはドライバの操舵角と操舵角速度により決定することとし、そのために、図４（Ａ），（Ｂ）に示すようなメンバシップ関数を設定し、これを用いて出力シンボルηdを決定する。
図４（Ａ），（Ｂ）のメンバシップ関数の閾値はδ1＝０．２５ｒａｄ，δ2＝０．５ｒａｄ，ｄδ1／ｄｔ＝１．０ｒａｄ／ｓｅｃ，ｄδ2／ｄｔ＝２．０ｒａｄ／ｓｅｃである。
このメンバシップ関数を用いることで、あるステップ時間ｔnにおいて、操舵角δ、操舵角速度ｄδ／ｄｔからそれぞれ３つの値μδl，μδ'm（ｌ，ｍ＝１，２，３、なお、δ’はδの微分係数である）を得ることができる。次に、これらの値を式（１０）に従い、９つの積Ｈk（ｋ＝１，２，・・・，９）を求める。最後に式（１１）に従い、９つの積Ｈkの値が最大のものの添え字を時間ｔnにおける出力シンボルμδ'mの値とする。
Ｈk（ｔn）＝μδl×μδ'm・・・（１０）
μd（ｔn）＝ａｒｇ  ｍａｘ[Ｈk（ｔn）] ・・・（１１）
時間により変化する各状態は遷移確率<ａy>（以下、明細書中では確率を三角括弧「<>」で示す）により変化し、出力シンボルは各状態から出力確率<ｂy>によって出力される。これらの確率は状態遷移確率行列《Ａy》（以下、明細書中では行列を二重三角括弧「《》」で示す）、出力確率行列《Ｂy》として、Ｂａｕｍ−Ｗｅｌｃｈのアルゴリズムを用いて学習させ、式（１２）のように各出力シンボルに対応する出力分布確率《Ｂd》を設定する。
《Ｂd》（ｙd（ｔn））[3×3]＝ｄｉａｇ{<ｂj>ｙd（ｔn）}・・・（１２）
【００２６】
以上に述べた隠れマルコフモデルから現在のドライバの運転行動を認識するための方法を以下に述べる。
まず、式（１３）のような行列ベクトルを定義する。
《Ｐ》n|n[3×1] ＝[Ｐn|n（１）  Ｐn|n（２）  Ｐn|n（３）]T・・・（１３）
ただし、Ｐn|n（ｉ）は現在のステップ時間ｔnにおけるドラバの運転状態がＳi（ｉ＝１，２，３）である確率であり、これらは以下に示す式（１４），（１５）に従い求めることができる。
《Ｐ》n|n-1[3×1]＝《Ａ》T[3×3]《Ｐ》n-1|n-1[3×1] ・・・（１４）
《Ｐ》n|n[3×1]＝《Ｂ》d（ｙd（ｔn））[3×3] 《Ｐ》n|n-1[3×1] ｝
／[１１１]《Ｂ》d（ｙd（ｔn））[3×3] 《Ｐ》n|n-1[3×1] ・・・（１５）
以上の手法により、求めた値から、式（１６），式（１７），式（１８）の規則に従い、ドライバの運転行動を決定する。認識結果を制御に適用するため、決定した運転行動をもとに前節で述べた切り替えシステムの重み係数をもとに前節で述べた切り替えシステムの重み係数を決定する。本実施形態では、車線変更行動であると認識されれば“０”、車線変更行動であると認識されなければ“１”を出力することとしている。
【００２７】
すなわち、
arg  max｛Ｐn|n（ｉ）｝＝１のときは、ｗ（ｔn）＝１・・・（１６）
arg  max｛Ｐn|n（ｉ）｝＝３のときは、ｗ（ｔn）＝０・・・（１７）
その他のときは、ｗ（ｔn）＝ｗ（ｔn-1）
以上に述べた隠れマルコフモデルを用いた運転行動認識システムの有効性の検証を行った。システムを実車に実装し、図５に示すシングルレーンチェンジの走行実験を行い、ドライバの操舵角入力、操舵角速度入力により、車線追従、車線変更の行動認識アルゴリズムが有効であるかを検証した。結果を図６に示す。図６において、（Ａ）はドライバの操舵角、（Ｂ）は操舵角速度、（Ｃ）は出力シンボル、（Ｄ）は行動認識出力を示す図である。
結果から、ドライバのハンドル操作後に行動認識出力が０になり、車線変更行動が認識されていることが確認できる。また、ドライバが車線変更を終え、ハンドル操作を終了した後は、行動認識出力が再び１への戻り、車線追従の運転意図を認識できていることからも、システムの有効性を確認できた。
【００２８】
運転行動認識に基づく支援効果をシミュレーションにより検討した。シミュレーションの条件は図７に示すように、車体速度３５ｋｍ／ｈで走行し、５秒後に幅２ｍの車線変更を１０ｍの間に行うものとした。なお、今回のシミュレーションでは、ＤＹＣ（Ｄｙｎａｍｉｃ  Ｙａｗｍｏｍｅｎｔ  Ｃｏｎｔｒｏｒｌ）入力の上限値を４００Ｎｍ、下限値を−４００Ｎｍとした。
シミュレーションの結果を図８，図９に示す。図８は切り替えシステムを適用せずに、車線追従制御のみで走行した場合の結果を示している。また、図９は本発明を適用した場合の結果を示す図である。
図８，図９において（Ａ）は前方横偏差を、（Ｂ）は操舵角を、（Ｃ）は重み係数およびＤＹＣ入力を、（Ｄ）は実ヨーレートおよび目標ヨーレートを、（Ｅ）は横滑り角をそれぞれ示すグラフである。
また、車線追従制御のみの車両軌跡を図１０に、行動認識システムを適用した制御の車両軌跡を図１１に示す。
図８から、目標ヨーレートの切り替えを行わず、車線追従制御のみで走行した場合、車線変更時に、ドライバの行動に反するヨーモーメントが働き、初期の車線変更において、大きな操舵角が必要となることが確認できる。それに対して、提案したシステムは、図９より、車線変更の行動認識が行われていることが確認できる。それにより、車線変更中は、横滑り角零化のために、操舵角に応じた目標ヨーレートに切り替わり、実ヨーレートが目標ヨーレートに追従し、その結果横滑り角が抑えられる。さらに、図１０、図１１により、車線追従制御のみで走行した場合の車両軌跡は目標コースからの偏差が大きいのに対し、本発明のシステムは追従性能が上がっていることがわかる。
【００２９】
隠れマルコフモデルを用いた運転行動認識システムを適用したヨーモーメント制御を実車ＮＯＶＥＬ−１に搭載し、シミュレーションと同様に図５のシングルレーンチェンジ走行実験を行い、運転行動の認識精度及び提案したＤＹＣの支援効果を、目標ヨーレートの切り替えを行わない車線追従制御のみで走行した場合と比較した。実験結果の時系列データを図１２，図１３に示す。図１２，図１３において（Ａ）は前方横偏差を、（Ｂ）は操舵角を、（Ｃ）は重み係数およびＤＹＣ入力を、（Ｄ）は後輪左右の駆動トルク，ヨーレートを、（Ｅ）は横滑り角をそれぞれ示すグラフである。
また、図１４はドライバの操舵角速度、図１５は車体横滑り角とドライバの操舵角によるリサージュ曲線である。図１５のリサージュ曲線は、操舵角‐横滑り角線図上の面積が小さいほど、安定性が優れることを意味する。
図１２により、目標ヨーレートの切り替えを行わない車線追従制御モードのみで走行した場合、車線変更中は元の車線に戻そうとするヨーモーメントが加わり、ドライバの操舵負担になっていることがわかる。
また、車線変更中には、図１３より、車線変更中に重み係数が０に切り替わり、横滑り角零化制御に切り替わることで、ドライバの操舵入力に比例した目標ヨーレートが算出される。また、車線変更終了後、重み係数は再び１に戻っていることから、運転行動認識が行われていることが確認できた。
図１４により、初期の車線変更において、本発明を適用したヨーモーメント制御は、操舵角速度が小さくなっており、緊急時において、ドライバの操舵角介入がしやすくなる。さらに、図１５から、横滑り角が操舵角とともに同時に低減されており、車両の操縦安定性が工場いていることが確認でき、運転行動認識に基づくヨーモーメント制御システムの有効性が実車実験により実証できた。
【００３０】
以上述べたように、本発明の車線追従制御装置１では、ヨーレートγを制御パラメータのひとつとして車線追従制御を行う機能を有し、（ａ）操舵角δを取得し当該操舵角の時間変化状態が所定条件に該当するか否かを検出し、当該操舵角δの時間変化状態が車線変更操作によるものか否かを判断する運転モード判断部１１と、（ｂ）運転モード判断部１１が操舵角の時間変化状態が車線変更操作によらないものと判断したときは車線追従制御用の目標ヨーレート（γc）を生成し、運転モード判断部１１が操舵角δの時間変化状態が車線変更操作によるものと判断したきは車線変更制御用の目標ヨーレート（γδ）を生成する制御部１２と、（ｃ）少なくとも制御部１２により取得した目標ヨーレートを制御パラメータとする車両制御信号Ｍを生成する車両運動制御部１３とを備える。これにより、車線追従制御装置作動中にドライバによる車線変更操作が行われる場合において、違和感を感じさせないように適切なタイミングで車線追従制御動作を解除し、かつ車線変更時における車両走行安定性を確保することができる。
【図面の簡単な説明】
【００３１】
【図１】本発明の車線追従制御装置の一実施形態を示す機能ブロック図である。
【図２】図１の車線追従制御装置のより具体的なブロック図である。
【図３】車線追従状態、待機状態、車線変更状態の３つのパターンを設置した。
【図４】（Ａ），（Ｂ）はメンバシップ関数を示す図である。
【図５】シングルレーンチェンジの走行実験を示す説明図である。
【図６】車線追従、車線変更の行動認識アルゴリズムが有効であるかを検証するための図であり、（Ａ）はドライバの操舵角、（Ｂ）は操舵角速度、（Ｃ）は出力シンボル、（Ｄ）は行動認識出力を示す図である。
【図７】運転行動認識に基づく支援効果を示すシミュレーションの条件を示す図である。
【図８】切り替えシステムを適用せずに、車線追従制御のみで走行した場合の結果を示す図であり、（Ａ）は前方横偏差を、（Ｂ）は操舵角を、（Ｃ）は重み係数およびＤＹＣ入力を、（Ｄ）は実ヨーレートおよび目標ヨーレートを、（Ｅ）は横滑り角をそれぞれ示すグラフである。
【図９】本発明を適用した場合の結果を示す図であり、（Ａ）は前方横偏差を、（Ｂ）は操舵角を、（Ｃ）は重み係数およびＤＹＣ入力を、（Ｄ）は実ヨーレートおよび目標ヨーレートを、（Ｅ）は横滑り角をそれぞれ示すグラフである。
【図１０】車線追従制御のみの車両軌跡を示す図である。
【図１１】本発明における行動認識システムを適用した制御の車両軌跡を示す図である。
【図１２】目標ヨーレートの切り替えを行わない車線追従制御モードのみで走行した場合の実験結果の時系列データを示す図であり、（Ａ）は前方横偏差を、（Ｂ）は操舵角を、（Ｃ）は重み係数およびＤＹＣ入力を、（Ｄ）は後輪左右の駆動トルク，ヨーレートを、（Ｅ）は横滑り角をそれぞれ示すグラフである。
【図１３】本発明による行動認識システムによる制御を行って走行した場合の実験結果の時系列データを示す図であり、（Ａ）は前方横偏差を、（Ｂ）は操舵角を、（Ｃ）は重み係数およびＤＹＣ入力を、（Ｄ）は後輪左右の駆動トルク，ヨーレートを、（Ｅ）は横滑り角をそれぞれ示すグラフである。
【図１４】ドライバの操舵角速度を示す図である。
【図１５】車体横滑り角とドライバの操舵角によるリサージュ曲線である。
【符号の説明】
【００３２】
１  車線追従制御装置
５  車両
１１  運転モード判断部
１２  制御部
１３  車両運動制御部
１４  偏差検出部
１０１  ハンドル
１０２  前輪
１０３  後輪
１２１  車線追従制御用ヨーレート生成手段
１２２  車線変更制御用ヨーレート生成手段
１２３  切替え手段
【図１】
2008044561.tif 000003
【図２】
2008044561.tif 000004
【図３】
2008044561.tif 000005
【図４】
2008044561.tif 000006
【図６】
2008044561.tif 000007
【図７】
2008044561.tif 000008
【図８】
2008044561.tif 000009
【図９】
2008044561.tif 000010
【図１０】
2008044561.tif 000011
【図１１】
2008044561.tif 000012
【図１２】
2008044561.tif 000013
【図１３】
2008044561.tif 000014
【図１４】
2008044561.tif 000015
【図１５】
2008044561.tif 000016
【図５】
2008044561.tif 000017