(57)【特許請求の範囲】
【請求項１】
車両の走行制御装置であって、前記車両の周囲環境情報に基づいて前記車両の各輪のタイヤ力の大きさが対応する車輪の摩擦円内に収まるよう設定される理想軌跡を生成する理想軌跡生成手段と、前記理想軌跡と前記車両の運転者の操作に基づいて前記車両の走行軌跡を制御する走行軌跡制御手段とを含み、前記走行軌跡制御手段が前記理想軌跡に対する前記車両の左右方向の位置を調節する第一のアクチュエータを制御する左右方向制御手段と前記理想軌跡に対する前記車両の前後方向の位置を調節する第二のアクチュエータを制御する前後方向制御手段とを含み、
前記左右方向制御手段が前記第一のアクチュエータに与える第一の制御量が、前記車両の左右方向に於いて前記車両の走行軌跡を前記理想軌跡に一致させるように前記理想軌跡に基づいて決定される前記第一のアクチュエータの自律走行制御量と前記運転者の前記第一のアクチュエータに対する操作量とに基づいて決定され、前記前後方向制御手段が前記第二のアクチュエータに与える第二の制御量が、前記車両の前後方向に於いて前記車両の走行軌跡を前記理想軌跡に一致させるよう前記理想軌跡に基づいて決定される前記第二のアクチュエータの自律走行制御量と前記運転者の前記第二のアクチュエータに対する操作量とに基づいて決定され、前記第一の制御量に於ける自律走行制御量と操作量とのそれぞれの寄与の割合と前記第二の制御量に於ける自律走行制御量と操作量とのそれぞれの寄与の割合とが独立して決定されることを特徴とする装置。
【請求項２】
請求項１の装置であって、前記第一のアクチュエータの自律走行制御量が前記理想軌跡より与えられる旋回曲率に基づいて決定され、前記第二のアクチュエータの自律走行制御量が前記理想軌跡より与えられる加減速度に基づいて決定されることを特徴とする装置。
【請求項３】
請求項１又は２の装置であって、前記運転者の希望する走行モードを受容する手段を含み、前記理想軌跡に対する前記車両の左右方向の位置に基づいて決定される前記第一のアクチュエータの制御量と前記運転者の前記第一のアクチュエータに対する操作量とを前記走行モードに応じて決定される第一の割合にて足し合わせることにより前記第一の制御量が決定され、前記理想軌跡に対する前記車両の前後方向の走行状態に基づいて決定される前記第二のアクチュエータの制御量と前記運転者の前記第二のアクチュエータに対する操作量とを前記走行モードに応じて決定される第二の割合にて足し合わせることにより前記第二の制御量が決定されることを特徴とする装置。
【請求項４】
請求項１乃至３のいずれかの装置であって、前記運転者の前記第一のアクチュエータに対する操作が前記車両の舵角の操作を含み、前記運転者の前記第二のアクチュエータに対する操作が前記車両の制駆動の操作を含むことを特徴とする装置。
【請求項５】
請求項１乃至４の装置であって、前記第一及び第二の制御量が、前記車両の各輪のタイヤ力の大きさが対応する車輪の摩擦円内に収まるよう修正されることを特徴とする装置。
【請求項６】
請求項１の装置であって、前記車両の周囲環境情報が道路線形、路面の摩擦係数又は障害物の位置を含むことを特徴とする装置。
【請求項７】
請求項１の装置であって、前記理想軌跡が前記車両の各輪のタイヤ力の摩擦円の使用率に基づいて決定されることを特徴とする装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、自動車等の車両の走行制御に係り、より詳細には、車両の運転者の運転支援を行うべく車両の走行・運動状態を自動的に又は自律的に制御する走行制御装置に係る。
【背景技術】
【０００２】
近年、自動車等の車両の知能化技術、情報化技術の進歩により、車両の運転・走行を支援する車両の制御技術は、従前に比して高度に発展し、車両の運転者の操縦負担は軽減され、車両の安全性が向上されている。例えば、車載レーダー、車車間通信技術等を用いて、自車の進行方向に存在する先行車両や障害物を自動的に発見し、それらを適切に回避し又は適正な車間距離を維持するよう運転者に警告を発し或いは自車の走行・運動を制御する技術（ＡＣＣ。例えば、特許文献１、２参照）や、車両のフロントガラス上部に備えられたビデオカメラを用いて車両の走行路面上の左右の白線を認識し、車両が車線を逸脱しそうになると、運転者に対し警告を発し（例えば、警告音、警告灯、操舵トルクの増大など）、或いは、自動操舵を実行して、車両が車線内にて走行するよう制御する技術（ＬＫＡ。例えば、特許文献３参照）などが提案されている。また、ＧＰＳ（Global  Positioning  System）によるカーナビゲーションシステムを用いることにより、自車両の現在位置の情報や周辺の道路状況に関する情報を取得し、それらの情報と運転者の長期希望（目的地、到着時刻など）とを参照して車両の走行制御を計画的に実行する技術（例えば、本願出願人による特願２００６−３１３２５８）、或いは、自車両の現在位置の情報や周辺の道路状況に関する情報に基づいて検知される障害物に対する数秒後の接触確率と自車両のタイヤ摩擦円の利用率とが最小化されるように車両の走行挙動を制御する技術（特許文献４）などが提案されている。
【０００３】
上記の如き車両の知能化技術、情報化技術を利用した車両の運転支援制御のいくつかに於いては、自車両の現在位置の情報や周辺の道路状況に関する情報、特に車両の進行方向の情報、例えば、道路線形、路面摩擦状態など（しばしば、「プレビュー情報」と称される。）に基づいて、将来の或る目標地点までの走行経路での車両の走行限界を考慮しつつ、将来の予定走行経路（理想軌跡又は将来軌跡）を設定し、車両がその経路に沿って走行するように、車両の走行を自律的に制御することが可能となっている。そのような車両の自律走行を達成する走行制御が実行されるときには、運転者が操縦を行わなくても、車両は、安全に且つ安定的に理想軌跡（概念的に述べれば、タイヤがそれぞれの摩擦円内で運動しタイヤがスリップせずに、更には、障害物等への衝突も回避されるよう設定される軌跡）を走行することが期待される。しかしながら、そのままでは、運転者の操縦意図が車両の挙動に全く反映されないことになりかねない。そこで、自律走行制御（「自律運転制御」とも称される。）の実行中に於いて運転者による操縦があったときには、自律走行制御と運転者による操縦との間で両者を協調させる制御（「自律運転とヒトとの協調制御」）の開発が試みられている。
【特許文献１】特開２００３−３４１５０１
【特許文献２】特開２００５−１００３３６
【特許文献３】特開２００２−６７９９８
【特許文献４】特開２００７−９９１６６
【非特許文献１】「自動車の運動と制御」安部正人著、平成１３年４月１５日  第４刷、山海堂、１８５頁
【発明の開示】
【発明が解決しようとする課題】
【０００４】
車両が走行している間に車両の走行制御が自動的に働く際に、即ち、運転者の車両の操縦に対して何らかの制御装置による制御が介入する際に、一般に、運転者は、車両の前後方向の挙動・位置を変化させる制御の介入があっても然程に違和感を覚えないが、車両の左右方向の挙動・位置を変化させる制御の介入があると、違和感を覚えやすいことが知られている。これは、車両の操縦の際、運転者は、車両の前後方向については、主として、周辺の車両との相対的な位置関係に着目する一方、車両の左右方向については、車両の絶対的な位置に着目するためであると考えられる。しかしながら、これまでの「自律運転とヒトとの協調制御」に於いては、上記の如く車両の前後方向と左右方向とで制御の介入に対する運転者の違和感の感じ方が異なるにもかかわらず、運転者の車両の運転制御に対する制御装置による制御の介入の大きさは、前後方向及び左右方向の双方で運転者の感じる違和感が問題とならないように、一括的に低減されることが多い。その場合、結局、制御装置による制御の介入の大きさ、つまり、制御装置による制御量の大きさは、違和感の感じやすい車両の左右方向に於いて運転者の違和感が問題とならないように調整されることとなるが、そうすると、車両の走行軌跡が理想軌跡から逸脱されやすくなってしまう。
【０００５】
そこで、本発明では、車両を理想軌跡に沿って自律的に運転する走行制御と運転者による操縦との協調制御を実行する制御システムに於いて、自律的走行制御による制御量を車両の前後方向の挙動・位置を調整する成分と左右方向の挙動・位置を調整する成分とに分割し、それぞれの成分の運転者の操縦に対する介入の大きさを別々に又は独立に制御する構成が提案される。このように、自律的走行制御による制御量に於ける車両の前後方向と左右方向の成分を切り離すことにより、車両の左右方向について自律走行制御の介入による運転者の違和感を低減しつつ、車両の前後方向について車両の走行を、できるだけ或いは少しでも、理想軌跡に沿った最適な状態に近づけられることが期待される。
【０００６】
かくして、本発明の一つの課題は、車両の運転支援を実現する車両の走行制御装置による自律運転とヒトとの協調制御システムであって、運転者の車両の運転制御に対する制御装置による制御の介入の大きさを車両全体で一括的に調整するのではなく、制御装置による制御の介入の大きさを車両の前後方向と左右方向で別々の程度にて調節できるようになったシステムを提供することである。
【０００７】
また、本発明の一つの課題は、上記の如き車両の運転支援システムであって、運転者の違和感に配慮し又はそれを低減しつつ、車両の走行軌跡・挙動状態をできるだけ理想軌跡に沿った安定的な状態に近づけられるよう構成されたシステムを提供することである。
【課題を解決するための手段】
【０００８】
本発明の車両の運転支援を実行する車両の走行制御装置は、車両の周囲環境情報に基づいて車両の理想軌跡を生成する理想軌跡生成手段と、理想軌跡と車両の運転者の操作に基づいて車両の走行軌跡を制御する走行軌跡制御手段とを含み、走行軌跡制御手段が理想軌跡に対する車両の左右方向の位置を調節する第一のアクチュエータを制御する左右方向制御手段と理想軌跡に対する車両の前後方向の位置を調節する第二のアクチュエータを制御する前後方向制御手段とを含み、左右方向制御手段が第一のアクチュエータに与える第一の制御量と前後方向制御手段が第二のアクチュエータに与える第二の制御量とが互いに独立に決定されることを特徴とする。
【０００９】
かかる構成に於いて、車両の理想軌跡を生成する理想軌跡生成手段とは、任意の車両の周囲環境情報、例えば、カーナビゲーション情報、路車間通信、車車間通信、レーダー装置、ビデオカメラ装置等によって得られる情報（又は更に運転者による入力）から得られる道路線形、路面の摩擦係数、障害物の位置などを含む情報に基づいて、任意の形式にて車両の将来の走行軌跡（以下、「理想軌跡」と称する。）を決定又は生成する手段であってよい（例えば、上記の特願２００６−３１３２５８に記載のシステムであってもよいが、これに限定されない。）。理想軌跡は、好適には、車両が安全且つ安定的に走行できるように、車両の各輪のタイヤ力の摩擦円の使用率に基づいて、タイヤがそれぞれの摩擦円内で運動しタイヤがスリップせずに、更には、障害物等への衝突も回避されるよう設定又は決定された軌跡であり、例えば、車両の発進後の任意の時刻以降（将来）に於いて、車両が辿るべき座標値、車速値、ヨーレート、ヨー角などの車両の状態量の値により与えられる（なお、本発明の趣旨は、理想軌跡が与えられた後の制御の構成であり、理想軌跡自体は、如何なる手法にて設定されるかは問わない。）。
【００１０】
また、上記の構成に於いて、車両の左右方向の位置を調節する第一のアクチュエータは、典型的には、前輪又は後輪の舵角を制御する操舵装置であってよく、車両の前後方向の位置を調節する第二のアクチュエータは、車両の駆動装置及び／又は制動装置であってよい。従って、運転者の第一のアクチュエータに対する操作が車両の舵角の操作を含み、運転者の第二のアクチュエータに対する操作が車両の制駆動の操作を含むようになっていてよい。しかしながら、例えば、タイヤの制駆動力の左右差により、車両にヨーモーメントや横力を発生させることができるので、第一のアクチュエータの一部として、車両の制動装置又は駆動装置（の一部の構成）が含まれていてもよい。また、逆に、車輪の舵角を制御することにより、車両の前後方向の制駆動力を調整することも可能なので、第二のアクチュエータの一部として、車両の操舵装置（の一部の構成）が含まれていてもよい。
【００１１】
上記の本発明の構成によれば、走行軌跡制御手段が理想軌跡と車両の運転者の操作に基づいて車両の走行軌跡を制御するところ、かかる走行軌跡制御手段に於いては、第一のアクチュエータを制御する左右方向制御手段と、第二のアクチュエータを制御する前後方向制御手段とが設けられ、左右方向制御手段が第一のアクチュエータに与える第一の制御量と前後方向制御手段が前記第二のアクチュエータに与える第二の制御量とが互いに独立に決定されることとなる。即ち、車両の走行軌跡の制御に於いて、車両の前後方向の制御と左右方向の制御とが、互いに切り離されて実行されることとなる。かかる態様によれば、車両の前後方向の制御と左右方向の制御のそれぞれの制御の寄与、即ち、理想軌跡に基づいて車両を走行させる制御の運転者の操縦に対する介入の程度が独立に調節できることとなる。従って、車両の前後方向と左右方向との制御の介入に対する運転者の違和感の感じ方に差異があっても、それぞれの方向に適合するように、典型的には、左右方向の制御の介入の大きさを低減しつつ、前後方向の制御の介入の大きさを大きくするといった制御態様が可能となる。そして、かかる制御態様によって、車両の前後方向と左右方向のうち、いずれかの一方の方向の理想軌跡に基づく制御の大きさが低減される状況に於いても、他方の方向については、車両の位置を理想軌跡に一致させる又は近づけられることとなる。
【００１２】
上記の本発明の車両の前後方向の制御と左右方向の制御を切り離す構成に於いて、一つの態様として、第一の制御量が車両の走行軌跡を理想軌跡に一致させるよう決定される第一のアクチュエータの制御量（以下、「自律走行制御量」と称する。）と運転者の第一のアクチュエータに対する操作量とに基づいて決定され、第二の制御量が車両の走行軌跡を理想軌跡に一致させるよう決定される第二のアクチュエータの自律走行制御量と運転者の第二のアクチュエータに対する操作量とに基づいて決定されるようになっていてよい。かかる態様によれば、車両の走行状態をその前後方向及び左右方向について調節するそれぞれの運転者の操作量と自律走行制御量の大きさとに基づく最終的な各方向のアクチュエータの制御量が独立して決定されることになり、従って、車両の前後方向及び左右方向のそれぞれに於いて、運転者の操作量と自律走行制御量の大きさとのバランスを適宜調整するといったことが可能となる。
【００１３】
上記の態様を達成する一つの形態としては、本発明の装置に於いて、更に運転者の希望する走行モードを受容する手段が設けられ、理想軌跡に対する車両の左右方向の位置、ヨーレート、スリップ角、旋回曲率等に基づいて決定される第一のアクチュエータの自律走行制御量と運転者の第一のアクチュエータに対する操作量とを前記の走行モードに応じて決定される第一の割合にて足し合わせることにより、第一の制御量が決定され、理想軌跡に対する車両の前後方向の走行状態、例えば、位置、車速、加減速度、制駆動力、制駆動トルク、に基づいて決定される第二のアクチュエータの自律走行制御量と運転者の第二のアクチュエータに対する操作量とを前記の走行モードに応じて決定される第二の割合にて足し合わせることにより第二の制御量が決定されるようになっていてよい。走行モードを受容する手段は、運転者の如何に車両を走行させたいかという要求を受け付ける手段であり、上記の構成に於いては、運転者の要求するモードに応じて、車両の前後方向と左右方向とで、運転者の操作量と自律走行制御量の大きさとのバランス（割合）を別々に設定することとなる。かかる構成によれば、例えば、燃費を重視する走行モードが選択されれば、前後方向についての最終的にアクチュエータに与える制御量（第二の制御量）に於いて、自律走行制御量の割合を大きくする（運転者の第一のアクチュエータに対する操作量の寄与が低減される。）といったことや、或いは、車両を緩やかに（運転者の違和感が大きくならないように）走行させる走行モードが選択されれば、左右方向についての最終的にアクチュエータに与える制御量（第一の制御量）に於いて、自律走行制御量の割合を小さくするといったことが可能となる。
【００１４】
なお、既に述べた如く、理想軌跡は、好適には、タイヤがそれぞれの摩擦円内で運動しタイヤがスリップせずに車両が安全に且つ安定的に走行するよう決定される軌跡であるところ、運転者の操作が自律的走行制御に介入することで、タイヤがスリップ状態となることは回避されることが好ましい。そこで、上記の構成に於いて、更に、第一及び第二の制御量が、前記車両の各輪のタイヤ力の大きさが対応する車輪の摩擦円内に収まるよう修正されるようして、車両が安全に且つ安定的に走行する状態が維持されるようになっていてよい。例えば、各輪のタイヤ力が車輪の摩擦円を超えるときには、前記の第一及び第二の割合がそれぞれ自律走行制御量の寄与を大きくする方向に変更されるようになっていてよい。
【発明の効果】
【００１５】
車両の運転支援を実行する制御の一つである自律的な走行制御は、原理的には、運転者の車両の操縦によらず達成されるよう構成されるが、実車に於いて、運転者が操縦を行うことなく車両を走行させる構成は、現実的でない。そこで、自律的な走行制御装置を搭載した車両に於いても、運転者の操縦通りに車両を走行させる構成が必須となる。しかしながら、その場合には、運転者の操縦と自律的な走行制御とが互いに干渉し得ることととなり、運転者の側からすれば、自律的な走行制御の実行により、運転者自身の操縦に対して介入を受け、違和感を感じることとなる。従って、実車に於いては、運転者がそのような違和感を感じないように配慮する必要があるが、そのために自律的な走行制御の寄与を低減すると、折角の運転支援効果が低減される。即ち、車両の運転支援と運転者の違和感低減は、相反する要求であるということができる。
【００１６】
本発明に於いては、上記の如き相反する要求に対して、「自律的走行制御装置による運転者の操縦への制御介入」に対する運転者の違和感の感じ方に車両の前後方向と左右方向とで差異が有り得ることに着目し、車両の前後方向と左右方向の挙動・位置を調節する自律的走行制御装置による制御の大きさをそれぞれ別々に調整することによって、できるだけ、前記の制御介入による運転者の違和感の低減を図ると同時に、車両の走行軌跡を理想軌跡に近づけることが可能となることが期待される。かかる新規な「自律運転とヒトとの協調制御」によれば、自律運転制御又は自律走行制御が適用される車両の範囲が更に拡大されることが期待される。
【００１７】
本発明のその他の目的及び利点は、以下に於いて、部分的に明らかになり、指摘される。
【発明を実施するための最良の形態】
【００１８】
車両の構成
図１は、本発明による車両の走行制御装置の好ましい実施形態が組み込まれた車両の構成を模式的に示している。同図を参照して、左右前輪１２ＦＬ、１２ＦＲと、左右後輪１２ＲＬ、１２ＲＲを有する車両１０には、運転者によるアクセルペダル１４の踏込みに応じて各輪（図示の例では、後輪駆動車であるから、後輪のみ）に制駆動力を発生する動力装置２０と、操舵装置３０と、各輪に制動力を発生する制動装置４０とが搭載される。駆動装置又は動力装置２０は、図示の例では、エンジン２２からトルクコンバータ２４、自動変速機２６、差動歯車装置２８等を介して出力される回転制駆動力が後輪１２ＲＬ、１２ＲＲへ伝達されるよう構成されている（エンジン２２に代えて電動機が用いられる電気式、或いは、エンジンと電動機との双方を有するハイブリッド式の駆動系装置であってもよい。）。駆動装置２０の発生する制駆動力は、本発明の走行制御の実行時には、後述の電子制御装置６０により適宜調節される。
【００１９】
操舵装置３０は、運転者によって作動されるステアリングホイール（ハンドル）３２の回転に応答してタイロッド３４Ｌ、Ｒを介して前輪１２ＦＬ、１２ＦＲを転舵する。かかる操舵装置３０は、好ましくは、運転者の操舵とは独立に前輪の舵角を変えることができる「アクティブ操舵装置」であり、ステアリングシャフトの途中に転舵角可変装置３６が設けられる。転舵角可変装置３６は、内部に駆動用電動機を含み、該電動機は、後述の電子制御装置６０の制御下、前輪舵角δｗを、ステアリングホイール３２の回転によらず、転舵できるよう構成されている。ステアリングホイールの操舵角δｈ及び車輪舵角δｗは、それぞれ、舵角センサ３２ａ、３６ａにより検出される。なお、図示していないが、後輪にも同様の電子制御装置６０の制御下、後輪を転舵する後輪操舵装置が設けられていてもよい。
【００２０】
制動装置４０は、各車輪の制動力を個別に発生することのできる油圧式制動装置であり、オイルリザーバ、オイルポンプ、種々の弁等（図示せず）、各輪に装備をされたホイールシリンダ４２ＦＬ、４２ＦＲ、４２ＲＬ、４２ＲＲ、及び、運転者によりブレーキペダル４４の踏込みに応答して作動されるマスタシリンダ４６を含む油圧回路４８を有し、各ホイールシリンダ内のブレーキ圧、即ち、各輪に於ける制動力は、通常は、マスタシリンダ圧力に応答して油圧回路４８によって調節されるところ、何らかの走行制御の実行時に於いては、電子制御装置６０の制御下、加減速制御又はＶＳＣ若しくはその他のヨーモーメント生成を行う制御に応じて一斉又は個別に制御されるようになっている。また、ブレーキ圧を制御するために、圧力センサ（図示せず）が、それぞれ、マスタシリンダ圧力、ホイールシリンダ４２ＦＬ−４２ＲＲの各圧力を検出するために設けられている。なお、制動装置は、各車輪の制動力を個別に調節できるものであれば、任意の形式（例えば、電磁式など）のものであってよい。
【００２１】
エンジンの駆動出力、各輪のブレーキ圧、即ち、制動力、車輪舵角を制御する電子制御装置６０は、通常の形式の、双方向コモン・バスにより相互に連結されたＣＰＵ、ＲＯＭ、ＲＡＭ及び入出力ポート装置を有するマイクロコンピュータ及び駆動回路を含んでいてよい。制御装置６０へは、本発明の制御を実施するために、アクセルペダルセンサ（図示せず）からのアクセルペダル踏込量θａ、ブレーキペダルセンサ（図示せず）からのブレーキペダル踏込量θｂ、ステアリングホイール（ハンドル）舵角δｈ、各輪の備えられた車輪速センサ（図示せず）からの車輪速Ｖｗｉ、各輪のホイールシリンダ４２ＦＬ−４２ＲＲ内の圧力Ｐｂｉ（ｉ＝ＦＬ、ＦＲ、ＲＬ、ＲＲ）、前輪舵角δｗ、前後加速度センサ６４により検出される前後加速度Ｇｘ、横方向加速度センサ６６により検出される横加速度Ｇｙ、ヨーレートセンサ６８により検出されるヨーレートγ、エンジン回転数・吸入空気量等のエンジン動作情報Ｅｒ等が入力される。
【００２２】
また、図示の車両に於いては、車両の周辺環境情報を取得する手段として、車両の前方の障害物・先行車両、レーン形状等を認識するための検出器（ビデオカメラ、レーダー装置）７０と、ＧＰＳ人工衛星データを受信して種々の情報を取得するカーナビゲーションシステム７２が設けられている。ビデオカメラ又はレーダー装置７０の検出データは、電子制御装置６０内のデータ解析装置ＩＰ（画像処理装置等）へ送信され、任意の公知の手法にて車両前方の障害物の有無とその位置（自車両からの相対距離・相対速度と方向）や、走行路面の形状に関する情報を生成するために用いられる。一方、カーナビゲーションシステムは、自車両の位置（緯度、経度）・車体の向き、走行路の道路線形等のデータを生成し、それらの情報を電子制御装置６０へ送信する。更に、電子制御装置６０の内部に於いて、公知の任意の方式により（好ましくは各輪の）路面摩擦係数μを推定する装置が組み込まれ、路面摩擦係数μが本発明の制御に於いて適宜利用される。その他、電子制御装置６０には、任意に、制御に必要なパラメータが各種センサにより検出され入力されてよい。なお、上記の電子制御装置へ入力される車両の周囲環境情報（自車の現在位置、道路線形、路面摩擦係数、障害物の有無及び位置など）は、周囲の他車と通信して情報交換を行う車車間通信システム又は道路インフラと通信して情報交換を行う路車間通信システムを通じて取得されるようになっていてもよい。
【００２３】
本発明の制御の概要
本実施形態の車両の走行制御の全体に於いては、基本的には、上記の如き自車の現在位置、道路線形、路面摩擦係数、障害物の有無及び位置などの車両の周囲環境情報を用いて、車両の「理想軌跡」が設定され、車両の操舵装置（第一のアクチュエータ）と制駆動装置（第二のアクチュエータ）は、車両が「理想軌跡」に沿って走行するよう自動的に制御される（自律走行制御）。ここで「理想軌跡」とは、車両が道路線形に沿って或いは障害物を回避しつつ安全に且つ安定的に走行できるよう任意の形式によって決定され走行軌跡である。具体的には、図５に模式的に例示されている如く、理想軌跡に於いて、軌跡（丸点列の各点）の座標値［ＸＧＰＳ＊，ＹＧＰＳ＊］（ＧＰＳ座標等であってよいが、これに限定されない。）と、それらの座標値の各々に於ける車速値Ｖｓｘ＊、ヨーレート値γ＊、スリップ角値β＊が、いわば、表形式のテーブルの如く、与えられる（以下、「理想軌跡」と言う場合には、特に断らない限り、座標値、車速値、ヨーレート値及びスリップ角値から成る数値の組を指す。「＊」は、理想軌跡の値であることを示す。）。そして、操舵装置と制駆動装置とは、車両が理想軌跡を達成するように制御される。
【００２４】
しかしながら、実車に於いては、車両は、運転者により操縦できるようになっていなければならない。そうなると、運転者の操作（ハンドルの回転、アクセル・ブレーキペダルの踏込み）があったときには、その運転者の操作に基づく制御と上記自律走行制御とが互いに干渉することとなる。そこで、二つの制御の干渉を調停するべく、既に触れた如く、「自律運転とヒトとの協調制御」が準備される。本発明の対象は、「理想軌跡」にて与えられている座標値、車速値、ヨーレート値及びスリップ角値を実現するよう走行している車両に於いて、運転者の操作があったときにその操作と理想軌跡に基づく自律走行制御とを調停するための自律運転とヒトとの協調制御にあり、本発明の装置の於いては、「理想軌跡」に基づいてアクチュエータの制御量を決定する際に、車両の前後方向の位置・走行状態を調節するアクチュエータと、車両の左右方向の位置・走行状態を調節するアクチュエータとを別々に制御し、即ち、車両の左右方向と前後方向の制御を互いに切り離して制御し、より好適には、運転者の操作による制御と自律走行制御との寄与の割合が車両の左右方向と前後方向とで別々に設定されるよう構成される。そして、かかる構成により、運転者の、自身の操作への自律走行制御の介入に対する違和感をできるだけ低減しつつ、車両をできるだけ理想軌跡に沿う又は理想軌跡を達成する態様にて走行させることが試みられる。
【００２５】
制御の構成と作動
図２及び図３は、本発明の走行制御装置を組み込んだ電子制御装置６０の好ましい実施形態の構成の概略を制御ブロック図の形式で表したものである。図中、符号６０a〜ｍ、８０ａ〜ｂが付されているブロック及び加算器、乗算器は、電子制御装置６０の内部構成及びその内部の記憶装置に記憶されたプログラムに従った演算処理作動により実現される。なお、同図に於いて、信号の流れについては、簡単のため、主要な信号の流れのみが記載されている。
【００２６】
［運転者操作による制御のための構成］
まず、図２を参照して、電子制御装置６０の好ましい実施形態は、通常の走行制御装置と同様に、アクセル踏込量θａとブレーキ踏込量θｂとに基づいて運転者の要求加減速度αｔを決定する加減速度制御指令決定部６０ａと、ハンドル操舵角δｈに基づいて車輪の目標転舵角δｗｔを決定する車輪舵角制御指令決定部６０ｂと含み、理想軌跡が生成されないときには（周知環境情報が取得できないときや運転者が自律走行制御を望まないとき）、通常の走行制御装置と同様に、要求加減速度αｔと目標転舵角δｗｔとが、制駆動力制御指令部６０ｃを介して駆動制御装置６０ｄ及び／又は制動制御装置６０ｅと、操舵制御装置６０ｆとへそれぞれ直接送られ、これらの目標値に基づいて、駆動装置、制動装置、操舵装置がそれぞれ制御される。
【００２７】
［自律走行制御のための構成］
更に、電子制御装置６０には、車両の自律走行を達成するために、理想軌跡生成部６０ｇが設けられ、これにより、ＧＰＳ情報（又は車車間通信情報）を含む周辺環境情報に基づいて、理想軌跡（座標値［ＸＧＰＳ＊，ＹＧＰＳ＊］、車速値Ｖｓｘ＊、ヨーレート値γ＊及び車体スリップ角値β＊）が設定される。理想軌跡生成部６０ｇは、走行モード決定部６０ｈからのモード情報により運転者により自律走行を指示する走行モードが選択されたことを受信すると、任意の形式にて、前記の図５に例示されている如き理想軌跡の各値を設定する（理想軌跡生成（例えば、特願２００６−３１３２５８参照））。なお、理想軌跡生成は、更に、運転者のハンドル又はペダル操作に応答して、例えば、要求加減速度αｔ、目標転舵角δｗｔの所定の変化に応答して開始されるようになっていてよい。理解されるべきことは、ここで、設定される理想軌跡の各値は、車両が道路線形に沿って、好適には、安全且つ安定的に走行するよう決定されるという点である。従って、車両が理想軌跡で設定される走行状態（車速、ヨーレート、スリップ角等）に追従して走行する場合には、各輪のタイヤ力がそれぞれ対応する最大摩擦円の十分に内側にある状態が達成され且つ維持されることとなる。
【００２８】
更に、理想軌跡生成部６０ｇに於いては、後に説明される制御処理に用いられる加減速度Ｇｓｘ＊及び旋回曲率１／ρ＊が各座標値に対応して決定されるようになっていてよい。加減速度Ｇｓｘ＊は、理想軌跡上の隣接する２点間の座標値と車速値Ｖｓｘ＊とを用いて、
Ｇｓｘ＊(n)＝（Vsx＊(n)２−Vsx＊(n-1)２）/2(ΔXGPS*2+ΔYGPS*2)1/2  …（１）
（ここで、ΔXGPS*＝XGPS*(n)−XGPS*(n-1)；ΔYGPS*＝YGPS*(n)−YGPS*(n-1)）
により与えられる。（ｎ）は、座標点を表す符号である。一方、曲率１／ρ＊は、
１／ρ＊＝ｃｏｓΨ＊・ｄΨ＊／ｄＸＧＰＳ      …（２）
ここで、ｃｏｓΨ＊＝(1+(dYGPS＊/dXGPS)２)-1/2
dΨ＊/dXGPS＝（d2YGPS＊／dXGPS2）・（1+(dYGPS＊/dXGPS)2）
により与えられる（dYGPS＊/dXGPSは、最近理想点（後述）の近傍の軌跡点ＹＧＰＳ＊のＸＧＰＳ方向の変化率であり、d2YGPS＊／dXGPS2は、更にdYGPS＊/dXGPSのＸＧＰＳ方向の変化率である。）。
【００２９】
かくして、上記の如く設定された理想軌跡の各値は、自律走行制御が実行される際には、現在の車両の位置を理想軌跡に一致させるように作動される車両のアクチュエータ、即ち、操舵装置、駆動装置、制動装置のための制御量（自律走行制御量）の決定に用いられる。なお、現在の車両の位置を理想軌跡に一致させる際の目標となる具体的な値は、ＧＰＳ装置から取得された車両の現在の位置［ＸａＧＰＳ，ＹａＧＰＳ］に最も近い理想軌跡点（最近理想点）であってよい。車両の現在の位置に最も近い理想軌跡点は、任意のアルゴリズムで決定されてよい。例えば、車速ベクトルＶｓｘと垂直方向の直線を決定し、その直線に最も近い理想軌跡上の点が最近理想点として選択されてよい（図５の右の四角枠内参照）。或いは、理想軌跡上の全点又は現在位置から所定の範囲の点のうち、車両の現在位置との間で最短距離を与える点が最近理想点として選択されてよい。更に、現在の車両の位置を理想軌跡に一致させる際の目標となる具体的な値は、自律走行開始時からの車両の走行距離ｓを変数パラメータとして、現在の車両の走行距離ｓに一致する距離ｓを有する理想軌跡上の点の値であってもよい。
【００３０】
更に、上記の自律走行制御量の決定に於いては、既に触れた通り、運転者の操作と自律走行制御との調停が、車両の左右方向の位置を調整するアクチュエータへの制御量（第一の制御量）と車両の前後方向の位置を調整するアクチュエータへの制御量（第二の制御量）とで別々に行われることとなる。そのために、自律走行制御量は、車両の左右方向の位置を調整するアクチュエータへの制御量と車両の前後方向の位置を調整するアクチュエータへの制御量とが別々に調製される。具体的には、図２に例示されている如く、車両の左右方向については、アクチュエータとして、例えば、操舵装置が選択され、自律制御（左右方向）目標舵角算出部６０ｉに於いて第一の制御量として目標舵角δｗｔ＊が決定され、車両の前後方向については、アクチュエータとして、例えば、駆動装置及び／又は制動装置が選択され、自律制御（前後方向）目標加減速度算出部６０ｊに於いて目標加減速度αｔ＊が決定される。
【００３１】
図３（Ａ）及び（Ｂ）は、それぞれ、上記の自律走行制御のための目標舵角δｗｔ＊及び目標加減速度αｔ＊を決定する自律制御のための目標値の算出部６０ｉ、６０ｊの内部の制御構成をブロック図の形式で示したものである。
【００３２】
まず、図３（Ａ）を参照して、自律制御（左右方向）目標舵角算出部６０ｉに於いては、自律目標舵角算出部８０ａにて、現在の実車速Ｖｓｘ、実加減速度Ｇｓｘ及び理想軌跡の座標値から得られる理想軌跡に於ける走行経路の曲率１／ρ＊を用いて、目標舵角δｗｔ＊が、例えば、下記の式により、算出される。
δｗｔ＊＝１／ρ＊・ｌ・｛１＋Vsx2(Ao+A1Gsx+A2Gsx2)｝      …（３）
ここで、ｌは、ホイールベース長であり、Ａｏ、Ａ１、Ａ２は、車両の諸元により与えられる定数である（非特許文献１参照）。実車速Ｖｓｘは、典型的には、車輪速センサからの車輪速値を用いて任意の形式で与えられたものでよい。また、実加減速度Ｇｓｘは、車両に備えられた前後加速度センサ６４からの値が用いられてよい。曲率１／ρ＊は、前記の最近理想点での値である。そして、自律目標舵角算出部８０ａにて理想軌跡を達成する基本的な目標舵角が算出されると、次いで、センサにより検知された現在の実ヨーレートγと最近理想点に於いて設定されたヨーレート目標値γ＊との偏差Δγ（＝γ＊−γ）、任意の形式にて与えられる現在の実スリップ角（車体）βと最近理想点に於いて設定されたスリップ角目標値β＊との偏差Δβ（＝β＊−β）とが算出され、これらの偏差が小さくなる方向に（適当に設定されるゲインＫγ、Ｋβを乗じて）基本的な目標舵角δｗｔ＊が、下記の如く、修正されるようになっていてよい（フィードバック制御）。即ち、
δｗｔ＊←δｗｔ＊＋ＫγΔγ＋ＫβΔβ      …（４）
【００３３】
更に、車両の現在位置の左右方向の位置を理想軌跡へ一致させるために、左右方向変位算出部８０ｂにて与えられる現在位置と最近理想点との距離ΔＹｓに基づいて、その距離ΔＹｓが小さくなる方向に（適当に設定されるゲインＫＹｓを乗じて）基本的な目標舵角δｗｔ＊が下記の如く、修正される。
δｗｔ＊←δｗｔ＊＋ＫＹｓΔＹｓ      …（５）
ΔＹｓの大きさは、前記の如く決定された最近理想点と現在位置との距離
｜ΔＹｓ｜＝｛(ＸＧＰＳ＊−ＸａＧＰＳ)２＋(ＹＧＰＳ＊−ＹａＧＰＳ)２｝1/2    …（６）
により与えられる。ΔＹｓの符号（向き）は、車両が現在位置から最近理想点へ向かう方向へ舵角が増大する方向に設定される。
【００３４】
一方、自律制御（前後方向）目標加減速度算出部６０ｊに於いては、図３（Ｂ）を参照して、最近理想点での加減速度Ｇｓｘ＊が、基本的な目標加減速度αｔ＊として設定される。そして、前後方向センサにより検知された実加減速度Ｇｓｘと最近理想点での加減速度Ｇｓｘ＊との偏差ΔＧｓｘ（＝Ｇｓｘ＊−Ｇｓｘ）と、実車速Ｖｓｘと最近理想点での車速Ｖｓｘ＊との偏差ΔＶｓｘ（＝Ｖｓｘ＊−Ｖｓｘ）とが小さくなる方向に（適当に設定されるゲインＫＧ、ＫＶを乗じて）目標加減速度αｔ＊が修正される（フィードバック制御）。なお、車速は、加減速度の一次であるので、車速偏差の微分項を適当に設定されるゲインＫＶ’を乗じて目標加減速度αｔ＊にフィードバックし、偏差ΔＶｓｘが小さくなる方向に目標加減速度αｔ＊を修正してもよい。かくして、αｔ＊は、
αｔ＊←Ｇsx＊＋ＫＧ・ΔＧsx＋ＫＶ・ΔＶsx＋ＫＶ’・ｄΔＶsx/dt
により与えられる。
【００３５】
［自律運転とヒトとの協調制御のための構成］
以上の如く算出された目標舵角δｗｔ＊と目標加減速度αｔ＊とがそのまま操舵制御装置６０ｆ、制駆動力制御指令部６０ｃへ送られると、車両は、自律的に理想軌跡に沿って予定された走行状態にて走行することが期待される。しかしながら、かかる自律走行中に運転者がハンドル操作やペダル操作を行ったときには、その操作を車両に或る程度反映させるために、運転者の操作に基づく目標舵角δｗｔ及び目標加減速度αｔと、自律走行制御による目標舵角δｗｔ＊及び目標加減速度αｔ＊とを調停する「自律運転とヒトとの協調制御」のための構成が設けられる。この点に関し、既に述べた如く、本実施形態の電子制御装置６０に於いては、運転者の操作に基づく制御目標値と自律走行制御による制御目標値との調停が、車両の左右方向と前後方向とで別々に行われる。
【００３６】
再び、図２を参照して、電子制御装置６０に於いて、車両の左右方向の位置を調節する制御量である目標舵角についての調停は、左右方向制御調停部６０ｋにて行われ、車両の前後方向の位置を調節する制御量である目標加減速度についての調停は、前後方向制御調停部６０ｌにて行われる。左右方向制御調停部６０ｋは、車輪舵角制御指令決定部６０ｂからの目標舵角δｗｔと自律制御目標舵角算出部からの目標舵角δｗｔ＊を受容し、調停後の目標舵角δｗｃは、
δｗｃ＝ｋ１・δｗｔ＊＋（１−ｋ１）・δｗｔ      …（７）
により与えられる。ここで、ｋ１は、１以下の正の係数（０≦ｋ１≦１）であり、δｗｔとδｗｔ＊との寄与の割合を決定する。同様に、前後方向制御調停部６０ｌは、加減速度制御指令決定部６０ａからの目標加減速度αｔと自律制御目標加減速度算出部αｔ＊を受容し、調停後の目標加減速度αｃは、
αｃ＝ｋ２・αｔ＊＋（１−ｋ２）・αｔ      …（８）
により与えられる。ここで、ｋ２は、１以下の正の係数（０≦ｋ２≦１）であり、αｔとαｔ＊との寄与の割合を決定する。上記の調停に於いて、重要なことは、左右方向に於けるδｗｔとδｗｔ＊との寄与の割合を決定する係数ｋ１と、前後方向に於けるαｔとαｔ＊との寄与の割合を決定する係数ｋ２とは、別々に決定される値であるという点である。係数ｋ１、ｋ２は、それぞれ、値が大きくなると、上記式（７）、（８）から理解される如く、それぞれ自律走行制御による制御の寄与が大きくなり、従って、車両の走行軌跡・状態は、理想軌跡に近づくこととなるところ、その程度は、車両の左右方向と前後方向とで独立して調節できることとなる。
【００３７】
上記の係数ｋ１、ｋ２の具体的な値は、運転者の選択によって可変であってよく、走行モード決定部６０ｈからのモード情報に基づいて適宜設定されてよい。例えば、自律走行モードの選択中に、燃費を重視する走行モードが選択されたときには、ｋ２の値を大きくし（前後方向状態が理想軌跡に近いほど、エネルギー効率良く車両が走行するため）、或いは、車両の挙動が穏やかにするモードが選択されたときには、ｋ１の値を小さくする（ｋ１を小さくすると、自律走行制御の寄与が下がり、車両は、より運転者の操舵通りに走行することとなり、運転者の違和感が低減される。）、といった設定が為されてよい（なお、かかる係数ｋ１、ｋ２の設定は、例示であって、これに限定されない。自律走行制御を実行しないときには、ｋ１＝ｋ２＝０としてよい。）。
【００３８】
上記の構成に於いて理解されるべきことは、運転者の操作と自律走行制御の寄与の割合を車両の前後方向と左右方向とで別々に決定することにより、自律走行制御による運転者の操作への介入に対する運転者の違和感が車両の前後方向と左右方向とで差異があるということに対処することが可能であるという点である。既に述べた如く、一般に、運転者は、車両操縦中、車両の前後方向について制御介入については違和感を感じにくいが、車両の左右方向について制御介入については違和感を感じやすい。上記の本発明の構成によれば、運転者の違和感の感じ方の差異に応じて、運転者の操作と自律走行制御の寄与の割合を決定できることとなるので、前後方向では、車両の状態をできるだけ理想軌跡に近づける一方で、左右方向では、運転者の操作の寄与を大きくして、運転者が違和感を感じないようにする、といった制御態様が可能となる。
【００３９】
［調停後の処理］
ところで、上記の式（７）及び（８）の如く決定された各アクチュエータの目標値をそのまま各アクチュエータへ与えるときには、各輪のタイヤ力がそれぞれの最大摩擦円に収まっているという保証はないこととなり、車両の走行状態が安定であるという条件が達成されないことが有り得る。そこで、そのような状況を回避するために、本実施形態の制御装置に於いては、調停後の目標舵角δｗｃと目標加減速度αｃから、車両の運動モデル又はタイヤモデルを用いて、各輪にてタイヤ力の大きさと向きを推定し、各輪の摩擦円の使用率が過剰にならないように上記の運転者の操作と自律走行制御の寄与の割合を決定する係数ｋ１、ｋ２をそれぞれ増大する調停割合修正部６０ｍが設けられる（完全に自律走行制御が達成されるとき（ｋ１＝ｋ２＝１）には、各輪の摩擦円の使用率が過剰にならないという条件が満たされている。）。
【００４０】
図４（Ａ）は、調停割合修正部６０ｍの制御処理をフローチャートの形式にて表したものである。同図を参照して、調停割合修正部６０ｍに於いては、左右方向及び前後方向の各制御調停部でそれぞれの目標値が算出されると、まず、それらの値に基づいて、公知の任意のモデルを用いて、各輪の前後力Ｔｉ、横力Ｆｉ、荷重Ｗｉ（ｉ＝ＦＬ，ＦＲ，ＲＬ，ＲＲ）とが推定され、各輪のタイヤ利用率λｉが
λｉ＝（Ｔｉ２＋Ｆｉ２）１／２／μＷｉ      …（９）
［ここで、μは、路面の最大摩擦係数である。］
により推定される（ステップ１０）。次いで、各輪のタイヤ利用率λｉに於いて、所定値λｏに対して
λｉ＞λｏ      …（１０）
が成立しないときには（ステップ２０）、各調停部に対して目標値の出力を許可する（ステップ３０）。他方、式（１０）が成立したときには、上記の係数ｋ１とｋ２がそれぞれ、
ｋ１←ｋ１＋Δｋ１      …（１１ａ）
ｋ２←ｋ２＋Δｋ２      …（１１ｂ）
により修正される（ステップ４０）。ここで、Δｋ１、Δｋ２は、任意に設定されてよい１未満の正の数であり、Δｋ１とΔｋ２とは、別々の値であってよい。そして、各調停部に於いて、式（７）、（８）により、目標値を再計算させ（ステップ５０）、式（１０）が成立しなくなるまで、ステップ１０、２０、４０、５０が繰り返される。
【００４１】
図４（Ｂ）は、かかる図４（Ａ）の処理に於いて意図されるタイヤ力の大きさの変化を説明する図である。同図に於いて示されている如く、自律走行制御のみを実行した場合には、全輪に於いてタイヤ力は、最大摩擦円の内側に収容された状態となっている。しかしながら、運転者の操作の寄与を含めた調停を行うと、調停後と付された矢印の如く、タイヤ力が摩擦円をはみ出ることが起き得る。そこで、図４（Ａ）の処理により、目標値に於いて、自律制御の寄与の割合を増大し、タイヤ力が摩擦円内に収容されるよう係数ｋ１、ｋ２が大きくして、状態を自律制御のみの場合に近づけ、車両の走行状態の安定性の維持が図られる。
【００４２】
総じて、上記の本発明の装置によれば、理想軌跡に沿った自律走行制御と運転者の操作との協調制御に於いて、車両の左右方向と前後方向との制御を切り離して、独立に制御されるようにすることにより、制御介入に対する運転者の違和感の低減と車両の走行軌跡を理想軌跡に一致させるという二つの相反する要求を、それぞれ、できるだけ高い程度に達成することが図られることとなる。
【００４３】
以上に於いては本発明を特定の実施例について詳細に説明したが、本発明は上述の実施例に限定されるものではなく、本発明の範囲内にて他の種々の実施例が可能であることは当業者にとって明らかであろう。
【００４４】
例えば、車両の左右方向の制御調停部に於いて、更に、加減速度制御指令決定部からの目標加減速度を考慮して、制御の調停が為されるようになっていてもよい。また、車両の左右方向の制御調停部からの制御量の一部が制動装置の制動力の左右差を与える成分を含み、調停後の制御量の一部が制動制御装置へ与えられるようになっていてもよい。更に、車両の左右方向の自律制御のための制御量として、ヨーモーメントが与えられてから、目標舵角、各輪制動力配分（ΔＦｂｔｉ）が決定されるようになっていてもよい。また更に、車両の前後方向の自律制御のための制御量として、加減速度に代えて、又は、これと共に、車速又は制駆動力若しくは制駆動トルクが用いられてもよい。本発明に於いて、重要なことは、理想軌跡の成分を車両の前後方向と左右方向と分割し、運転者の操作量に対する自律制御の割合を車両の前後方向と左右方向とで独立に調整できるようにすることである。
【図面の簡単な説明】
【００４５】
【図１】図１は、本発明の好ましい実施形態である走行制御装置が搭載される車両の模式図である。
【図２】図２は、本発明の好ましい実施形態に於ける自律運転とヒトとの協調制御のため走行制御装置が組み込まれた電子制御装置の内部構成を制御ブロックの形式で表したものである。
【図３】図３（Ａ）は、自律制御の左右方向の制御量である目標舵角を決定する目標舵角算出部５０ｉの内部構成を制御ブロックの形式で表したものであり、図３（Ｂ）は、自律制御の前後方向の制御量である目標加減速度を決定する目標加減速度算出部５０ｊの内部構成を制御ブロックの形式で表したものである。
【図４】図４（Ａ）は、目標舵角算出部５０ｉと目標加減速度算出部５０ｊに於ける調停割合を修正する調停割合修正部６０ｍの制御処理をフローチャートの形式で表したものである。図４（Ｂ）は、調停割合修正部６０ｍの制御処理による各輪タイヤ力の変化を模式的に表したものである。
【図５】図５は、理想軌跡生成部で生成される理想軌跡に於いて設定される座標値、各種状態量をＧＰＳ座標系と共に模式的に示したものである。理想軌跡の座標値は、図中の丸点列の座標値（ＸＧＰＳ＊、ＹＧＰＳ＊）にて与えられ、更に、各丸点に於いて、車速Ｖｓｘ＊、ヨーレートγ＊、車体スリップ角β＊が設定される。なお、更に、車両の横速度が設定されてもよい。座標値は、ＧＰＳ座標系であってもよいが、これに限定されない。図中、Ｘｓ、Ｙｓは、車両に固定された座標系を示している。ＸａＧＰＳ、ＹａＧＰＳは、車両の現在位置の座標値である。図中、右下の四角枠内は、車両の現在位置に最も近い理想軌跡上の点を決定する処理の概念を説明する図である。
【符号の説明】
【００４６】
１０…車両
１２ＦＬ〜１２ＲＲ…車輪
１４…アクセルペダル
２０…動力装置
３０…操舵装置
３２…ステアリングホイール
３６…転舵角可変装置
４０…制動装置
４２FL〜４２RR…ホイールシリンダ
４４…ブレーキペダル
４８…油圧回路
６０…電子制御装置
６４…前後加速度センサ
６６…横方向加速度センサ
６８…ヨーレートセンサ
７０…ビデオカメラ又はレーダー装置
７２…カーナビゲーションシステム
【図１】
0005120049.tif 000002
【図２】
0005120049.tif 000003
【図３】
0005120049.tif 000004
【図４】
0005120049.tif 000005
【図５】
0005120049.tif 000006