(57)【要約】【課題】先行車との車間距離を目標車間距離に維持すべく自車の制駆動力を制御する機能を備えるＡＣＣシステムにおいて、Ｓ字カーブ等においても、先行車を適確に捕捉しえるようにする。【解決手段】ヨーレートセンサおよび車速検出手段の検出信号に基づいて自車の進行方向に沿う曲率を推定する手段２３、自車進行路の車線幅を設定する手段２４、自車進行路の曲率と車線幅とから自車進行路の車線形状を設定する手段２５、前方車の位置を検出する手段２１、自車進行路の車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定する手段２６、ヨーレートセンサの検出誤差を補正する手段（ヨーレートの検出値＝推定曲率に対応するゲイン×ヨーレートの出力値に補正する手段３１）、を備える。【選択図】図２
2008232946.tif 000002
【特許請求の範囲】
【請求項１】
自車のヨーレートを検出するヨーレートセンサ、自車の車速を検出する手段、ヨーレートの検出信号および車速の検出信号に基づいて自車進行路の曲率を推定する手段、自車進行路の車線幅を設定する手段、自車進行路の曲率と車線幅とから自車進行路の車線形状を設定する手段、前方車の位置を検出する手段、自車進行路の車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定する手段、ヨーレートセンサの検出誤差を補正する手段、を備えることを特徴とする車載用レーダ装置。
【請求項２】
自車のヨーレートを検出するヨーレートセンサ、自車の車速を検出する手段、ヨーレートセンサの検出信号に含まれるノイズを除去する第１フィルタ、第１フィルタ処理後のヨーレートと車速の進出信号とから自車進行路の曲率を推定する手段、自車進行路の車線幅を設定する手段、自車進行路の曲率と車線幅とから自車進行路の車線形状を設定する手段、前方車の位置を検出する手段、自車進行路の車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定する手段、ヨーレートの検出に含まれるノイズを除去する第２フィルタ、第２フィルタ処理後のヨーレートの変動を演算する手段、この変動に基づいて第１フィルタの時定数を調整する手段、第２フィルタ処理後のヨーレートと車速の検出信号とから自車進行路の曲率を推定する手段、ヨーレートセンサの検出誤差を第２フィルタの応答遅れと共に補正する手段、を備えることを特徴とする車載用レーダ装置。
【請求項３】
ヨーレートの誤差を補正する手段は、推定曲率をパラメータとしてこれに対応するゲインを設定する手段、ヨーレートの検出値＝推定曲率に対応するゲイン×ヨーレートセンサの出力値に補正する手段、を備える請求項１または請求項２に記載の車載用レーダ装置。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、ＡＣＣ（Adaptive Cruise Control)システムに好適な車載用レーダ装置に関する。
【背景技術】
【０００２】
ＡＣＣシステムにおいては、先行車に対して所定の車間距離を保つように自車の駆動力や制動力を制御する機能（追従制御）が設定され、先行車の捕捉および車間距離の計測などに車載用レーダ装置が用いられる。特許文献１においては、車載レーダ装置を用いて自車から先行車までの車間距離などを検出する装置が開示される。
【特許文献１】特許第３０８９８６４号
【発明の開示】
【発明が解決しようとする課題】
【０００３】
ＡＣＣシステムに好適な車載用レーダ装置については、先行車の捕捉性を高めるため、自車の車速とヨーレートとから自車進行路の曲率を推定する手段と、自車進行路の車線幅を設定する手段、自車進行路の曲率と車線幅とから自車進行路の車線形状を設定する手段、車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定する手段、を備えるものがある（特願２００６−７９０６６号）。
【０００４】
このような車載用レーダ装置においては、自車進行路の曲率の推定精度が十分に確保されないと、Ｓ字カーブ等において、自車が追走するべき先行車を見失ったり、隣接する対向車を先行車と誤認しやすく、追従制御により、不必要な加速や減速を繰り返しかねない、という不具合が考えられる。
【０００５】
この発明は、このような不具合を解決するための有効な手段の提供を目的とする。
【課題を解決するための手段】
【０００６】
第１の発明は、車載用レーダ装置において、自車のヨーレートを検出するヨーレートセンサ、自車の車速を検出する手段、ヨーレートの検出信号および車速の検出信号に基づいて自車進行路の曲率を推定する手段、自車進行路の車線幅を設定する手段、自車進行路の曲率と車線幅とから自車進行路の車線形状を設定する手段、前方車の位置を検出する手段、自車進行路の車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定する手段、ヨーレートセンサの検出誤差を補正する手段、を備えることを特徴とする。
【０００７】
第２の発明は、車載用レーダ装置において、自車のヨーレートを検出するヨーレートセンサ、自車の車速を検出する手段、ヨーレートセンサの検出信号に含まれるノイズを除去する第１フィルタ、第１フィルタ処理後のヨーレートと車速の進出信号とから自車進行路の曲率を推定する手段、自車進行路の車線幅を設定する手段、自車進行路の曲率と車線幅とから自車進行路の車線形状を設定する手段、前方車の位置を検出する手段、自車進行路の車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定する手段、ヨーレートの検出に含まれるノイズを除去する第２フィルタ、第２フィルタ処理後のヨーレートの変動を演算する手段、この変動に基づいて第１フィルタの時定数を調整する手段、第２フィルタ処理後のヨーレートと車速の検出信号とから自車進行路の曲率を推定する手段、ヨーレートセンサの検出誤差を第２フィルタの応答遅れと共に補正する手段、を備えることを特徴とする。
【０００８】
第３の発明は、第１の発明または第２の発明に係る車載用レーダ装置において、ヨーレートの誤差を補正する手段は、推定曲率をパラメータとしてこれに対応するゲインを設定する手段、ヨーレートの検出値＝推定曲率に対応するゲイン×ヨーレートセンサの出力値に補正する手段、を備えることを特徴とする。
【発明の効果】
【０００９】
第１の発明〜第３の発明においては、ヨーレートセンサの検出誤差が補正され、補正後のヨーレートの検出信号を用いて、自車進行路の曲率が推定される。ヨーレートセンサの検出誤差は、物理的な動作遅れ（応答遅れ）を含むので、直進走行中は、ノイズ（エンジン振動などによる高周波成分）に紛れる程度の検出誤差も、自車が旋回走行へ移行すると、これに伴って大きくなる。その誤差分を取り去ることにより、Ｓ字カーブ等においても、先行車を適確に捕捉することができる。
【００１０】
第２の発明または第３の発明においては、第２フィルタにより、ヨーレートの変動を感度よく判定可能となる。このため、第１フィルタの時定数の調整（補正）が早められ、第１フィルタ処理後のヨーレートと車速の検出信号とから自車進行路の曲率を適切に推定することができる。第１フィルタのみの場合、直進時の時定数の設定が難しくなる。つまり、第２フィルタにより、第１フィルタにおいて、ヨーレートの変動を感度よく判定しつつ、応答遅れも最小限に抑えられるのである。第２フィルタの応答遅れについては、ヨーレートセンサの検出誤差と共に補正される。これらにより、Ｓ字カーブ等においても、自車進行路の曲率を精度よく推定することができる。
【発明を実施するための最良の形態】
【００１１】
図１において、１０はトラックに搭載されるＡＣＣシステムの電子制御ユニット(ＡＣＣ-ＥＣＵ)であり、先行車との実車間距離を目標車間距離に維持するように車両の制駆動力を制御する車間距離制御系１１（追従走行制御系）を備える。１２はＡＣＣシステム１０の操作系であり、メインスイッチのほか、各種機能スイッチが配置される。１３はＡＣＣシステムの表示系であり、各種のＡＣＣ情報を表示する。１４は車間警報ブザーである。
【００１２】
１５はエンジンの電子制御ユニット（エンジン-ＥＣＵ）であり、１６はリターダの電子制御ユニット（リターダ-ＥＣＵ）であり、１７はトランスミッションの電子制御ユニット（Ｔ／Ｍ-ＥＣＵ）であり、１８は前方車との実車間距離を検出する車間距離レーダ装置であり、１９は車両の重心点回りの角速度（ヨーレート）を検出するヨーレートセンサであり、これらはＡＣＣ-ＥＣＵの車間距離制御系１１にＣＡＮバスを介して接続される。
【００１３】
エンジン-ＥＣＵ１５は、ＡＣＣ-ＥＣＵ１１からの車速指令に基づいて車速制御系が燃料噴射制御系の燃料噴射量およびエキゾーストブレーキのON-OFFを制御する。Ｔ／Ｍ-ＥＣＵ１７は、ＡＣＣ-ＥＣＵ１１から車速指令に基づいて車両の変速（クラッチの断続およびトランスミッションのギヤシフト）を制御する。リターダ-ＥＣＵ１６は、ＡＣＣ-ＥＣＵ１１からの車速指令に基づいてリターダのON-OFFを制御する。
【００１４】
図２は、レーダ装置１８の構成に説明する概要図であり、レーダ（ミリ波の送信部および受信部を備える）の受信情報から前方車の位置（距離，角度）情報を検出する手段２１、自車の車速とヨーレートとから自車進行路（進行方向の中心線の曲率）を推定する手段２３、自車進行路の中心線に与える水平方向の車線幅（設定値）を格納する手段２４、自車進行路の中心線と車線幅とから自車進行路の車線形状を設定する手段２５、前方車の位置情報に基づいて自車進行路の車線形状上の最も近い前方車を先行車（追従制御対象）と確定しつつその先行車の位置情報をＡＣＣユニット１１へ出力する手段２６、を備える。２７は自車の車速を検出する車速センサである。
【００１５】
図３は、車線形状の説明図であり、自車のヨーレートと車速とから自車進行路（進行方向の中心線）が推定され、この中心線（図４、参照）に水平方向の車線幅を与えることにより、自車進行路の車線形状（網掛領域）が設定される。左は直進走行時の車線形状であり、右は旋回走行時の車線形状である。車線幅（設定値）は、直進路の場合、進行方向に一律の設定となる。図示の旋回走行時においては、進行方向の中心線が湾曲するため、その接線と垂直に交わる方向の車線幅（図示せず）が水平方向の車線幅より小さくなるので、実際の走行路の車線幅との整合を取る上から、車線幅の変更手段（図のS10、参照）が備えられる。
【００１６】
車線幅の変更手段においては、図５の表のような車線幅変更マップが設定され、曲率半径（推定曲率の逆数）および前方車位置情報の距離に基づいて、自車進行路の中心線に与える水平方向の車線幅を変更するようになっている。図５において、各車線幅の中間値は、補間処理により求められる。直進路の車線幅として例示される数値が格納手段２４の設定値に該当する。
【００１７】
図４は、先行車確定方法の説明図であり、先行車は車線形状と前方車位置情報とから確定される、図４においては、３台の前方車がレーダにより捕捉され、○の２台の前方車については、車線形状上になく、先行車候補とならない。●の１台の前方車については、車線形状上にあるため、先行車候補となり、●の先行車候補は、１台のみのため、これが自車の追従走行すべき対象の先行車と確定されるのである。この先行車の位置情報はＡＣＣシステム１１へ出力され、車間距離制御系において、先行車との実車間距離を目標車間距離に保つように車両の制駆動力が制御される。
【００１８】
車線幅の変更手段（図のS10、参照）により、自車進行路の曲率半径および前方車位置情報の距離に応じて車線幅が変更されるので、旋回走行時においても、実際の走行路の車線幅との整合が取れ、自車が追従するべき先行車を適確に捕捉できるのである。
【００１９】
前方車位置情報は、自車のヨーイングや前方車のヨーイングにより、前方車の車体側面がミリ波の反射範囲に入ると、前方車の反射幅の中心が変位することになり、実際の前方車の位置と誤差を生じるため、その誤差を補正する手段３０（図２、参照）が備えられる。
【００２０】
補正手段３０においては、図６の表のような前方車位置情報補正マップが設定され、レーダの前方車位置情報（角度と距離）に対応するゲイン（補正係数）により、レーダの前方車角度情報を補正するようになっている。補正後の前方車角度情報＝レーダの前方車角度情報×ゲイン、となる。図６において、各ゲインの中間値は、補間処理により求められる。
【００２１】
図２において、３２はヨーレートに乗るノイズ（高周波成分）を除去（平滑化）する第１フィルタであり、３３は同じく第２フィルタであり、３４は第２フィルタ処理後のヨーレートの変動を演算する手段である。第１フィルタ３２は、演算手段３５からの入力（ヨーレートの変動の演算値）に基づいて、車両の操舵に伴うヨーレートの変動（低周波成分）の発生を判定すると、時定数を直進時よりも相対的に小さく補正する手段（図示せず）を備える。第２フィルタ３３の時定数は、所定の固定値に設定される。
【００２２】
第１フィルタにおいては、第２フィルタ処理後のヨーレートから車両の操舵に伴う変動（低周波成分）が判定されると、第１フィルタ３２の時定数が小さく補正される。このため、第１フィルタ３２の応答遅れが小さくなり、Ｓ字カーブ等においても、先行車を適確に捕捉することができる。第１フィルタ３２の直進時の時定数は、ヨーレートに乗るノイズの除去率を高めるため、大きく設定することが可能となるのである。
【００２３】
第２フィルタ３３の時定数を小さく設定することにより、ヨーレートの変動を感度よく判定可能となり、第１フィルタ３２の時定数の補正（調整）が早まるため、Ｓ字カーブ等においても、第１フィルタ処理後のヨーレートと車速の検出信号とから自車進行路の曲率を精度よく推定することができる。第１フィルタ３２のみの場合、直進時の時定数の設定が難しい。つまり、第２フィルタ３３を加えることにより、第１フィルタ３２において、ヨーレートの変動を感度よく判定しつつ、応答遅れも最小限に抑えることができる。また、第１フィルタ３２の時定数は、第２フィルタ３３の時定数が固定値のため、これを基準に設定しやすくなる。
【００２４】
３１はヨーレートセンサ１９の検出誤差（物理的な動作遅れを含む）を補正する手段である。ヨーレートセンサ１９の検出誤差は、ヨーレートの変動と比例的な関係があり、この例においては、図７の表のようなヨーレート補正マップが設定され、曲率半径（推定曲率の逆数）に対応するゲイン（補正係数）により、ヨーレートセンサ１９の検出誤差を第２フィルタ３３の応答遅れと共に補正するようになっている。補正後のヨーレート＝ヨーレートセンサの出力値×ゲイン、となる。図７において、各ゲインの中間値は、補間処理により求められる。
【００２５】
ヨーレートセンサ１９の検出誤差は、物理的な動作遅れ（応答遅れ）を含むので、直進走行中は、ノイズ（エンジン振動などによる高周波成分）に紛れる程度の検出誤差も、自車が旋回走行へ移行すると、これに伴って大きくなる。補正手段３１において、その誤差分が第２フィルタ３３の応答遅れと共に取り除かれるため、自車進行路の曲率を精度よく推定することができる。
【００２６】
図８は、レータ装置の制御内容を説明するフローチャートであり、所定の周期毎に実行される。S1においては、車速の検出信号を読み込む。S2においては、ヨーレートセンサ１９の検出信号を読み込む。S3においては、レーダの前方車位置情報を読み込む。
【００２７】
S4においては、車速センサ２７の検出情報と第２フィルタ処理後のヨーレートとから自車進行路の中心線の曲率を推定する。S5においては、図７のヨーレート補正マップに基づいて、曲率半径（S4の推定曲率の逆数）に対応するゲインにより、ヨーレートセンサの検出誤差を第２フィルタの応答遅れと共に補正する。S6においては、ヨーレート変動の演算値に基づいて、第１フィルタの時定数を調整（補正）するのである。
【００２８】
S7においては、車速の検出信号と第１フィルタ処理後のヨーレートとから自車進行方向の中心線の曲率を推定する。S8においては、図６の前方車位置情報補正マップに基づいて、前方車位置情報（角度，距離）に対応するゲインにより、前方車角度情報を補正する。
【００２９】
S9においては、自車進行方向の中心線に車線幅を与えることにより、自車進行路の車線形状を設定する。S10においては、図５の車線幅変更マップに基づいて、車線幅を自車進行路の曲率半径および前方車位置情報の距離に応じた変更を車線形状の車線幅に加える。S11においては、車線形状および前方車位置情報（前方車距離情報，補正後の前方車角度情報）に基づいて、自車進行路の車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定するのである。
【００３０】
このような制御により、Ｓ字カーブ等においても、自車が追走するべき先行車を適確に捕捉することができる。そのため、ＡＣＣシステムにおいて、信頼性の高い追従制御を実現することができる。
【００３１】
第２フィルタ３３により、第１フィルタ３２において、ヨーレートの変動を感度よく判定しつつ、応答遅れも最小限に抑えられる。第２フィルタ３３の応答遅れについては、ヨーレートセンサ１９の検出誤差と共に補正されるため、Ｓ字カーブ等においても、自車進行路の曲率を精度よく推定することができる。
【００３２】
前方車位置情報は、自車のヨーイングや前方車のヨーイングに原因する誤差が過不足なく補正されるため、Ｓ字カーブ等においても、車線幅の変更手段（図のS10、参照）との相乗効果により、先行車を精度よく確定することができる。
【００３３】
尚、以上の説明では、実施形態をＡＣＣシステムを用いて説明したが、本発明はこれに限らず、先行車を認識する装置に適用可能である。
【図面の簡単な説明】
【００３４】
【図１】ＡＣＣシステムの構成を説明する概要図である
【図２】レーダ装置の構成を説明するブロック図である。
【図３】車線形状の説明図である。
【図４】先行車の確定方法の説明図である。
【図５】車線幅変更マップを例示する表である。
【図６】前方車位置情報補正マップを例示する表である。
【図７】ヨーレート補正マップを例示する表である。
【図８】レーダ装置の制御内容を説明するフローチャートである。
【符号の説明】
【００３５】
１０  ＡＣＣシステム
１１  車間距離制御系
１５  エンジン-ＥＣＵ
１７  Ｔ／Ｍ-ＥＣＵ
１８  レータ装置
１９  ヨーレートセンサ
２１  前方車情報検出手段
２３  自車進行路推定手段
２４  車線幅設定手段
２５  車線形状設定手段
２６  先行車判定手段
２７  車速センサ
３１  ヨーレート補正手段
３２  第１フィルタ
３３  第２フィルタ
３４  ヨーレート変動演算手段
３５  自車進行路曲率推定手段
【図８】
2008232946.tif 000003
【図１】
2008232946.tif 000004
【図２】
2008232946.tif 000005
【図３】
2008232946.tif 000006
【図４】
2008232946.tif 000007
【図５】
2008232946.tif 000008
【図６】
2008232946.tif 000009
【図７】
2008232946.tif 000010