JP4919850B2 - 車載用レーダ装置 - Google Patents

Description

この発明は、ＡＣＣ（Adaptive Cruise Control)システムに好適な車載用レーダ装置に関する。

ＡＣＣシステムにおいては、先行車に対して所定の車間距離を保つように自車の駆動力や制動力を制御する機能（追従制御）が設定され、先行車の捕捉および車間距離の計測などに車載用レーダ装置が用いられる。特許文献１においては、車載レーダ装置を用いて自車から先行車までの車間距離などを検出する装置が開示される。
特許第３０８９８６４号

ＡＣＣシステムに好適な車載用レーダ装置については、先行車の捕捉性を高めるため、自車の車速とヨーレートとから自車進行路の曲率を推定する手段と、自車進行路の車線幅を設定する手段、自車進行路の曲率と車線幅とから自車進行路の車線形状を設定する手段、車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定する手段、を備えるものがある（特願２００６−７９０６６号）。

このような車載用レーダ装置においては、前方車の検出位置に実際の前方車の位置と誤差があると、Ｓ字カーブ等において、自車が追走するべき先行車を見失ったり、隣接する対向車を先行車と誤認しやすく、追従制御により、不必要な加速や減速を繰り返しかねない。誤差としては、自車のヨーイングや前方車のヨーイングに原因するものが考えられる。

この発明は、このような不具合を解決するための有効な手段の提供を目的とする。

第１の発明は、自車のヨーレートを検出するヨーレートセンサと、自車の車速を検出する車速センサと、自車の進行方向に沿う車線幅の設定値を格納する手段と、前記ヨーレートセンサの出力を平滑化して出力する第１フィルタと、前記第１フィルタの出力と前記車速センサの出力とから自車の進行方向に沿う曲率を推定する曲率推定手段と、前記ヨーレートセンサの出力を平滑化して出力する第２フィルタと、前記第２フィルタの出力から前記ヨーレートの変動を演算する手段と、前記変動演算手段の演算結果に基づいて前記第１フィルタの時定数を調整する手段と、前記曲率推定手段によって推定される曲率と前記車線幅の設定値とから自車進行路の車線形状を設定する手段と、前方車の位置を検出する手段と、前記前方車の検出位置の角度を補正する手段と、を備えることを特徴とする車載用レーダ装置である。

第２の発明は、第１の発明に係る車載用レーダ装置において、前記前方車の検出位置の角度を補正する手段は、前方車の検出位置の距離と角度をパラメータとしてこれらに対応するゲインを設定する手段と、前方車の角度＝検出角度×ゲインに補正する手段と、を備えることを特徴とする。

第１の発明においては、第１フィルタの出力と車速センサの出力とから自車の進行方向の曲率を推定され、この推定曲率と車線幅の設定値とから自車進行路の車線形状が設定される。また、第２フィルタの出力から自車の操舵に伴うヨーレートの変動が演算され、その演算結果に基づいて、第１フィルタの時定数が補正（調整）される。このため、ヨーレートの変動を感度よく判定可能となる。また、自車のヨーイングや前方車のヨーイングにより、実際の前方車の位置と誤差を生じるが、前方車の検出位置は、角度が補正され、自車や前方車のヨーイングに原因する分の誤差が取り除かれ、前方車の適正な位置が得られる。

第２の発明においては、前方車の検出位置の距離および角度に基づく補正により、ヨーイングに原因する誤差を過不足なく取り除くことができる。

図１において、１０はトラックに搭載されるＡＣＣシステムの電子制御ユニット(ＡＣＣ-ＥＣＵ)であり、先行車との実車間距離を目標車間距離に維持するように車両の制駆動力を制御する車間距離制御系１１（追従走行制御系）を備える。１２はＡＣＣシステム１０の操作系であり、メインスイッチのほか、各種機能スイッチが配置される。１３はＡＣＣシステムの表示系であり、各種のＡＣＣ情報を表示する。１４は車間警報ブザーである。

１５はエンジンの電子制御ユニット（エンジン-ＥＣＵ）であり、１６はリターダの電子制御ユニット（リターダ-ＥＣＵ）であり、１７はトランスミッションの電子制御ユニット（Ｔ／Ｍ-ＥＣＵ）であり、１８は前方車との実車間距離を検出する車間距離レーダ装置であり、１９は車両の重心点回りの角速度（ヨーレート）を検出するヨーレートセンサであり、これらはＡＣＣ-ＥＣＵの車間距離制御系１１にＣＡＮバスを介して接続される。

エンジン-ＥＣＵ１５は、ＡＣＣ-ＥＣＵ１１からの車速指令に基づいて車速制御系が燃料噴射制御系の燃料噴射量およびエキゾーストブレーキのON-OFFを制御する。Ｔ／Ｍ-ＥＣＵ１７は、ＡＣＣ-ＥＣＵ１１から車速指令に基づいて車両の変速（クラッチの断続およびトランスミッションのギヤシフト）を制御する。リターダ-ＥＣＵ１６は、ＡＣＣ-ＥＣＵ１１からの車速指令に基づいてリターダのON-OFFを制御する。

図２は、レーダ装置１８の構成を説明する概要図であり、レーダ（ミリ波の送信部および受信部を備える）の受信情報から前方車の位置（距離，角度）情報を検出する手段２１、自車の車速とヨーレートとから自車進行路（進行方向の中心線の曲率）を推定する手段２３、自車進行路の中心線に与える水平方向の車線幅（設定値）を格納する手段２４、自車進行路の中心線と車線幅とから自車進行路の車線形状を設定する手段２５、前方車の位置情報に基づいて自車進行路の車線形状上の最も近い前方車を先行車（追従制御対象）と確定しつつその先行車の位置情報をＡＣＣユニット１１へ出力する手段２６、を備える。２７は自車の車速を検出する車速センサである。

図３は、車線形状の説明図であり、自車のヨーレートと車速とから自車進行路（進行方向の中心線）が推定され、この中心線（図４、参照）に水平方向の車線幅を与えることにより、自車進行路の車線形状（網掛領域）が設定される。左は直進走行時の車線形状であり、右は旋回走行時の車線形状である。車線幅（設定値）は、直進路の場合、進行方向に一律の設定となる。図示の旋回走行時においては、進行方向の中心線が湾曲するため、その接線と垂直に交わる方向の車線幅（図示せず）が水平方向の車線幅より小さくなるので、実際の走行路の車線幅との整合を取る上から、車線幅の変更手段（図のS9、参照）が備えられる。

車線幅の変更手段においては、図５の表のような車線幅変更マップが設定され、曲率半径（推定曲率の逆数）および前方車位置情報の距離に基づいて、自車進行路の中心線に与える水平方向の車線幅を変更するようになっている。図５において、各車線幅の中間値は、補間処理により求められる。直進路の車線幅として例示される数値が格納手段２４の設定値に該当する。

図４は、先行車確定方法の説明図であり、先行車は車線形状と前方車位置情報とから確定される、図４においては、３台の前方車がレーダにより捕捉され、○の２台の前方車については、車線形状上になく、先行車候補とならない。●の１台の前方車については、車線形状上にあるため、先行車候補となり、●の先行車候補は、１台のみのため、これが自車の追従走行すべき対象の先行車と確定されるのである。この先行車の位置情報はＡＣＣシステム１１へ出力され、車間距離制御系において、先行車との実車間距離を目標車間距離に保つように車両の制駆動力が制御される。

車線幅の変更手段（図のS9、参照）により、自車進行路の曲率半径および前方車位置情報の距離に応じて車線幅が変更されるので、旋回走行時においても、実際の走行路の車線幅との整合が取れ、自車が追従するべき先行車を適確に捕捉できるのである。

前方車位置情報は、自車のヨーイングや前方車のヨーイングにより、前方車の車体側面がミリ波の反射範囲に入ると、前方車の反射幅の中心が変位することになり、実際の前方車の位置と誤差を生じるため、その誤差を補正する手段３０（図２、参照）が備えられる。

補正手段３０においては、図６の表のような前方車位置情報補正マップが設定され、レーダの前方車位置情報（角度と距離）に対応するゲイン（補正係数）により、レーダの前方車角度情報を補正するようになっている。補正後の前方車角度情報＝レーダの前方車角度情報×ゲイン、となる。図６において、各ゲインの中間値は、補間処理により求められる。

図２において、３２はヨーレートに乗るノイズ（高周波成分）を除去（平滑化）する第１フィルタであり、３３は同じく第２フィルタであり、３４は第２フィルタ処理後のヨーレートの変動を演算する手段である。第１フィルタ３２は、演算手段３５からの入力（ヨーレートの変動の演算値）に基づいて、車両の操舵に伴うヨーレートの変動（低周波成分）の発生を判定すると、時定数を直進時よりも相対的に小さく補正する手段（図示せず）を備える。第２フィルタ３３の時定数は、所定の固定値に設定される。

第１フィルタにおいては、第２フィルタ処理後のヨーレートから車両の操舵に伴う変動（低周波成分）が判定されると、第１フィルタ３２の時定数が小さく補正される。このため、第１フィルタ３２の応答遅れが小さくなり、Ｓ字カーブ等においても、先行車を適確に捕捉することができる。第１フィルタ３２の直進時の時定数は、ヨーレートに乗るノイズの除去率を高めるため、大きく設定することが可能となるのである。

第２フィルタ３３の時定数を小さく設定することにより、ヨーレートの変動を感度よく判定可能となり、第１フィルタ３２の時定数の補正（調整）が早まるため、Ｓ字カーブ等においても、第１フィルタ処理後のヨーレートと車速の検出信号とから自車進行路の曲率を精度よく推定することができる。第１フィルタ３２のみの場合、直進時の時定数の設定が難しい。つまり、第２フィルタ３３を加えることにより、第１フィルタ３２において、ヨーレートの変動を感度よく判定しつつ、応答遅れも最小限に抑えることができる。また、第１フィルタ３２の時定数は、第２フィルタ３３の時定数が固定値のため、これを基準に設定しやすくなる。

３１はヨーレートセンサ１９の検出誤差（物理的な動作遅れを含む）を補正する手段である。ヨーレートセンサ１９の検出誤差は、ヨーレートの変動と比例的な関係があり、この例においては、図７の表のようなヨーレート補正マップが設定され、曲率半径（推定曲率の逆数）に対応するゲイン（補正係数）により、ヨーレートセンサ１９の検出誤差を第２フィルタ３３の応答遅れと共に補正するようになっている。補正後のヨーレート＝ヨーレートセンサの出力値×ゲイン、となる。図７において、各ゲインの中間値は、補間処理により求められる。

ヨーレートセンサ１９の検出誤差は、物理的な動作遅れ（応答遅れ）を含むので、直進走行中は、ノイズ（エンジン振動などによる高周波成分）に紛れる程度の検出誤差も、自車が旋回走行へ移行すると、これに伴って大きくなる。補正手段３１において、その誤差分が第２フィルタ３３の応答遅れと共に取り除かれるため、自車進行路の曲率を精度よく推定することができる。

図８は、レータ装置の制御内容を説明するフローチャートであり、所定の周期毎に実行される。S1においては、車速の検出信号を読み込む。S2においては、ヨーレートセンサ１９の検出信号を読み込む。S3においては、レーダの前方車位置情報を読み込む。

S4においては、車速センサ２７の検出情報と第２フィルタ処理後のヨーレートとから自車進行路の中心線の曲率を推定する。S5においては、図７のヨーレート補正マップに基づいて、曲率半径（S4の推定曲率の逆数）に対応するゲインにより、ヨーレートセンサの検出誤差を第２フィルタの応答遅れと共に補正する。S6においては、ヨーレート変動の演算値に基づいて、第１フィルタの時定数を調整（補正）するのである。

S7においては、車速の検出信号と第１フィルタ処理後のヨーレートとから自車進行方向の中心線の曲率を推定する。S8においては、図６の前方車位置情報補正マップに基づいて、前方車位置情報（角度，距離）に対応するゲインにより、前方車角度情報を補正する。

S9においては、自車進行方向の中心線に車線幅を与えることにより、自車進行路の車線形状を設定する。S10においては、図５の車線幅変更マップに基づいて、車線幅を自車進行路の曲率半径および前方車位置情報の距離に応じた変更を車線形状の車線幅に加える。S11においては、車線形状および前方車位置情報（前方車距離情報，補正後の前方車角度情報）に基づいて、自車進行路の車線形状上の最も近い前方車を所定の車間距離を保つべき対象の先行車と確定するのである。

このような制御により、Ｓ字カーブ等においても、自車が追走するべき先行車を適確に捕捉することができる。そのため、ＡＣＣシステムにおいて、信頼性の高い追従制御を実現することができる。

第２フィルタ３３により、第１フィルタ３２において、ヨーレートの変動を感度よく判定しつつ、応答遅れも最小限に抑えられる。第２フィルタ３３の応答遅れについては、ヨーレートセンサ１９の検出誤差と共に補正されるため、Ｓ字カーブ等においても、自車進行路の曲率を精度よく推定することができる。

前方車位置情報は、自車のヨーイングや前方車のヨーイングに原因する誤差が過不足なく補正されるため、Ｓ字カーブ等においても、車線幅の変更手段（図のS9）との相乗効果により、先行車を精度よく確定することができる。

尚、以上の説明では、実施形態をＡＣＣシステムを用いて説明したが、本発明はこれに限らず、先行車を認識する装置に適用可能である。

ＡＣＣシステムの構成を説明する概要図である レーダ装置の構成を説明するブロック図である。 車線形状の説明図である。 先行車の確定方法の説明図である。 車線幅変更マップを例示する表である。 前方車位置情報補正マップを例示する表である。 ヨーレート補正マップを例示する表である。 レーダ装置の制御内容を説明するフローチャートである。

符号の説明

１０ ＡＣＣシステム
１１ 車間距離制御系
１５ エンジン-ＥＣＵ
１７ Ｔ／Ｍ-ＥＣＵ
１８ レータ装置
１９ ヨーレートセンサ
２１ 前方車情報検出手段
２３ 自車進行路推定手段
２４ 車線幅設定手段
２５ 車線形状設定手段
２６ 先行車判定手段
２７ 車速センサ
３１ ヨーレート補正手段
３２ 第１フィルタ
３３ 第２フィルタ
３４ ヨーレート変動演算手段
３５ 自車進行路曲率推定手段

Claims (2)

1. 自車のヨーレートを検出するヨーレートセンサと、
   自車の車速を検出する車速センサと、
   自車の進行方向に沿う車線幅の設定値を格納する手段と、
   前記ヨーレートセンサの出力を平滑化して出力する第１フィルタと、
   前記第１フィルタの出力と前記車速センサの出力とから自車の進行方向に沿う曲率を推定する曲率推定手段と、
   前記ヨーレートセンサの出力を平滑化して出力する第２フィルタと、
   前記第２フィルタの出力から前記ヨーレートの変動を演算する手段と、
   前記変動演算手段の演算結果に基づいて前記第１フィルタの時定数を調整する手段と、
   前記曲率推定手段によって推定される曲率と前記車線幅の設定値とから自車進行路の車線形状を設定する手段と、
   前方車の位置を検出する手段と、
   前記前方車の検出位置の角度を補正する手段と、
   を備えることを特徴とする車載用レーダ装置。
2. 前記前方車の検出位置の角度を補正する手段は、前方車の検出位置の距離と角度をパラメータとしてこれらに対応するゲインを設定する手段と、前方車の角度＝検出角度×ゲインに補正する手段と、を備えることを特徴とする請求項１に記載の車載用レーダ装置。