(57)【特許請求の範囲】
【請求項１】
車両前方の道路情報を検出する道路情報検出手段と、
検出された前記道路情報に基づいて、車両の目標走行ラインを設定する目標走行ライン設定手段と、
検出された前記道路情報と、設定された前記目標走行ラインとに基づいて、該目標走行ラインに対する車両の横方向相対位置を検出する相対位置検出手段と、
車両のサスペンションの変位量から車両重量を算出する車両重量演算手段と、
検出された前記横方向相対位置と、算出された前記車両重量と、該車両重量に応じて設定される車両前輪のコーナリングパワーとに基づいて、車両を前記目標走行ラインに沿って走行させるためのステアリングの操舵角を目標操舵角として算出する目標操舵角演算手段と、
算出された前記目標操舵角に基づいて自動操舵電流を算出する自動操舵電流演算手段と、
算出された前記自動操舵電流に応じて、前記ステアリングを前記目標操舵角に回動させるアクチュエータと、を備え、
前記目標操舵角演算手段は、
前記コーナリングパワーを、車両の動特性及び重心変化を考慮しない時の前記車両重量に対する関係に基づいて算出されるリファレンスコーナリングパワーとして設定する
ことを特徴とする車両の自動走行制御装置。
【請求項２】
車両前方の道路情報を検出する道路情報検出手段と、
検出された前記道路情報に基づいて、車両の目標走行ラインを設定する目標走行ライン設定手段と、
検出された前記道路情報と、設定された前記目標走行ラインとに基づいて、該目標走行ラインに対する車両の横方向相対位置を検出する相対位置検出手段と、
車両のサスペンションの変位量から車両重量を算出する車両重量演算手段と、
検出された前記横方向相対位置と、算出された前記車両重量と、該車両重量に応じて設定される車両前輪のコーナリングパワーとに基づいて、車両を前記目標走行ラインに沿って走行させるためのステアリングの操舵角を目標操舵角として算出する目標操舵角演算手段と、
算出された前記目標操舵角に基づいて自動操舵電流を算出する自動操舵電流演算手段と、
算出された前記自動操舵電流に応じて、前記ステアリングを前記目標操舵角に回動させるアクチュエータと、を備え、
前記目標操舵角演算手段は、
前記横方向相対位置及び該横方向相対位置を時間微分した横方向相対速度を含む設計関数から、該設計関数のリファレンス拘束速度と実拘束速度との差で設計パラメータを調整することで、前記車両重量及び前記コーナリングパワーの変化の影響を低減して前記目標操舵角を算出し、
前記拘束速度は、状態挙動がない状態に拘束される速度である
ことを特徴とする車両の自動走行制御装置。
【請求項３】
前記目標操舵角演算手段は、
前記横方向相対位置及び該横方向相対位置を時間微分した横方向相対速度を含む設計関数から、該設計関数のリファレンス拘束速度と実拘束速度との差で設計パラメータを調整することで、前記車両重量及び前記コーナリングパワーの変化の影響を低減して前記目標操舵角を算出し、
前記拘束速度は、状態挙動がない状態に拘束される速度である請求項１に記載の車両の自動走行制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、自動走行制御装置に関し、特に車両を目標走行ラインに沿って自動操舵する自動走行制御装置に関する。
【背景技術】
【０００２】
近年、車両の自動操舵制御に関する様々な技術が提案され、その実用化が進められている。例えば、特許文献１には、目標走行ラインの曲率に応じて車両に発生すべき平衡点操舵角を過去ｎ個分の目標操舵角の平均値（時間移動平均値）から演算することで、曲線路走行を良好に行えるようにした車両の自動操舵装置が開示されている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開平１０−２９７５２１号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
ところで、推定される曲率を用いる自動操舵制御の場合、制御性能は推定される曲率の精度に大きく依存することになる。そのため、このような自動操舵制御を、例えば荷物の積み下ろしによる荷重変動が大きい商用車等に適用した場合、積荷重心の変動により車両のピッチ、ロール、ヨー等を含むダイナミック特性も大きく変動するため、曲率の推定は極めて複雑で困難なものになる。また、変動するダイナミック特性を把握すべく、各状態量を検出するセンサ類を設けると、装置のコストアップを招く可能性がある。
【０００５】
本発明はこのような点に鑑みてなされたもので、その目的は、車両の動特性が変動した場合においても、目標走行ラインを安定して自動走行することにある。
【課題を解決するための手段】
【０００６】
上述の目的を達成するため、本発明の車両の自動走行制御装置は、車両前方の道路情報を検出する道路情報検出手段と、検出された前記道路情報とに基づいて、車両の目標走行ラインを設定する目標走行ライン設定手段と、検出された前記道路情報と、設定された前記目標走行ラインとに基づいて、該目標走行ラインに対する車両の横方向相対位置を検出する相対位置検出手段と、車両のサスペンションの変位量から車両重量を算出する車両重量演算手段と、検出された前記横方向相対位置と、算出された前記車両重量と、該車両重量に応じて設定される車両前輪のコーナリングパワーと基づいて、車両を前記目標走行ラインに沿って走行させるためのステアリングの操舵角を目標操舵角として算出する目標操舵角演算手段と、算出された前記目標操舵角に基づいて自動操舵電流を算出する自動操舵電流演算手段と、算出された前記自動操舵電流に応じて、前記ステアリングを前記目標操舵角に回動させるアクチュエータとを備えることを特徴とする。
【０００７】
また、前記目標操舵角演算手段は、前記コーナリングパワーを、車両の動特性及び重心変化を考慮しない時の前記車両重量に対する関係に基づいて算出されるリファレンスコーナリングパワーとして設定してもよい。
【０００８】
また、前記目標操舵角演算手段は、前記横方向相対位置及び該横方向相対位置を時間微分した横方向相対速度を含む設計関数から、該設計関数のリファレンス拘束速度と実拘束速度との差で設計パラメータを調整することで、前記車両重量及び前記コーナリングパワーの変化の影響を低減して前記目標操舵角を算出してもよい。
【発明の効果】
【０００９】
本発明の車両の自動走行制御装置によれば、車両の動特性が変動した場合においても、目標走行ラインを安定して自動走行することができる。
【図面の簡単な説明】
【００１０】
【図１】本発明の一実施形態に係る自動走行制御装置の構成を示すブロック図である。
【図２】図１の自動走行制御装置を搭載する車両の入出力構成を示す図である。
【図３】本発明の一実施形態に係る自動走行制御装置の制御フローを示すフローチャートである。
【発明を実施するための形態】
【００１１】
以下、図１〜３に基づいて、本発明の一実施形態に係る車両の自動走行制御装置について説明する。同一の部品には同一の符号を付してあり、それらの名称および機能も同じである。したがって、それらについての詳細な説明は繰返さない。
【００１２】
図１に示すように、本実施形態の自動走行制御装置１０は、カメラ１１と、操舵角センサ１２と、トルクセンサ１３と、ストロークセンサ１４と、アクチュエータ１５と、ＥＣＵ（電子制御ユニット）２０とを備えている。
【００１３】
カメラ１１は、例えばＣＣＤカメラであって、車両前方の路面を撮像する。このカメラ１１により撮像された画像データは、電気的に接続されたＥＣＵ２０に出力される。なお、本実施形態のカメラ１１は、本発明の道路情報検出手段を構成する。
【００１４】
操舵角センサ１２は、図２に示すように、ステアリングシャフト３に組み付けられており、ステアリングシャフト３の回転量を検出する。この操舵角センサ１２により検出された回転量は、電気的に接続されたＥＣＵ２０に操舵角θとして出力される。
【００１５】
トルクセンサ１３は、図２に示すように、ステアリングシャフト３に組み付けられており、ステアリングホイール２に入力された操舵トルクを検出する。このトルクセンサ１３により検出された操舵トルクは、電気的に接続されたＥＣＵ２０に操舵トルクＴｈとして出力される。
【００１６】
ストロークセンサ１４は、車両の図示しない各サスペンション装置にそれぞれ組み付けられており、サスペンション装置の変位量を検出する。このストロークセンサ１４より検出された各サスペンション装置の変位量は、電気的に接続されたＥＣＵ２０に変位量Ｄとして出力される。
【００１７】
アクチュエータ１５は、ステアリングシャフト３に設けられた駆動部１５ａと、この駆動部１５ａに作動油を供給する油圧ポンプ１５ｂと、駆動部１５ａに供給される作動油の油圧を調整するコントロールバルブ１５ｃとを備えている。また、コントロールバルブ１５ｃはＥＣＵ２０と電気的に接続されており、ＥＣＵ２０から入力される指示電流ｉautoに応じてバルブ開度が調整される。すなわち、ＥＣＵ２０からの指示電流ｉautoに応じて駆動部１５ａに供給される作動油の油圧が調整され、この油圧に応じた駆動部１５ａの駆動によりステアリングシャフト３が回動することで、車両の操舵輪は自動で転舵、すなわち自動操舵されるように構成されている。
【００１８】
ＥＣＵ２０は、自動走行制御装置１０の各種制御を行うもので、公知のＣＰＵやＲＯＭ、ＲＡＭ、入力ポート、出力ポート等を備え構成されている。この各種制御を行うために、ＥＣＵ２０には、操舵角センサ１２、トルクセンサ１３、ストロークセンサ１４等の各種センサの出力信号がＡ／Ｄ変換された後に入力される。また、ＥＣＵ２０は、車両重量演算部２１と、目標走行ライン設定部２２と、偏差演算部２３と、偏差微分演算部２４と、目標操舵角演算部２５と、指示電流演算出力部２６とを一部の機能要素として有する。これら各機能要素は、本実施形態では一体のハードウェアであるＥＣＵ２０に含まれるものとして説明するが、これらのいずれか一部を別体のハードウェアに設けることもできる。
【００１９】
車両重量演算部２１は、ストロークセンサ１４から出力される各サスペンション装置の変位量Ｄに、既知のサスペンションバネ定数を乗算して得られる各サスペンション装置の荷重を合計することで、空荷時や積載時における車両重量Ｍを演算する。なお、本実施形態のストロークセンサ１４とＥＣＵ２０の車両重量演算部２１とは、本発明の車両重量演算手段を構成する。
【００２０】
目標走行ライン設定部２２は、カメラ１１から出力される撮像画像に基づいて路面両端の白線を認識し、これら白線間を車両の走行レーンに設定すると共に、片側の白線（例えば、左側の白線）から所定の距離に位置するラインを目標走行ラインとして設定する。例えば、片側の白線から５０％の距離を目標走行ラインに設定した場合、両端の白線の中央に位置するラインが目標走行ラインとなる。
【００２１】
偏差演算部２３は、目標走行ライン設定部２２により設定された目標走行ラインに対する車両の現在位置である横方向相対位置（以下、横位置ともいう）を演算する。具体的には、カメラ１１から出力される撮像画像に基づいて、片側の白線から車両までの距離と、片側の白線から目標走行ラインまでの距離との差が偏差ｙ（目標偏差）として算出される。
【００２２】
偏差微分演算部２４は、偏差演算部２３が算出した偏差ｙを所定時間毎に時間微分することにより偏差微分ｙ’（以下、横速度ともいう）を算出する。
【００２３】
目標操舵角演算部２５は、車両重量演算部２１により算出された車両重量Ｍ、偏差演算部２３により演算された偏差ｙ、偏差微分演算部２４により算出された偏差微分ｙ’、操舵角センサ１２から出力される操舵角θ、前輪コーナリングパワーＫf、後輪コーナリングパワーＫrに基づいて、車両を目標走行ラインに沿って走行させるための操舵角を目標操舵角度δとして算出する。
【００２４】
指示電流演算出力部２６は、目標操舵角演算部２５により算出された目標操舵角度δに基づいて、車両を目標走行ラインに沿って走行させるためのアクチュエータ１５を駆動させる電流を指示電流ｉautoとして演算するとともに、この指示電流ｉautoをアクチュエータ１５のコントロールバルブ１５ｃに出力する。
【００２５】
次に、本実施形態に係る自動走行制御装置１０による制御フローを図３に基づいて説明する。
【００２６】
ステップＣ１０１では、カメラ１１、操舵角センサ１２、トルクセンサ１３、ストロークセンサ１４からＥＣＵ２０に必要なパラメータが読み込まれる。
【００２７】
ステップＣ１０２では、ＥＣＵ２０の目標走行ライン設定部２２により、カメラ１１から出力される撮像画像に基づいて目標走行ラインが設定される。
【００２８】
ステップＣ１０３では、ＥＣＵ２０の偏差演算部２３により、目標走行ラインに対する車両の現在位置（横位置）としての偏差ｙが算出される。
【００２９】
ステップＣ１０４では、ＥＣＵ２０の目標操舵角演算部２５により目標操舵角δが算出される。
【００３０】
ここで、操舵系の状態方程式は、以下の式（１）で表される。
【００３１】
【数１】
0005790232.tif 000002
【００３２】
なお、式（１）におけるＡ11、Ａ12、Ａ13、Ａ31、Ａ32、Ａ33、Ｂ11、Ｂ31は、以下のように表される。
【００３３】
【数２】
0005790232.tif 000003
【００３４】
また、曲率ｒは、以下の式（２）で表される。なお、式（２）において、λrは曲率ｒの近似一次系の係数である。
【００３５】
【数３】
0005790232.tif 000004
【００３６】
また、スライディングモードの超平面は、以下の式（３）で表される。
【００３７】
【数４】
0005790232.tif 000005
【００３８】
この式（３）において、ｈは正の任意の定数であり、実験により値を決定する。ここで、システムを安定化することができる制御入力として、以下に示す式（４）がある。
【００３９】
【数５】
0005790232.tif 000006
【００４０】
式（４）において、μ＞０は設計パラメータである。ＳＣＢを式（４）に代入すると、以下に示す式（５）となる。
【００４１】
【数６】
0005790232.tif 000007
【００４２】
式（５）に示すように、荷重変動により前輪コーナリングパワーＫfと車両重量Ｍとの比が変動しても、設計パラメータμを所定値以上に設定すれば、制御システムの追従ロバスト性を保証できる。しかし、車両重量Ｍと前輪コーナリングパワーＫfとが変動すると、σ（０）が０（ゼロ）に拘束される速度に相違が生じ、追従ロバスト性は落ちないものの、操舵系に振動現象（車両の蛇行）を引き起こすため、最適な操舵角度を得ることができない。すなわち、車両重量Ｍと前輪コーナリングパワーＫfとの変動が把握できればよいが、前輪コーナリングパワーＫfの変動は車両の動特性の影響を受けるため、把握することはきわめて困難である。
【００４３】
そこで、本実施形態では、車両の動特性及び重心変化を考慮しない場合の車両重量Ｍと前輪コーナリングパワーＫfとの関係を求める。例えば、車両が水平状態の静的状態（Static）における、各タイヤへの荷重配分とタイヤ構造とに基づいて、リファレンスとしてのリファレンスコーナリングパワーＫfrefを算出する。また、リファレンスコーナリングパワーＫfrefは、車両のロール、ピッチ、積載荷重による重心位置の変動により変化するため、この変化の影響を以下に示す式（６）で設計パラメータμを調整することにより低減する。
【００４４】
【数７】
0005790232.tif 000008
【００４５】
なお、式（６）において、μTは調整後ＥＣＵ２０に入力するパラメータである。また、μSは車両重量ＭとリファレンスコーナリングパワーＫfrefにより設定したパラメータであってシミュレーションにより求める。また、Δμは、実拘束速度とリファレンス拘束速度との誤差を低減する調整量である。
【００４６】
次に、式（５）に式（６）を代入する。すなわち、目標操舵角δは以下に示す式（７）で演算される。
【００４７】
【数８】
0005790232.tif 000009
【００４８】
目標操舵角演算部２５は、式（７）から求めた目標操舵角δを指示電流演算出力部２６に入力する。
【００４９】
ステップＣ１０５では、指示電流演算出力部２６により指示電流ｉautoが算出される。ここで、目標操舵角δは、以下の式（８）に示すように、指示電流ｉautoと二次遅れ系の関係がある。指示電流演算出力部２６は、この式（８）に基づいて指示電流ｉautoを算出する。
【００５０】
【数９】
0005790232.tif 000010
【００５１】
ステップＣ１０６では、Ｃ１０５で算出された指示電流ｉautoが、指示電流演算出力部２６からアクチュエータ１５のコントロールバルブ１５ｃに出力されて、本制御はリターンされる。
【００５２】
次に、本実施形態の自動走行制御装置１０による作用について説明する。
【００５３】
車両が曲線路を走行する場合、カメラ１１により撮像された車両前方の路面の撮像画像に基づいて、目標走行ラインが設定されると共に、目標走行ラインに対する車両の現在の距離である偏差ｙ（横位置）と、この偏差ｙを時間微分した偏差微分ｙ’（横速度）が算出される。さらに、ストロークセンサ１４の検出値（変位量Ｄ）に基づいて、車両の重量としての車両重量Ｍが算出される。
【００５４】
その後、これら偏差ｙ、偏差微分ｙ’、車両重量Ｍ、操舵角θ、前輪コーナリングパワーＫfに基づいて、車両を目標走行ラインに沿って安定して走行させるための目標操舵角δが算出される。この時、本実施形態の自動走行制御装置１０によれば、車両の動特性及び重心変化を考慮しない場合のリファレンスコーナリングパワーＫfrefが算出されると共に、車両の動特性の変化の影響を低減すべく、設計パラメータμが調整される。
【００５５】
すなわち、車両重量Ｍ及び、この車両重量Ｍに対するリファレンスコーナリングパワーＫfrefに応じて、設計関数のリファレンス拘束速度と実拘束速度との差により設計パラメータμを調整することで、車両を目標走行ラインに沿って走行させるための最適な目標操舵角δが算出されることになる。
【００５６】
したがって、曲率推定等を行うことなく、動特性が大きく変化した場合においても目標操舵角δを精度良く算出することが可能となり、車両を目標走行ラインに沿って安定して自動走行させることができる。
【００５７】
なお、本発明は、上述の実施形態に限定されるものではなく、本発明の趣旨を逸脱しない範囲で、適宜変形して実施することが可能である。
【００５８】
例えば、上述の実施形態において、目標走行ラインと偏差ｙ（横位置）とは、カメラ１１の撮像画像に基づいて設定もしくは算出されるものとして説明したが、ＧＰＳ衛星から送信される位置情報を受信して、この位置情報に基づいて設定もしくは算出してもよい。
【００５９】
この場合も上述の実施形態と同様の作用効果を奏することができる。
【符号の説明】
【００６０】
１０  自動走行制御装置
１１  カメラ（道路情報検出手段）
１２  操舵角センサ
１３  トルクセンサ
１４  ストロークセンサ（車両重量演算手段）
２０  ＥＣＵ
２１  車両重量演算部（車両重量演算手段）
２２  目標走行ライン設定部
２３  偏差演算部
２４  偏差微分演算部
２５  目標操舵角演算部（目標操舵角演算手段）
２６  指示電流演算出力部（自動操舵電流演算手段）
【図２】
0005790232.tif 000011
【図１】
0005790232.tif 000012
【図３】
0005790232.tif 000013