先行車検出装置
【課題】従来に比して正確に先行車の位置を検出可能な先行車検出装置を提供する。
【解決手段】自車両の前方を走行する先行車の位置を検出する先行車検出装置であって、少なくとも先行車の左右方向の位置情報を検出する先行車位置検出手段と、現時点において検出した位置情報を補正するフィルタ補正手段と、先行車の走行状態を推定する先行車走行状態推定手段と、フィルタ補正手段による補正の度合いを、先行車走行状態推定手段によって推定された先行車の走行状態に応じて変更するフィルタ制御手段とを備える先行車検出装置である。
【解決手段】自車両の前方を走行する先行車の位置を検出する先行車検出装置であって、少なくとも先行車の左右方向の位置情報を検出する先行車位置検出手段と、現時点において検出した位置情報を補正するフィルタ補正手段と、先行車の走行状態を推定する先行車走行状態推定手段と、フィルタ補正手段による補正の度合いを、先行車走行状態推定手段によって推定された先行車の走行状態に応じて変更するフィルタ制御手段とを備える先行車検出装置である。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、先行車検出装置に関し、より特定的には、検出した先行車位置情報をフィルタ補正処理する先行車検出装置に関する。
【背景技術】
【０００２】
従来、衝突防止や追従走行等の自車両の走行制御を実行するために、先行車の位置を検出する先行車検出装置が開発されている。このような先行車検出装置の一種として、電磁波等の搬送波を車両の周囲に照射し、当該搬送波が先行車に反射して成る反射波を受信することによって当該先行車の位置を検出するレーダー装置が知られている。このようなレーダー装置は、反射波の周波数、位相、および強度などの情報に基づいて先行車の位置を検出する。
【０００３】
上記のようなレーダー装置によって先行車を継続的に追従検出する際、当該先行車における電磁波の照射箇所、すなわち反射する部材の形状や材質等が変化すると、同一先行車であっても反射波の情報が変化する場合がある。例えば、電磁波の照射箇所が樹脂製のバンパー、鋼板製のボディー、またはガラスの何れの部位で反射されるかによって反射波の情報が変化する。このような場合、例えば、実際には先行車が直進しており、横方向の位置が変化していない場合であっても、当該先行車が蛇行しているかのようにレーダー装置によって検出されてしまう場合がある。
【０００４】
上記のような問題を解決すべく開発された先行車検出装置の一例が、特許文献１に開示されている。特許文献１に開示されるレーダー装置は、物体を検出した場合、当該物体と過去の検出物との同一性を判定する。そして、レーダー装置は、検出した物体を過去にも検出していた場合、当該物体の現時点の検出位置を当該物体の過去の検出位置に応じて補正するフィルタリング処理を行う。具体的には、当該レーダー装置は、検出物の現時点の検出位置と、過去の検出位置とを重み付け加算した結果を現時点の検出位置として算出する。このような処理によれば、当該物体の検出位置がばらつくことを防ぐことができる。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２００１−１８３４５１号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
しかしながら、実際に検出物とレーダー装置との相対位置が変化している場合に上記のようなフィルタリング処理を実行すると、算出される検出物の位置の時間応答性が低下する虞があった。
【０００７】
例えば、レーダー装置が車線変更している先行車を検出している場合を想定する。ここで、レーダー装置は、上記のフィルタリング処理を実行することによって、検出した現時点の先行車の位置を過去の検出位置に近づけるように補正してしまう。その結果、レーダー装置が算出した先行車の位置は、実際の先行車の位置に比べて時間的に遅れた位置を示すようになる。したがって、例えば、実際には先行車が移動先の車線への移動を完了した時点において、レーダー装置では、先行車が未だに車線変更中であるものとして検出される場合がある。
【０００８】
そして、このような応答性の低下によって現時点における先行車の位置を正確に検出できない場合、当該位置情報を用いた自車両の走行制御を最適に実行できなくなる虞があった。
【０００９】
本発明は上記の課題を鑑みて成されたものであり、従来に比して正確に先行車の位置を検出可能とする先行車検出装置を提供することを目的とする。
【課題を解決するための手段】
【００１０】
上記の課題を解決するため、本願は以下の構成を採用した。すなわち、第１の発明は、自車両の前方を走行する先行車の位置を検出する先行車検出装置であって、少なくとも先行車の左右方向の位置情報を検出する先行車位置検出手段と、現時点において検出した位置情報を補正するフィルタ補正手段と、先行車の走行状態を推定する先行車走行状態推定手段と、フィルタ補正手段による補正の度合いを、先行車走行状態推定手段によって推定された先行車の走行状態に応じて変更するフィルタ制御手段とを備える先行車検出装置である。
【００１１】
第２の発明は、第１の発明において、先行車走行状態検出手段は、先行車が自車両が走行する自車走行車線から離脱中か否かを推定し、フィルタ制御手段は、先行車が自車走行車線から離脱中であると推定された場合、フィルタ補正手段による補正の度合いを先行車が自車走行車線から離脱中でないと推定された場合に比べて低くすることを特徴とする。
【００１２】
第３の発明は、第２の発明において、自車走行車線に隣接する隣接車線が有るか否かを推定する隣接車線推定手段をさらに備え、離脱推定手段は、少なくとも隣接車線が有ると推定された場合に、先行車が離脱中であると推定することを特徴とする。
【００１３】
第４の発明は、第２乃至３の何れか１つ発明において、自車両から自車両が走行する道路の路側物までの横方向の距離を路側物距離として検出する路側距離検出手段をさらに備え、隣接車線推定手段は、路側物距離に基づいて隣接車線の有無を推定することを特徴とする。
【００１４】
第５の発明は、第４の発明において、自車走行車線と隣接車線との境界位置を推定する車線境界位置推定手段をさらに備え、隣接車線推定手段は、隣接車線が存在すると仮定した場合の当該隣接車線の車線幅を路側物距離および境界位置に基づいて推定し、（Ａ）当該車線幅が所定の車線幅閾値以上である場合、隣接車線が有ると判定し、（Ｂ）当該車線幅が所定の車線幅閾値未満である場合、隣接車線が無いと判定することを特徴とする。
【００１５】
第６の発明は、第５の発明において、先行車までの距離が長いほど、車線幅閾値の大きさを大きな値に変更する閾値変更手段をさらに備えることを特徴とする。
【００１６】
第７の発明は、第３の発明において、自車両と並走する並走車を検出する並走車検出手段をさらに備え、隣接車線推定手段は、並走車を検出した場合、隣接車線が有ると判定することを特徴とする。
【００１７】
第８の発明は、第３乃至７の何れか１つの発明において、先行車位置検出手段により検出された位置情報を記憶する記憶手段をさらに備え、先行車が左右何れの方向へ移動しているかを現在および過去の位置情報に基づいて算出する移動方向算出手段をさらに備え、隣接車線推定手段は、先行車の移動方向側に隣接車線が有るか否かを判定し、フィルタ制御手段は、フィルタ補正手段による補正の度合いを、先行車の移動方向側に隣接車線が有るか否かに応じて変更することを特徴とする。
【００１８】
第９の発明は、第１乃至８の発明において、先行車位置検出手段により検出された位置情報を記憶する記憶手段をさらに備え、フィルタ補正手段は、現時点の位置情報と過去の位置情報とを各々所定のフィルタ係数に応じた重みを付けて加算することによって、当該現時点の位置情報を補正することを特徴とする。
【００１９】
第１０の発明は、第９の発明において、フィルタ制御手段は、隣接車線が有ると推定された場合、現時点の位置情報の重みが隣接車線が無いと推定された場合に比べて重くなるようフィルタ係数の値を変更することによって、当該補正の度合いを弱くするを特徴とする。
【発明の効果】
【００２０】
第１の発明によれば、フィルタ補正手段による補正の度合いを、先行車の走行状態に応じて変更することができる。したがって、例えば、フィルタ補正手段による補正の度合いに応じて先行車の位置情報の検出応答速度が変化する場合に、先行車の走行状態に応じて適切な補正を行い、適切な応答速度で当該先行車の位置を検出することができる。故に、先行車の位置を正確に検出することが可能である。
【００２１】
第２の発明によれば、先行車が自車走行車線から離脱中である場合に、フィルタ補正手段による補正の度合いを低くすることができる。したがって、先行車が自車走行車線から離脱中である場合、当該先行車の位置を応答性良く検出することができる。一方、先行車が自車走行車線を走行している間は、フィルタ補正手段による補正の度合いを低減することなく位置情報を補正し、当該位置情報のばらつきを低減することができる。
【００２２】
第３の発明によれば、先行車が自車走行車線から離脱中であるか否かを隣接車線の有無に応じて正確に判定することができる。隣接車線が存在しない場合には、先行車は車線変更ができないため、離脱中でないと想定される。したがって、隣接車線の有無を勘案することによって、先行車が自車走行車線から離脱中であるか否かを、より正確に判定することができるのである。
【００２３】
第４の発明によれば、路側物までの距離に基づいて隣接車線の有無を推定することができる。隣接車線が存在する場合には、前記自車両から前記自車両が走行する道路の路側物までの路側物距離が比較的長いと考えられる。したがって、路側物距離を用いることによって隣接車線の有無を容易に推定することができる。
【００２４】
第５の発明によれば、隣接車線の車線幅を推定することによって、隣接車線の有無を正確に推定することができる。
【００２５】
第６の発明によれば、隣接車線の有無をさらに正確に推定することができる。路側物距離は、自車両から遠方になるほど検出精度が低下する。すなわち、自車両から遠方になるほど、算出した隣接車線の車線幅に誤差が生じやすくなる。その点、第６の発明によれば、自車両から先行車までの距離に応じて車線幅閾値の値が設定されるため、このような誤差を許容して隣接車線の有無を推定することができる。
【００２６】
第７の発明によれば、並走車の有無に応じて容易に隣接車線の有無を推定することができる。自車両と並走する並走車が存在する場合、隣接車線が存在すると考えられるため、当該並走車を検出することによって隣接車線の有無を推定可能である。
【００２７】
第８の発明によれば、先行車の移動方向についてのみ隣接車線の有無を判定し、当該判定結果に応じてフィルタ補正手段による補正の度合いを変更することができる。したがって自車走行車線の両側について隣接車線の有無を推定する必要が無く、少ない処理量で上記の効果を得ることができる。
【００２８】
第９の発明によれば、先行車の位置情報がばらつくことを簡単な処理で防止することができる。例えば、直進している先行車を追従して継続的に検出している場合、反射箇所の変化等により先行車の横位置が瞬間的にずれて検出されたとしても、当該横位置を過去の横位置に近づけるように補正して検出位置とすることができる。
【００２９】
第１０の発明によれば、係数値を変更する簡単な処理で、容易に補正の度合いを変更することができる。
【図面の簡単な説明】
【００３０】
【図１】先行車検出装置１の構成を示すブロック図の一例
【図２】第１の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理の詳細を示すフローチャートの一例
【図３】マッピングされた先行車２００の位置情報を示すイメージ図
【図４】位置情報処理ＥＣＵ２０が実行する先行車離脱判定処理の詳細を示すフローチャートの一例
【図５】車線幅閾値テーブルの概念を示す図
【図６】先行車２００の実際の走行経路の一例を示す図
【図７】図６のように走行する先行車２００を先行車検出装置１および従来のレーダー装置によって検出した結果を示した図
【図８】第２の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理の詳細を示すフローチャートの一例
【発明を実施するための形態】
【００３１】
（第１の実施形態）
以下、本発明の第１の実施形態に係る先行車検出装置１について説明する。先行車検出装置１は、車両に搭載され、当該車両の前方を走行する先行車の位置情報を検出、および当該位置情報の補正処理を行う装置である。以下では、先行車検出装置１が自車両１００に搭載される例について説明する。
【００３２】
先ず、図１を参照して先行車検出装置１のハードウェア構成について説明する。なお、図１は、先行車検出装置１の構成を示すブロック図の一例である。図１に示すように。先行車検出装置は、レーダー装置１０、および位置情報処理ＥＣＵ２０を備える。
【００３３】
レーダー装置１０は、自車両１００の周囲の物体の位置情報を検出する装置である。レーダー装置１０は、典型的にはＦＭ−ＣＷ方式のミリ波レーダー装置である。レーダー装置１０は、位置情報処理ＥＣＵ２０と電気的に接続され、検出した物体の位置情報を位置情報処理ＥＣＵ２０へ送信する。レーダー装置１０は、例えば、フロントグリルやフロントバンパー等の自車両１００の前方に搭載され、自車両１００の前方および前側方の物体を検出する。
【００３４】
位置情報処理ＥＣＵ２０は、典型的には、ＣＰＵ（Central Processing Unit：中央処理装置）などの情報処理装置、メモリなどの記憶装置、およびインターフェース回路などを備える制御装置である。位置情報処理ＥＣＵ２０は、レーダー装置１０から受信した物体の位置情報を必要に応じてフィルタ補正処理し、最終的に得られた物体の位置情報を自車両１００に搭載された車両制御装置５０へ送信する。
【００３５】
車両制御装置５０は、自車両１００の走行を制御する装置である。車両制御装置５０は、例えば、位置情報処理ＥＣＵ２０から受信した検出物の位置情報に基づいて、当該検出物と自車両１００との衝突を予測し、当該衝突を回避すべく自車両１００のブレーキを自動的に動作させる。
【００３６】
次いで、図２を参照して、位置情報処理ＥＣＵ２０が実行する処理について説明する。図２は、第１の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理の詳細を示すフローチャートの一例である。位置情報処理ＥＣＵ２０は、自車両１００のＩＧ電源がオン状態に設定されると、図２のフローチャートの処理を実行する。位置情報処理ＥＣＵ２０は、図２のフローチャートの処理を開始すると、先ず、ステップＡ１の処理を実行する。
【００３７】
ステップＡ１において、位置情報処理ＥＣＵ２０は、先行車２００を検出したか否か判定する。位置情報処理ＥＣＵ２０は、例えば、レーダー装置１０から取得した物体の位置情報に基づいて、自車両１００の進行方向と同一方向へ所定の速度以上で移動する物体を自車両１００の前方において所定時間以上継続して検出した場合、当該物体を先行車２００として検出する。位置情報処理ＥＣＵ２０は、先行車２００を検出したと判定した場合、処理をステップＡ２へ進める。一方、位置情報処理ＥＣＵ２０は、先行車２００を検出していないと判定した場合、処理をステップＡ８へ進める。
【００３８】
なお、ステップＡ１において、位置情報処理ＥＣＵ２０は、検出した先行車２００の位置を、仮想空間上にマッピングする。例えば、位置情報処理ＥＣＵ２０は、図３に示すように、自車両１００を原点とし、自車両１００の進行方向を示す軸線をＹ軸、自車両１００の左右方向を示す軸線をＸ軸とする座標系に先行車２００の位置情報をマッピングする。なお、図３は、マッピングされた先行車２００の位置情報を示すイメージ図である。図３に示す通り、自車両１００から前方へ離れるほどＹ座標の値が大きくなり、自車両１００から見て右へ離れる程、Ｘ座標の値が大きくなる。以下では当該マップにおける先行車２００の横位置情報（Ｘ座標）を検出横位置Ｐ（ｎ）と呼称する。また、先行車２００の縦位置情報（Ｙ座標）を検出縦位置Ｑ（ｎ）と呼称する。なお、検出横位置Ｐ（ｎ）および検出縦位置Ｑ（ｎ）の添え字のｎは、現在時刻を表し、ｎ−１，ｎ−２，…は各々、１サンプリング時間前、２サンプリング時間前、…の時刻を示す。すなわち、Ｐ（ｎ）は、現時点の先行車２００の検出横位置を示し、Ｐ（ｎ−１）は、１サンプリング前の先行車２００の検出横位置を示す。また、上記の先行車２００の検出方法、およびマッピングの方法は一例であり、位置情報処理ＥＣＵ２０は、従来周知の任意の手法を用いてこれらの処理を行って構わない。
【００３９】
ステップＡ２において、位置情報処理ＥＣＵ２０は、先行車離脱判定処理を実行する。先行車離脱判定処理は、自車両１００の前方を走行する先行車２００が自車両１００の走行車線（以下、自車走行車線と呼称する）から離脱中であるか否かを推定する処理である。位置情報処理ＥＣＵ２０は、先行車離脱判定処理において、先行車が自車走行車線から離脱中であると推定した場合、離脱フラグをオン状態に設定し、先行車が自車走行車線から離脱中でないと推定した場合、離脱フラグをオフ状態に設定する。離脱フラグは、位置情報処理ＥＣＵ２０の記憶装置に記憶されるフラグデータである。以下、図４を参照し、先行車離脱判定処理の詳細について説明する。図４は、位置情報処理ＥＣＵ２０が実行する先行車離脱判定処理の詳細を示すフローチャートの一例である。位置情報処理ＥＣＵ２０は、先行車離脱判定処理を開始すると、先ず、ステップＡ２１の処理を実行する。
【００４０】
ステップＡ２１において、位置情報処理ＥＣＵ２０は、左隣接車線境界Ｌｔｈ＿Ｌおよび右隣接車線境界Ｌｔｈ＿Ｒを算出する。左隣接車線境界Ｌｔｈ＿Ｌは、自車走行車線と、自車走行車線の左側の隣接車線（以下、左隣接車線と呼称する）との境界線の推定位置である。右隣接車線境界Ｌｔｈ＿Ｒは、自車走行車線と、自車走行車線の右側の隣接車線（以下、右隣接車線と呼称する）との境界線の予想位置である。すなわち、左隣接車線境界Ｌｔｈ＿Ｌおよび右隣接車線境界Ｌｔｈ＿Ｒは、各々、自車走行車線の左端および右端の推定位置を示す。位置情報処理ＥＣＵ２０は、図２において示したＸＹ座標系において予め定められた関数ＦＬに基づいて左隣接車線境界Ｌｔｈ＿Ｌを、関数ＦＲに基づいて右隣接車線境界Ｌｔｈ＿Ｒを各々算出する。具体的には、位置情報処理ＥＣＵ２０は、ステップＡ１において検出した先行車２００の検出縦位置Ｑ（ｎ）を関数ＦＬへ入力して得られる出力値を左隣接車線境界Ｌｔｈ＿Ｌとして算出する。同様に位置情報処理ＥＣＵ２０は、ステップＡ１において検出した先行車２００の検出縦位置Ｑ（ｎ）を関数ＦＲへ入力して得られる出力値を右隣接車線境界Ｌｔｈ＿Ｒとして算出する。このような処理により、位置情報処理ＥＣＵ２０は、先行車２００の近傍における車線の境界位置を予測する。位置情報処理ＥＣＵ２０は、ステップＡ２１の処理を完了すると、処理をステップＡ２２へ進める。
【００４１】
ステップＡ２２において、位置情報処理ＥＣＵ２０は検出横位置Ｐ（ｎ）が自車走行車線外に存在するか否か推定する。具体的には、先ず、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）が左隣接車線境界Ｌｔｈ＿Ｌより外側（左隣接車線側）に存在するか否か判定する。より詳細には、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値より大きいか否かを式（１）に基づいて判定する。
｜Ｐ（ｎ）｜＞｜Ｌｔｈ＿Ｌ｜ …（１）
次いで、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）が右隣接車線境界Ｌｔｈ＿Ｒより外側（右隣接車線側）に存在するか否か判定する。具体的には、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の絶対値が右隣接車線境界Ｌｔｈ＿Ｒの絶対値より大きいか否かを式（２）に基づいて判定する。
｜Ｐ（ｎ）｜＞｜Ｌｔｈ＿Ｒ｜ …（２）
そして、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値より大きい場合、または、右隣接車線境界Ｌｔｈ＿Ｒの絶対値より大きい場合、検出横位置Ｐ（ｎ）が自車走行車線外に存在すると推定し、処理をステップＡ２３へ進める。一方、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値以下であり、且つ、右隣接車線境界Ｌｔｈ＿Ｒの絶対値以下である場合、検出横位置Ｐ（ｎ）が自車走行車線内に存在していると推定し、処理をステップＡ３１へ進める。
【００４２】
ステップＡ２３において、位置情報処理ＥＣＵ２０は、前回サンプリング時点の出力横位置Ｐｏｕｔ（ｎ−１）が自車走行車線内に存在していたか否か推定する。出力横位置Ｐｏｕｔ（ｎ）は、後述の位置情報処理ＥＣＵ２０の処理によって最終的に算出された先行車２００の横位置情報である。具体的には、先ず、位置情報処理ＥＣＵ２０は、前回の出力横位置Ｐｏｕｔ（ｎ−１）が左隣接車線境界Ｌｔｈ＿Ｌより内側（自車走行車線側）に存在するか否か判定する。より詳細には、位置情報処理ＥＣＵ２０は、前回の出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値より小さいか否かを式（３）に基づいて判定する。
｜Ｌｔｈ＿Ｌ｜＞Ｐｏｕｔ（ｎ−１） …（３）
次いで、位置情報処理ＥＣＵ２０は、前回の出力横位置Ｐｏｕｔ（ｎ−１）が右隣接車線境界Ｌｔｈ＿Ｒより内側（自車走行車線側）に存在するか否か判定する。具体的には、位置情報処理ＥＣＵ２０は、前回の出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が右隣接車線境界Ｌｔｈ＿Ｒの絶対値より小さいか否かを式（４）に基づいて判定する。
｜Ｌｔｈ＿Ｒ｜＞Ｐｏｕｔ（ｎ−１） …（４）
そして、位置情報処理ＥＣＵ２０は、前回サンプリング時点の出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値より小さく、且つ、出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が右隣接車線境界Ｌｔｈ＿Ｒの絶対値より小さい場合、前回サンプリング時点の出力横位置Ｐｏｕｔ（ｎ−１）が自車走行車線内に存在していたと推定し、処理をステップＡ２４へ進める。一方、位置情報処理ＥＣＵ２０は、出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値以上である場合、または、出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が右隣接車線境界Ｌｔｈ＿Ｒの絶対値以上である場合、出力横位置Ｐｏｕｔ（ｎ−１）が自車走行車線内に存在していなかったと推定し、処理をステップＡ３１へ進める。
【００４３】
上述ステップＡ２１からステップＡ２３の処理は、先行車が自車走行車線から隣接車線へ離脱しているか否かを先行車２００の位置情報に基づいて推定する処理である。過去に自車走行車線内に存在していた先行車２００の位置が、現時点において隣接車線へ移動している場合、先行車２００が自車走行車線から離脱中であると考えられる。このような観点から、位置情報処理ＥＣＵ２０は、ステップＡ２１からステップＡ２３を実行することによって先行車２００が自車走行車線から離脱中であるか否かを判定することができる。
【００４４】
ステップＡ２４において、位置情報処理ＥＣＵ２０は、先行車２００が自車走行車線から左右何れの方向へ離脱中であるか推定する。以下、先行車２００が離脱している方向を離脱方向と呼称する。例えば、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）が前回の出力横位置Ｐｏｕｔ（ｎ）より大きい場合、先行車２００が右方向へ離脱中であると推定し、検出横位置Ｐ（ｎ）が前回の出力横位置Ｐｏｕｔ（ｎ）より小さい場合、先行車２００が左方向へ離脱中であると推定する。ステップＡ２４の処理を完了すると、位置情報処理ＥＣＵ２０は、処理をステップＡ２５へ進める。
【００４５】
ステップＡ２５において、位置情報処理ＥＣＵ２０は、並走車を検出したか否か判定する。位置情報処理ＥＣＵ２０は、例えば、自車両１００の前側方を所定速度以上で自車両１００と同方向へ進行する物体を検出した場合、当該物体を並走車として検出する。なお、上記の手法は一例であり、位置情報処理ＥＣＵ２０は、従来周知の手法を用いて並走車を検出しても構わない。位置情報処理ＥＣＵ２０は、並走車を検出したと判定した場合、処理をステップＡ３０へ進める。一方、位置情報処理ＥＣＵ２０は、並走車を検出していないと判定した場合、処理をステップＡ２６へ進める。
【００４６】
上述ステップＡ２５の処理は、先行車２００が自車走行車線から隣接車線へ離脱中か否かを自車両１００の並走車の有無に基づいて推定する処理である。自車両１００の並走車が先行車２００の離脱方向側に存在する場合、先行車２００の移動先に隣接車線が存在すると考えられる。すなわち、先行車２００が自車走行車線から離脱可能であると考えられる。したがって、上記ステップＡ２５の処理によれば、位置情報処理ＥＣＵ２０は、自車走行車線から隣接車線へ離脱中か否かを、より正確に判定することができる。
【００４７】
ステップＡ２６において、位置情報処理ＥＣＵ２０は、路側物３００を検出したか否か判定する。具体的には、位置情報処理ＥＣＵ２０は、例えば、自車両１００から見て先行車２００の離脱方向側に、自車走行車線に沿って静止物を連続的に検出した場合、当該物体をガードレール等の路側物３００として検出する。例えば、図３に示すマップのＸ＝−８〜−６、Ｙ＝０〜１００の領域において静止物を連続して検出した場合、当該検出点を直線近似または曲線近似し、当該近似線を路側物３００として検出する。なお、上記の手法は一例であり、位置情報処理ＥＣＵ２０は従来周知の任意の手法を用いて路側物３００を検出および認識して構わない。位置情報処理ＥＣＵ２０は、路側物３００を検出したと判定した場合、処理をステップＡ２７へ進める。一方、位置情報処理ＥＣＵ２０は、路側物３００を検出していないと判定した場合、処理をステップＡ３１へ進める。
【００４８】
ステップＡ２７において、位置情報処理ＥＣＵ２０は、隣接車線幅Ｗを算出する。隣接車線幅Ｗは、先行車２００が離脱しようとしている隣接車線の幅を示す値である。具体的には、先ず、位置情報処理ＥＣＵ２０は、ステップＡ２６において検出した路側物３００の図３のマップにおけるＸ座標を路側物位置Ｌｇとして算出する。当該路側物位置Ｌｇは、自車両１００から路側物３００までの横方向の距離を示す値である。路側物３００までの横方向の距離は、次いで、位置情報処理ＥＣＵ２０は、路側物位置Ｌｇから路側物３００が存在する方向側の隣接車線境界の値を減算して隣接車線幅Ｗを算出する。例えば、先行車２００が自車走行車線から左側へ離脱中である場合、位置情報処理ＥＣＵ２０は、路側物位置Ｌｇから左隣接車線境界Ｌｔｈ＿Ｌの値を減算して隣接車線幅Ｗを算出する。位置情報処理ＥＣＵ２０は、ステップＡ２７の処理を完了すると、処理をステップＡ２８へ進める。
【００４９】
ステップＡ２８において、位置情報処理ＥＣＵ２０は、車線幅閾値Ｗｔｈを算出する。具体的には、位置情報処理ＥＣＵ２０は、検出縦位置Ｑ（ｎ）および車線幅閾値テーブルに基づいて車線幅閾値Ｗｔｈを算出する。車線幅閾値テーブルは、車線幅閾値Ｗｔｈと検出縦位置Ｑ（ｎ）との関係を示すデータテーブルである。図５は、車線幅閾値テーブルの概念を示す図である。図５に示すように、車線幅閾値テーブルは、列毎に検出縦位置Ｑ（ｎ）および車線幅閾値Ｗｔｈの値が各々並べられたテーブルである。当該テーブルにおいて、１列目には検出縦位置Ｑ（ｎ）の値が示され、２列目には各検出縦位置Ｑ（ｎ）の値と対応する車線幅閾値Ｗｔｈの値が示される。位置情報処理ＥＣＵ２０は、車線幅閾値テーブルの１列目において、ステップＡ１２において取得した検出縦位置Ｑ（ｎ）の値に対応する行を探索する。そして、位置情報処理ＥＣＵ２０は、探索した行と同じ行の２列目に記された車線幅閾値Ｗｔｈの値を検出縦位置Ｑ（ｎ）に対応する車線幅閾値Ｗｔｈの値として算出する。そして、図５に示す車線幅閾値テーブルによれば、検出縦位置Ｑ（ｎ）が大きいほど車線幅閾値Ｗｔｈの値が大きな値として算出される。位置情報処理ＥＣＵ２０は、ステップＡ２８の処理を完了すると、処理をステップＡ２９へ進める。
【００５０】
ステップＡ２９において、位置情報処理ＥＣＵ２０は、隣接車線幅Ｗが車線幅閾値Ｗｔｈ以上か否か判定する。位置情報処理ＥＣＵ２０は、隣接車線幅Ｗが車線幅閾値Ｗｔｈ以上であると判定した場合、処理をステップＡ３０へ進める。一方、位置情報処理ＥＣＵ２０は、隣接車線幅Ｗが車線幅閾値Ｗｔｈより小さいと判定した場合、処理をステップＡ３１へ進める。
【００５１】
上述ステップＡ２６からステップＡ２９の処理は、先行車２００が自車走行車線から隣接車線へ離脱しているか否かを路側物３００の位置情報に基づいて推定する処理である。自車両１００から路側物３００までの横方向の距離が比較的短い場合、すなわち、隣接車線幅が比較的狭い場合、隣接車線が存在していないと考えられる。そして、隣接車線が存在しない場合には、仮に上述ステップＡ２１からステップＡ２３の処理において先行車２００が隣接車線へ移動していると推定されていたとしても、実際には先行車２００は隣接車線へ移動不可能であるから、当該先行車２００は自車走行車線から離脱していないと考えられる。このような観点から、位置情報処理ＥＣＵ２０は、上述ステップＡ２６からステップＡ２９の処理を実行することによって、先行車２００が自車走行車線から離脱しているか否かをより正確に推定することができる。
【００５２】
また、上記ステップＡ２４からステップＡ２９の処理では、先行車２００の離脱方向側についてのみ隣接車線の有無を推定するため、離脱方向と逆側の隣接車線については、その有無を推定しなくて良い。すなわち、これらの処理によれば位置情報処理ＥＣＵ２０の処理量を低減することが可能である。なお、このような処理量の低減が不要である場合は、位置情報処理ＥＣＵ２０は、自車走行車線の両側について隣接車線の有無を推定して構わない。
【００５３】
ステップＡ３０において、位置情報処理ＥＣＵ２０は、離脱フラグをオン状態に設定する。離脱フラグは、上述の通り、オン状態である場合に先行車２００が自車走行車線から離脱中であることを示すフラグデータである。位置情報処理ＥＣＵ２０は、ステップＡ３０の処理を完了すると、処理をステップＡ図２のステップＡ３へ進める。
【００５４】
ステップＡ３１において、位置情報処理ＥＣＵ２０は、離脱フラグをオフ状態に設定する。位置情報処理ＥＣＵ２０は、ステップＡ３１の処理を完了すると、処理を図２のステップＡ３へ進める。
【００５５】
なお、上述ステップＡ２６からステップＡ２９までの処理では、位置情報処理ＥＣＵ２０が、先行車２００が自車走行車線から離脱中であるか否かを、路側物位置Ｌｇに基づいて算出した隣接車線幅Ｗの値に応じて判定する例について説明したが、位置情報処理ＥＣＵ２０は、先行車２００が自車走行車線から離脱中であるか否かを路側物位置Ｌｇの大きさに応じて直接的に判定しても構わない。例えば、位置情報処理ＥＣＵ２０は、路側物位置Ｌｇが予め定められた閾値以上である場合、離脱フラグをオン状態に設定し、路側物位置Ｌｇが予め定められた閾値未満である場合、離脱フラグをオフ状態に設定しても構わない。このような処理によれば、位置情報処理ＥＣＵ２０は、隣接車線幅Ｗを算出する処理を省略することができるので、比較的少ない処理量で先行車２００が自車走行車線から離脱中であるか否かを判定することができる。
【００５６】
図２の説明に戻り、ステップＡ３において、位置情報処理ＥＣＵ２０は、離脱フラグがオン状態であるか否か判定する。位置情報処理ＥＣＵ２０は、離脱フラグがオン状態であると判定した場合、処理をステップＡ４へ進める。一方、位置情報処理ＥＣＵ２０は、離脱フラグがオフ状態であると判定した場合、処理をステップＡ５へ進める。
【００５７】
ステップＡ４において、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の値を出力横位置Ｐｏｕｔ（ｎ）として設定する。出力横位置Ｐｏｕｔ（ｎ）は、最終的に先行車検出装置１から車両制御装置５０へ出力される先行車の横位置情報である。位置情報処理ＥＣＵ２０は、ステップＡ４の処理を完了すると、処理をステップＡ７へ進める。
【００５８】
ステップＡ５において、位置情報処理ＥＣＵ２０は、フィルタ処理を実行する。具体的には、位置情報処理ＥＣＵ２０は、式（５）に示すように、現時点の検出横位置Ｐ（ｎ）と過去の出力横位置Ｐｏｕｔ（ｎ−１）とを各々フィルタ係数ｋに応じた重みを付けて加算することによって、フィルタ補正位置Ｐｆｔ（ｎ）を算出する。
Ｐｆｔ（ｎ）＝（１−ｋ）×Ｐｏｕｔ（ｎ―１）＋ｋ×Ｐ（ｎ） …（５）
なお、第１の実施形態においては、フィルタ係数ｋの値は位置情報処理ＥＣＵ２０の記憶装置に予め記憶された任意の定数とする。位置情報処理ＥＣＵ２０は、ステップＡ５の処理を完了すると、処理をステップＡ６へ進める。
【００５９】
ステップＡ６において、位置情報処理ＥＣＵ２０は、フィルタ補正位置Ｐｆｔ（ｎ）の値を出力横位置Ｐｏｕｔ（ｎ）として設定する。位置情報処理ＥＣＵ２０は、ステップＡ６の処理を完了すると、処理をステップＡ７へ進める。
【００６０】
ステップＡ７において、位置情報処理ＥＣＵ２０は、Ｐｏｕｔ（ｎ）を出力する。位置情報処理ＥＣＵ２０は、ステップＡ７の処理を完了すると、処理をステップＡ８へ進める。
【００６１】
ステップＡ８において、位置情報処理ＥＣＵ２０は、ＩＧ電源がオフに設定されたか否か判定する。位置情報処理ＥＣＵ２０は、ＩＧ電源がオフに設定されたと判定した場合、図２のフローチャートの処理を終了する。一方、位置情報処理ＥＣＵ２０は、ＩＧ電源がオン状態であると判定した場合、処理をステップＡ１へ戻す。
【００６２】
上記に示した位置情報処理ＥＣＵ２０の処理によれば、先行車２００が自車走行車線から離脱中であると推定された場合、フィルタ補正処理をしていない検出横位置Ｐ（ｎ）の値がそのまま出力横位置Ｐｏｕｔ（ｎ）として車両制御装置５０へ出力される。一方、先行車２００が自車走行車線から離脱中でないと推定された場合、フィルタ補正処理後のフィルタ補正位置Ｐｆｔ（ｎ）の値が出力横位置Ｐｏｕｔ（ｎ）として車両制御装置５０へ出力される。
【００６３】
次いで、図６および図７を参照して、上述の先行車検出装置１によって先行車２００の位置が好適に検出される様子について説明する。以下、先行車２００が、自車走行車線から左側の隣接車線へ離脱して走行する場合を例として説明する。
【００６４】
図６は、先行車２００の実際の走行経路の一例を示す図である。図６に示すように、先行車２００は、時刻ｔ１から時刻ｔ３にかけて自車走行車線を直進し、時刻ｔ３から時刻ｔ５にかけて隣接車線へ車線変更し、時刻ｔ５から時刻ｔ６にかけて隣接車線を直進する。
【００６５】
図７は、図６のように走行する先行車２００を先行車検出装置１および従来のレーダー装置によって検出した結果を示した図である。図７に示すように、ステップＡ５のようなフィルタ補正処理を実行しない従来のレーダー装置によって先行車２００を検出した場合、時刻ｔ３、および時刻ｔ６の時点のように実際の先行車２００の位置に対してずれた位置に先行車２００が存在するものとして検出してしまう（図７中、菱形プロット参照）。
【００６６】
ステップＡ５のようなフィルタ補正処理を常時実行する従来のレーダー装置によって先行車２００を検出した場合、フィルタ補正処理により時刻ｔ３および時刻ｔ６の時点における検出位置のばらつきを抑制することができるため、先行車２００が直進している間は、上述フィルタ補正処理を実行しない従来のレーダー装置に比べて先行車２００の位置を正確に検出することができる。しかしながら、フィルタ補正処理を常時実行する従来のレーダー装置は、先行車２００が車線変更を行っている間にもフィルタ補正処理を実行するため、この間、現時点の検出横位置を前回の検出横位置方向へずらしてしまう。そのため、フィルタ補正処理を常時実行する従来のレーダー装置は、時刻ｔ４から時刻ｔ６にかけて、実際の先行車２００の位置に対して時間的にずれた位置に当該先行車２００が存在するものとして検出してしまう（図７中、正方形プロット参照）。
【００６７】
一方、本発明に係る先行車検出装置１によれば、先行車２００が直進している間はフィルタ補正処理後のフィルタ補正位置Ｐｆｔ（ｎ）の値を出力値とするため、時刻ｔ３および時刻ｔ６の時点における検出位置のばらつきを抑制することができる。また、先行車検出装置１は、先行車２００が車線変更を行っている間はフィルタ補正処理を行っていない検出横位置Ｐ（ｎ）を出力値とするため、時刻ｔ４から時刻ｔ６にかけて高い応答性で先行車２００の横位置を正確に検出することが可能である。
【００６８】
以上に示した通り、本発明の第１の実施形態に係る先行車検出装置１によれば、フィルタ補正処理による補正の度合いを、先行車２００の走行状態に応じて変更することができる。したがって、先行車２００の走行状態に応じて適切な応答速度で当該先行車の位置を検出し、先行車の位置を正確に検出することが可能である。
【００６９】
なお、上記第１の実施形態では、先行車が自車走行車線から離脱していないと判定された場合にのみフィルタ処理を実行する例について説明したが、位置情報処理ＥＣＵ２０はステップＡ３の判定内容に関わらず、先行車の位置を検出する毎にフィルタ処理を実行しても構わない。すなわち、位置情報処理ＥＣＵ２０は、ステップＡ５の処理を、例えばステップＡ１の処理後、ステップＡ２の処理前に実行しても構わない。このような処理を行う場合、位置情報処理ＥＣＵ２０は、ステップＡ３において先行車が離脱していないと判定した際に処理をステップＡ６へ進める。位置情報処理ＥＣＵ２０は、このような処理を行った場合においても、先行車２００が自車走行車線から離脱しているか否かに応じてＰ（ｎ）の値、またはＰｆｔ（ｎ）の値を適宜選択してＰｏｕｔ（ｎ）の値を決定することが可能である。
【００７０】
（第２の実施形態）
上記第１の実施形態では、位置情報処理ＥＣＵ２０が、先行車２００が自車走行車線から離脱するか否かに応じてフィルタ補正処理の実行／停止状態を制御する例について説明したが、位置情報処理ＥＣＵ２０は、先行車２００が自車走行車線から離脱するか否かに応じてフィルタ補正処理の補正の度合いを変更しつつ、常時フィルタ補正処理を実行する制御を行っても構わない。以下、第２の実施形態に係る先行車検出装置について説明する。なお、第２の実施形態に係る先行車検出装置のハードウェア構成は図１に示す第１の実施形態と同様であるため、詳細な説明を省略する。
【００７１】
以下、第２の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理について図８を参照して説明する。なお、図８は、第２の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理の詳細を示すフローチャートの一例である。図８に示す処理において、図２と同様の処理を行うステップについては同様の符号を付し、詳細な説明を省略する。
【００７２】
位置情報処理ＥＣＵ２０は、図８の処理を開始すると、図２と同様にステップＡ１からステップＡ３の処理を実行する。ここで、第２の実施形態に係る位置情報処理ＥＣＵ２０は、ステップＡ３において離脱フラグがオン状態であると判定した場合、処理をステップＢ２へ進める。一方、位置情報処理ＥＣＵ２０は、離脱フラグがオフ状態であると判定した場合、処理をステップＢ１へ進める。
【００７３】
ステップＢ１において位置情報処理ＥＣＵ２０は、フィルタ係数ｋの値を通常値αに設定する。通常値αは、位置情報処理ＥＣＵ２０の記憶装置に予め記憶された任意の定数である。位置情報処理ＥＣＵ２０は、ステップＢ１の処理を完了すると、処理をステップＡ５へ進める。
【００７４】
ステップＢ２において位置情報処理ＥＣＵ２０は、フィルタ係数ｋの値を変更値βに設定する。変更値βは、位置情報処理ＥＣＵ２０の記憶装置に予め記憶された任意の定数である。位置情報処理ＥＣＵ２０は、ステップＢ２の処理を完了すると、処理をステップＡ５へ進める。
【００７５】
上記第２の実施形態に係る位置情報処理ＥＣＵ２０によれば、先行車２００が自車走行車線から離脱している場合、フィルタ係数ｋの大きさを先行車２００が自車走行車線から離脱していない場合に比べて小さな値に変更される。すなわち、先行車２００が自車走行車線から離脱している場合、過去の出力横位置Ｐｏｕｔ（ｎ−１）より現時点の検出横位置Ｐ（ｎ）の重みを比較的大きくして、フィルタ補正位置Ｐｆｔ（ｎ）を算出することができる。つまり、第２の実施形態に係る位置情報処理ＥＣＵ２０は、先行車２００が自車走行車線から離脱中である場合、先行車２００が自車走行車線から離脱中でない場合に比べてフィルタ補正の度合いを弱くし、応答性を高くすることができる。
【００７６】
以上に示した通り、第２の実施形態に係る先行車検出装置によれば、第１の実施形態と同様に、先行車２００が自車走行車線から離脱中であるか否かに応じてフィルタ補正処理を制御し、先行車２００の位置を正確に検出することができる。また、第２の実施形態に係る先行車検出装置によれば、先行車２００が自車走行車線から離脱している間、完全にフィルタ補正処理を停止することなく、所定の度合いでフィルタ補正処理の効果を得ることが可能である。
【００７７】
なお、上記各実施形態では、位置情報処理ＥＣＵ２０が、先行車２００が自車走行車線から隣接車線へ離脱中にフィルタ補正処理を抑制する例について説明したが、位置情報処理ＥＣＵ２０は、先行車２００が隣接車線から自車走行車線へ進入している際にフィルタ補正処理を抑制する制御を行っても構わない。例えば、位置情報処理ＥＣＵ２０は、過去に隣接車線に存在していた先行車２００の位置が、現時点において自車走行車線内へ移動している場合にフィルタ補正処理を抑制しても構わない。また、位置情報処理ＥＣＵ２０は、先行車２００が自車両１００から見て左右方向に移動している場合に、フィルタ補正処理を抑制して構わない。
【００７８】
また、上記各実施形態では、レーダー装置１０によって先行車２００の位置および路側物３００の位置を検出する例について説明したが、自車両の周囲の物体の位置情報を検出可能な装置であれば、レーダー装置に限らず任意の装置を用いて先行車２００の位置および路側物３００の位置を検出しても構わない。例えば、本発明に係る先行車検出装置は、レーダー装置１０の代わりにカメラ装置を搭載する構成としても構わない。このような構成とした先行車検出装置によっても、位置情報処理ＥＣＵ２０が実行する処理によって上述と同様の効果を得ることが可能である。
【産業上の利用可能性】
【００７９】
本発明に係る先行車検出装置は、従来に比して正確に先行車の位置を検出可能な先行車検出装置などとして有用である。
【符号の説明】
【００８０】
１ 先行車検出装置
１０ レーダー装置
２０ 位置情報処理ＥＣＵ
５０ 車両制御装置
１００ 自車両
２００ 先行車
３００ 路側物
【技術分野】
【０００１】
本発明は、先行車検出装置に関し、より特定的には、検出した先行車位置情報をフィルタ補正処理する先行車検出装置に関する。
【背景技術】
【０００２】
従来、衝突防止や追従走行等の自車両の走行制御を実行するために、先行車の位置を検出する先行車検出装置が開発されている。このような先行車検出装置の一種として、電磁波等の搬送波を車両の周囲に照射し、当該搬送波が先行車に反射して成る反射波を受信することによって当該先行車の位置を検出するレーダー装置が知られている。このようなレーダー装置は、反射波の周波数、位相、および強度などの情報に基づいて先行車の位置を検出する。
【０００３】
上記のようなレーダー装置によって先行車を継続的に追従検出する際、当該先行車における電磁波の照射箇所、すなわち反射する部材の形状や材質等が変化すると、同一先行車であっても反射波の情報が変化する場合がある。例えば、電磁波の照射箇所が樹脂製のバンパー、鋼板製のボディー、またはガラスの何れの部位で反射されるかによって反射波の情報が変化する。このような場合、例えば、実際には先行車が直進しており、横方向の位置が変化していない場合であっても、当該先行車が蛇行しているかのようにレーダー装置によって検出されてしまう場合がある。
【０００４】
上記のような問題を解決すべく開発された先行車検出装置の一例が、特許文献１に開示されている。特許文献１に開示されるレーダー装置は、物体を検出した場合、当該物体と過去の検出物との同一性を判定する。そして、レーダー装置は、検出した物体を過去にも検出していた場合、当該物体の現時点の検出位置を当該物体の過去の検出位置に応じて補正するフィルタリング処理を行う。具体的には、当該レーダー装置は、検出物の現時点の検出位置と、過去の検出位置とを重み付け加算した結果を現時点の検出位置として算出する。このような処理によれば、当該物体の検出位置がばらつくことを防ぐことができる。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２００１−１８３４５１号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
しかしながら、実際に検出物とレーダー装置との相対位置が変化している場合に上記のようなフィルタリング処理を実行すると、算出される検出物の位置の時間応答性が低下する虞があった。
【０００７】
例えば、レーダー装置が車線変更している先行車を検出している場合を想定する。ここで、レーダー装置は、上記のフィルタリング処理を実行することによって、検出した現時点の先行車の位置を過去の検出位置に近づけるように補正してしまう。その結果、レーダー装置が算出した先行車の位置は、実際の先行車の位置に比べて時間的に遅れた位置を示すようになる。したがって、例えば、実際には先行車が移動先の車線への移動を完了した時点において、レーダー装置では、先行車が未だに車線変更中であるものとして検出される場合がある。
【０００８】
そして、このような応答性の低下によって現時点における先行車の位置を正確に検出できない場合、当該位置情報を用いた自車両の走行制御を最適に実行できなくなる虞があった。
【０００９】
本発明は上記の課題を鑑みて成されたものであり、従来に比して正確に先行車の位置を検出可能とする先行車検出装置を提供することを目的とする。
【課題を解決するための手段】
【００１０】
上記の課題を解決するため、本願は以下の構成を採用した。すなわち、第１の発明は、自車両の前方を走行する先行車の位置を検出する先行車検出装置であって、少なくとも先行車の左右方向の位置情報を検出する先行車位置検出手段と、現時点において検出した位置情報を補正するフィルタ補正手段と、先行車の走行状態を推定する先行車走行状態推定手段と、フィルタ補正手段による補正の度合いを、先行車走行状態推定手段によって推定された先行車の走行状態に応じて変更するフィルタ制御手段とを備える先行車検出装置である。
【００１１】
第２の発明は、第１の発明において、先行車走行状態検出手段は、先行車が自車両が走行する自車走行車線から離脱中か否かを推定し、フィルタ制御手段は、先行車が自車走行車線から離脱中であると推定された場合、フィルタ補正手段による補正の度合いを先行車が自車走行車線から離脱中でないと推定された場合に比べて低くすることを特徴とする。
【００１２】
第３の発明は、第２の発明において、自車走行車線に隣接する隣接車線が有るか否かを推定する隣接車線推定手段をさらに備え、離脱推定手段は、少なくとも隣接車線が有ると推定された場合に、先行車が離脱中であると推定することを特徴とする。
【００１３】
第４の発明は、第２乃至３の何れか１つ発明において、自車両から自車両が走行する道路の路側物までの横方向の距離を路側物距離として検出する路側距離検出手段をさらに備え、隣接車線推定手段は、路側物距離に基づいて隣接車線の有無を推定することを特徴とする。
【００１４】
第５の発明は、第４の発明において、自車走行車線と隣接車線との境界位置を推定する車線境界位置推定手段をさらに備え、隣接車線推定手段は、隣接車線が存在すると仮定した場合の当該隣接車線の車線幅を路側物距離および境界位置に基づいて推定し、（Ａ）当該車線幅が所定の車線幅閾値以上である場合、隣接車線が有ると判定し、（Ｂ）当該車線幅が所定の車線幅閾値未満である場合、隣接車線が無いと判定することを特徴とする。
【００１５】
第６の発明は、第５の発明において、先行車までの距離が長いほど、車線幅閾値の大きさを大きな値に変更する閾値変更手段をさらに備えることを特徴とする。
【００１６】
第７の発明は、第３の発明において、自車両と並走する並走車を検出する並走車検出手段をさらに備え、隣接車線推定手段は、並走車を検出した場合、隣接車線が有ると判定することを特徴とする。
【００１７】
第８の発明は、第３乃至７の何れか１つの発明において、先行車位置検出手段により検出された位置情報を記憶する記憶手段をさらに備え、先行車が左右何れの方向へ移動しているかを現在および過去の位置情報に基づいて算出する移動方向算出手段をさらに備え、隣接車線推定手段は、先行車の移動方向側に隣接車線が有るか否かを判定し、フィルタ制御手段は、フィルタ補正手段による補正の度合いを、先行車の移動方向側に隣接車線が有るか否かに応じて変更することを特徴とする。
【００１８】
第９の発明は、第１乃至８の発明において、先行車位置検出手段により検出された位置情報を記憶する記憶手段をさらに備え、フィルタ補正手段は、現時点の位置情報と過去の位置情報とを各々所定のフィルタ係数に応じた重みを付けて加算することによって、当該現時点の位置情報を補正することを特徴とする。
【００１９】
第１０の発明は、第９の発明において、フィルタ制御手段は、隣接車線が有ると推定された場合、現時点の位置情報の重みが隣接車線が無いと推定された場合に比べて重くなるようフィルタ係数の値を変更することによって、当該補正の度合いを弱くするを特徴とする。
【発明の効果】
【００２０】
第１の発明によれば、フィルタ補正手段による補正の度合いを、先行車の走行状態に応じて変更することができる。したがって、例えば、フィルタ補正手段による補正の度合いに応じて先行車の位置情報の検出応答速度が変化する場合に、先行車の走行状態に応じて適切な補正を行い、適切な応答速度で当該先行車の位置を検出することができる。故に、先行車の位置を正確に検出することが可能である。
【００２１】
第２の発明によれば、先行車が自車走行車線から離脱中である場合に、フィルタ補正手段による補正の度合いを低くすることができる。したがって、先行車が自車走行車線から離脱中である場合、当該先行車の位置を応答性良く検出することができる。一方、先行車が自車走行車線を走行している間は、フィルタ補正手段による補正の度合いを低減することなく位置情報を補正し、当該位置情報のばらつきを低減することができる。
【００２２】
第３の発明によれば、先行車が自車走行車線から離脱中であるか否かを隣接車線の有無に応じて正確に判定することができる。隣接車線が存在しない場合には、先行車は車線変更ができないため、離脱中でないと想定される。したがって、隣接車線の有無を勘案することによって、先行車が自車走行車線から離脱中であるか否かを、より正確に判定することができるのである。
【００２３】
第４の発明によれば、路側物までの距離に基づいて隣接車線の有無を推定することができる。隣接車線が存在する場合には、前記自車両から前記自車両が走行する道路の路側物までの路側物距離が比較的長いと考えられる。したがって、路側物距離を用いることによって隣接車線の有無を容易に推定することができる。
【００２４】
第５の発明によれば、隣接車線の車線幅を推定することによって、隣接車線の有無を正確に推定することができる。
【００２５】
第６の発明によれば、隣接車線の有無をさらに正確に推定することができる。路側物距離は、自車両から遠方になるほど検出精度が低下する。すなわち、自車両から遠方になるほど、算出した隣接車線の車線幅に誤差が生じやすくなる。その点、第６の発明によれば、自車両から先行車までの距離に応じて車線幅閾値の値が設定されるため、このような誤差を許容して隣接車線の有無を推定することができる。
【００２６】
第７の発明によれば、並走車の有無に応じて容易に隣接車線の有無を推定することができる。自車両と並走する並走車が存在する場合、隣接車線が存在すると考えられるため、当該並走車を検出することによって隣接車線の有無を推定可能である。
【００２７】
第８の発明によれば、先行車の移動方向についてのみ隣接車線の有無を判定し、当該判定結果に応じてフィルタ補正手段による補正の度合いを変更することができる。したがって自車走行車線の両側について隣接車線の有無を推定する必要が無く、少ない処理量で上記の効果を得ることができる。
【００２８】
第９の発明によれば、先行車の位置情報がばらつくことを簡単な処理で防止することができる。例えば、直進している先行車を追従して継続的に検出している場合、反射箇所の変化等により先行車の横位置が瞬間的にずれて検出されたとしても、当該横位置を過去の横位置に近づけるように補正して検出位置とすることができる。
【００２９】
第１０の発明によれば、係数値を変更する簡単な処理で、容易に補正の度合いを変更することができる。
【図面の簡単な説明】
【００３０】
【図１】先行車検出装置１の構成を示すブロック図の一例
【図２】第１の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理の詳細を示すフローチャートの一例
【図３】マッピングされた先行車２００の位置情報を示すイメージ図
【図４】位置情報処理ＥＣＵ２０が実行する先行車離脱判定処理の詳細を示すフローチャートの一例
【図５】車線幅閾値テーブルの概念を示す図
【図６】先行車２００の実際の走行経路の一例を示す図
【図７】図６のように走行する先行車２００を先行車検出装置１および従来のレーダー装置によって検出した結果を示した図
【図８】第２の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理の詳細を示すフローチャートの一例
【発明を実施するための形態】
【００３１】
（第１の実施形態）
以下、本発明の第１の実施形態に係る先行車検出装置１について説明する。先行車検出装置１は、車両に搭載され、当該車両の前方を走行する先行車の位置情報を検出、および当該位置情報の補正処理を行う装置である。以下では、先行車検出装置１が自車両１００に搭載される例について説明する。
【００３２】
先ず、図１を参照して先行車検出装置１のハードウェア構成について説明する。なお、図１は、先行車検出装置１の構成を示すブロック図の一例である。図１に示すように。先行車検出装置は、レーダー装置１０、および位置情報処理ＥＣＵ２０を備える。
【００３３】
レーダー装置１０は、自車両１００の周囲の物体の位置情報を検出する装置である。レーダー装置１０は、典型的にはＦＭ−ＣＷ方式のミリ波レーダー装置である。レーダー装置１０は、位置情報処理ＥＣＵ２０と電気的に接続され、検出した物体の位置情報を位置情報処理ＥＣＵ２０へ送信する。レーダー装置１０は、例えば、フロントグリルやフロントバンパー等の自車両１００の前方に搭載され、自車両１００の前方および前側方の物体を検出する。
【００３４】
位置情報処理ＥＣＵ２０は、典型的には、ＣＰＵ（Central Processing Unit：中央処理装置）などの情報処理装置、メモリなどの記憶装置、およびインターフェース回路などを備える制御装置である。位置情報処理ＥＣＵ２０は、レーダー装置１０から受信した物体の位置情報を必要に応じてフィルタ補正処理し、最終的に得られた物体の位置情報を自車両１００に搭載された車両制御装置５０へ送信する。
【００３５】
車両制御装置５０は、自車両１００の走行を制御する装置である。車両制御装置５０は、例えば、位置情報処理ＥＣＵ２０から受信した検出物の位置情報に基づいて、当該検出物と自車両１００との衝突を予測し、当該衝突を回避すべく自車両１００のブレーキを自動的に動作させる。
【００３６】
次いで、図２を参照して、位置情報処理ＥＣＵ２０が実行する処理について説明する。図２は、第１の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理の詳細を示すフローチャートの一例である。位置情報処理ＥＣＵ２０は、自車両１００のＩＧ電源がオン状態に設定されると、図２のフローチャートの処理を実行する。位置情報処理ＥＣＵ２０は、図２のフローチャートの処理を開始すると、先ず、ステップＡ１の処理を実行する。
【００３７】
ステップＡ１において、位置情報処理ＥＣＵ２０は、先行車２００を検出したか否か判定する。位置情報処理ＥＣＵ２０は、例えば、レーダー装置１０から取得した物体の位置情報に基づいて、自車両１００の進行方向と同一方向へ所定の速度以上で移動する物体を自車両１００の前方において所定時間以上継続して検出した場合、当該物体を先行車２００として検出する。位置情報処理ＥＣＵ２０は、先行車２００を検出したと判定した場合、処理をステップＡ２へ進める。一方、位置情報処理ＥＣＵ２０は、先行車２００を検出していないと判定した場合、処理をステップＡ８へ進める。
【００３８】
なお、ステップＡ１において、位置情報処理ＥＣＵ２０は、検出した先行車２００の位置を、仮想空間上にマッピングする。例えば、位置情報処理ＥＣＵ２０は、図３に示すように、自車両１００を原点とし、自車両１００の進行方向を示す軸線をＹ軸、自車両１００の左右方向を示す軸線をＸ軸とする座標系に先行車２００の位置情報をマッピングする。なお、図３は、マッピングされた先行車２００の位置情報を示すイメージ図である。図３に示す通り、自車両１００から前方へ離れるほどＹ座標の値が大きくなり、自車両１００から見て右へ離れる程、Ｘ座標の値が大きくなる。以下では当該マップにおける先行車２００の横位置情報（Ｘ座標）を検出横位置Ｐ（ｎ）と呼称する。また、先行車２００の縦位置情報（Ｙ座標）を検出縦位置Ｑ（ｎ）と呼称する。なお、検出横位置Ｐ（ｎ）および検出縦位置Ｑ（ｎ）の添え字のｎは、現在時刻を表し、ｎ−１，ｎ−２，…は各々、１サンプリング時間前、２サンプリング時間前、…の時刻を示す。すなわち、Ｐ（ｎ）は、現時点の先行車２００の検出横位置を示し、Ｐ（ｎ−１）は、１サンプリング前の先行車２００の検出横位置を示す。また、上記の先行車２００の検出方法、およびマッピングの方法は一例であり、位置情報処理ＥＣＵ２０は、従来周知の任意の手法を用いてこれらの処理を行って構わない。
【００３９】
ステップＡ２において、位置情報処理ＥＣＵ２０は、先行車離脱判定処理を実行する。先行車離脱判定処理は、自車両１００の前方を走行する先行車２００が自車両１００の走行車線（以下、自車走行車線と呼称する）から離脱中であるか否かを推定する処理である。位置情報処理ＥＣＵ２０は、先行車離脱判定処理において、先行車が自車走行車線から離脱中であると推定した場合、離脱フラグをオン状態に設定し、先行車が自車走行車線から離脱中でないと推定した場合、離脱フラグをオフ状態に設定する。離脱フラグは、位置情報処理ＥＣＵ２０の記憶装置に記憶されるフラグデータである。以下、図４を参照し、先行車離脱判定処理の詳細について説明する。図４は、位置情報処理ＥＣＵ２０が実行する先行車離脱判定処理の詳細を示すフローチャートの一例である。位置情報処理ＥＣＵ２０は、先行車離脱判定処理を開始すると、先ず、ステップＡ２１の処理を実行する。
【００４０】
ステップＡ２１において、位置情報処理ＥＣＵ２０は、左隣接車線境界Ｌｔｈ＿Ｌおよび右隣接車線境界Ｌｔｈ＿Ｒを算出する。左隣接車線境界Ｌｔｈ＿Ｌは、自車走行車線と、自車走行車線の左側の隣接車線（以下、左隣接車線と呼称する）との境界線の推定位置である。右隣接車線境界Ｌｔｈ＿Ｒは、自車走行車線と、自車走行車線の右側の隣接車線（以下、右隣接車線と呼称する）との境界線の予想位置である。すなわち、左隣接車線境界Ｌｔｈ＿Ｌおよび右隣接車線境界Ｌｔｈ＿Ｒは、各々、自車走行車線の左端および右端の推定位置を示す。位置情報処理ＥＣＵ２０は、図２において示したＸＹ座標系において予め定められた関数ＦＬに基づいて左隣接車線境界Ｌｔｈ＿Ｌを、関数ＦＲに基づいて右隣接車線境界Ｌｔｈ＿Ｒを各々算出する。具体的には、位置情報処理ＥＣＵ２０は、ステップＡ１において検出した先行車２００の検出縦位置Ｑ（ｎ）を関数ＦＬへ入力して得られる出力値を左隣接車線境界Ｌｔｈ＿Ｌとして算出する。同様に位置情報処理ＥＣＵ２０は、ステップＡ１において検出した先行車２００の検出縦位置Ｑ（ｎ）を関数ＦＲへ入力して得られる出力値を右隣接車線境界Ｌｔｈ＿Ｒとして算出する。このような処理により、位置情報処理ＥＣＵ２０は、先行車２００の近傍における車線の境界位置を予測する。位置情報処理ＥＣＵ２０は、ステップＡ２１の処理を完了すると、処理をステップＡ２２へ進める。
【００４１】
ステップＡ２２において、位置情報処理ＥＣＵ２０は検出横位置Ｐ（ｎ）が自車走行車線外に存在するか否か推定する。具体的には、先ず、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）が左隣接車線境界Ｌｔｈ＿Ｌより外側（左隣接車線側）に存在するか否か判定する。より詳細には、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値より大きいか否かを式（１）に基づいて判定する。
｜Ｐ（ｎ）｜＞｜Ｌｔｈ＿Ｌ｜ …（１）
次いで、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）が右隣接車線境界Ｌｔｈ＿Ｒより外側（右隣接車線側）に存在するか否か判定する。具体的には、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の絶対値が右隣接車線境界Ｌｔｈ＿Ｒの絶対値より大きいか否かを式（２）に基づいて判定する。
｜Ｐ（ｎ）｜＞｜Ｌｔｈ＿Ｒ｜ …（２）
そして、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値より大きい場合、または、右隣接車線境界Ｌｔｈ＿Ｒの絶対値より大きい場合、検出横位置Ｐ（ｎ）が自車走行車線外に存在すると推定し、処理をステップＡ２３へ進める。一方、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値以下であり、且つ、右隣接車線境界Ｌｔｈ＿Ｒの絶対値以下である場合、検出横位置Ｐ（ｎ）が自車走行車線内に存在していると推定し、処理をステップＡ３１へ進める。
【００４２】
ステップＡ２３において、位置情報処理ＥＣＵ２０は、前回サンプリング時点の出力横位置Ｐｏｕｔ（ｎ−１）が自車走行車線内に存在していたか否か推定する。出力横位置Ｐｏｕｔ（ｎ）は、後述の位置情報処理ＥＣＵ２０の処理によって最終的に算出された先行車２００の横位置情報である。具体的には、先ず、位置情報処理ＥＣＵ２０は、前回の出力横位置Ｐｏｕｔ（ｎ−１）が左隣接車線境界Ｌｔｈ＿Ｌより内側（自車走行車線側）に存在するか否か判定する。より詳細には、位置情報処理ＥＣＵ２０は、前回の出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値より小さいか否かを式（３）に基づいて判定する。
｜Ｌｔｈ＿Ｌ｜＞Ｐｏｕｔ（ｎ−１） …（３）
次いで、位置情報処理ＥＣＵ２０は、前回の出力横位置Ｐｏｕｔ（ｎ−１）が右隣接車線境界Ｌｔｈ＿Ｒより内側（自車走行車線側）に存在するか否か判定する。具体的には、位置情報処理ＥＣＵ２０は、前回の出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が右隣接車線境界Ｌｔｈ＿Ｒの絶対値より小さいか否かを式（４）に基づいて判定する。
｜Ｌｔｈ＿Ｒ｜＞Ｐｏｕｔ（ｎ−１） …（４）
そして、位置情報処理ＥＣＵ２０は、前回サンプリング時点の出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値より小さく、且つ、出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が右隣接車線境界Ｌｔｈ＿Ｒの絶対値より小さい場合、前回サンプリング時点の出力横位置Ｐｏｕｔ（ｎ−１）が自車走行車線内に存在していたと推定し、処理をステップＡ２４へ進める。一方、位置情報処理ＥＣＵ２０は、出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が左隣接車線境界Ｌｔｈ＿Ｌの絶対値以上である場合、または、出力横位置Ｐｏｕｔ（ｎ−１）の絶対値が右隣接車線境界Ｌｔｈ＿Ｒの絶対値以上である場合、出力横位置Ｐｏｕｔ（ｎ−１）が自車走行車線内に存在していなかったと推定し、処理をステップＡ３１へ進める。
【００４３】
上述ステップＡ２１からステップＡ２３の処理は、先行車が自車走行車線から隣接車線へ離脱しているか否かを先行車２００の位置情報に基づいて推定する処理である。過去に自車走行車線内に存在していた先行車２００の位置が、現時点において隣接車線へ移動している場合、先行車２００が自車走行車線から離脱中であると考えられる。このような観点から、位置情報処理ＥＣＵ２０は、ステップＡ２１からステップＡ２３を実行することによって先行車２００が自車走行車線から離脱中であるか否かを判定することができる。
【００４４】
ステップＡ２４において、位置情報処理ＥＣＵ２０は、先行車２００が自車走行車線から左右何れの方向へ離脱中であるか推定する。以下、先行車２００が離脱している方向を離脱方向と呼称する。例えば、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）が前回の出力横位置Ｐｏｕｔ（ｎ）より大きい場合、先行車２００が右方向へ離脱中であると推定し、検出横位置Ｐ（ｎ）が前回の出力横位置Ｐｏｕｔ（ｎ）より小さい場合、先行車２００が左方向へ離脱中であると推定する。ステップＡ２４の処理を完了すると、位置情報処理ＥＣＵ２０は、処理をステップＡ２５へ進める。
【００４５】
ステップＡ２５において、位置情報処理ＥＣＵ２０は、並走車を検出したか否か判定する。位置情報処理ＥＣＵ２０は、例えば、自車両１００の前側方を所定速度以上で自車両１００と同方向へ進行する物体を検出した場合、当該物体を並走車として検出する。なお、上記の手法は一例であり、位置情報処理ＥＣＵ２０は、従来周知の手法を用いて並走車を検出しても構わない。位置情報処理ＥＣＵ２０は、並走車を検出したと判定した場合、処理をステップＡ３０へ進める。一方、位置情報処理ＥＣＵ２０は、並走車を検出していないと判定した場合、処理をステップＡ２６へ進める。
【００４６】
上述ステップＡ２５の処理は、先行車２００が自車走行車線から隣接車線へ離脱中か否かを自車両１００の並走車の有無に基づいて推定する処理である。自車両１００の並走車が先行車２００の離脱方向側に存在する場合、先行車２００の移動先に隣接車線が存在すると考えられる。すなわち、先行車２００が自車走行車線から離脱可能であると考えられる。したがって、上記ステップＡ２５の処理によれば、位置情報処理ＥＣＵ２０は、自車走行車線から隣接車線へ離脱中か否かを、より正確に判定することができる。
【００４７】
ステップＡ２６において、位置情報処理ＥＣＵ２０は、路側物３００を検出したか否か判定する。具体的には、位置情報処理ＥＣＵ２０は、例えば、自車両１００から見て先行車２００の離脱方向側に、自車走行車線に沿って静止物を連続的に検出した場合、当該物体をガードレール等の路側物３００として検出する。例えば、図３に示すマップのＸ＝−８〜−６、Ｙ＝０〜１００の領域において静止物を連続して検出した場合、当該検出点を直線近似または曲線近似し、当該近似線を路側物３００として検出する。なお、上記の手法は一例であり、位置情報処理ＥＣＵ２０は従来周知の任意の手法を用いて路側物３００を検出および認識して構わない。位置情報処理ＥＣＵ２０は、路側物３００を検出したと判定した場合、処理をステップＡ２７へ進める。一方、位置情報処理ＥＣＵ２０は、路側物３００を検出していないと判定した場合、処理をステップＡ３１へ進める。
【００４８】
ステップＡ２７において、位置情報処理ＥＣＵ２０は、隣接車線幅Ｗを算出する。隣接車線幅Ｗは、先行車２００が離脱しようとしている隣接車線の幅を示す値である。具体的には、先ず、位置情報処理ＥＣＵ２０は、ステップＡ２６において検出した路側物３００の図３のマップにおけるＸ座標を路側物位置Ｌｇとして算出する。当該路側物位置Ｌｇは、自車両１００から路側物３００までの横方向の距離を示す値である。路側物３００までの横方向の距離は、次いで、位置情報処理ＥＣＵ２０は、路側物位置Ｌｇから路側物３００が存在する方向側の隣接車線境界の値を減算して隣接車線幅Ｗを算出する。例えば、先行車２００が自車走行車線から左側へ離脱中である場合、位置情報処理ＥＣＵ２０は、路側物位置Ｌｇから左隣接車線境界Ｌｔｈ＿Ｌの値を減算して隣接車線幅Ｗを算出する。位置情報処理ＥＣＵ２０は、ステップＡ２７の処理を完了すると、処理をステップＡ２８へ進める。
【００４９】
ステップＡ２８において、位置情報処理ＥＣＵ２０は、車線幅閾値Ｗｔｈを算出する。具体的には、位置情報処理ＥＣＵ２０は、検出縦位置Ｑ（ｎ）および車線幅閾値テーブルに基づいて車線幅閾値Ｗｔｈを算出する。車線幅閾値テーブルは、車線幅閾値Ｗｔｈと検出縦位置Ｑ（ｎ）との関係を示すデータテーブルである。図５は、車線幅閾値テーブルの概念を示す図である。図５に示すように、車線幅閾値テーブルは、列毎に検出縦位置Ｑ（ｎ）および車線幅閾値Ｗｔｈの値が各々並べられたテーブルである。当該テーブルにおいて、１列目には検出縦位置Ｑ（ｎ）の値が示され、２列目には各検出縦位置Ｑ（ｎ）の値と対応する車線幅閾値Ｗｔｈの値が示される。位置情報処理ＥＣＵ２０は、車線幅閾値テーブルの１列目において、ステップＡ１２において取得した検出縦位置Ｑ（ｎ）の値に対応する行を探索する。そして、位置情報処理ＥＣＵ２０は、探索した行と同じ行の２列目に記された車線幅閾値Ｗｔｈの値を検出縦位置Ｑ（ｎ）に対応する車線幅閾値Ｗｔｈの値として算出する。そして、図５に示す車線幅閾値テーブルによれば、検出縦位置Ｑ（ｎ）が大きいほど車線幅閾値Ｗｔｈの値が大きな値として算出される。位置情報処理ＥＣＵ２０は、ステップＡ２８の処理を完了すると、処理をステップＡ２９へ進める。
【００５０】
ステップＡ２９において、位置情報処理ＥＣＵ２０は、隣接車線幅Ｗが車線幅閾値Ｗｔｈ以上か否か判定する。位置情報処理ＥＣＵ２０は、隣接車線幅Ｗが車線幅閾値Ｗｔｈ以上であると判定した場合、処理をステップＡ３０へ進める。一方、位置情報処理ＥＣＵ２０は、隣接車線幅Ｗが車線幅閾値Ｗｔｈより小さいと判定した場合、処理をステップＡ３１へ進める。
【００５１】
上述ステップＡ２６からステップＡ２９の処理は、先行車２００が自車走行車線から隣接車線へ離脱しているか否かを路側物３００の位置情報に基づいて推定する処理である。自車両１００から路側物３００までの横方向の距離が比較的短い場合、すなわち、隣接車線幅が比較的狭い場合、隣接車線が存在していないと考えられる。そして、隣接車線が存在しない場合には、仮に上述ステップＡ２１からステップＡ２３の処理において先行車２００が隣接車線へ移動していると推定されていたとしても、実際には先行車２００は隣接車線へ移動不可能であるから、当該先行車２００は自車走行車線から離脱していないと考えられる。このような観点から、位置情報処理ＥＣＵ２０は、上述ステップＡ２６からステップＡ２９の処理を実行することによって、先行車２００が自車走行車線から離脱しているか否かをより正確に推定することができる。
【００５２】
また、上記ステップＡ２４からステップＡ２９の処理では、先行車２００の離脱方向側についてのみ隣接車線の有無を推定するため、離脱方向と逆側の隣接車線については、その有無を推定しなくて良い。すなわち、これらの処理によれば位置情報処理ＥＣＵ２０の処理量を低減することが可能である。なお、このような処理量の低減が不要である場合は、位置情報処理ＥＣＵ２０は、自車走行車線の両側について隣接車線の有無を推定して構わない。
【００５３】
ステップＡ３０において、位置情報処理ＥＣＵ２０は、離脱フラグをオン状態に設定する。離脱フラグは、上述の通り、オン状態である場合に先行車２００が自車走行車線から離脱中であることを示すフラグデータである。位置情報処理ＥＣＵ２０は、ステップＡ３０の処理を完了すると、処理をステップＡ図２のステップＡ３へ進める。
【００５４】
ステップＡ３１において、位置情報処理ＥＣＵ２０は、離脱フラグをオフ状態に設定する。位置情報処理ＥＣＵ２０は、ステップＡ３１の処理を完了すると、処理を図２のステップＡ３へ進める。
【００５５】
なお、上述ステップＡ２６からステップＡ２９までの処理では、位置情報処理ＥＣＵ２０が、先行車２００が自車走行車線から離脱中であるか否かを、路側物位置Ｌｇに基づいて算出した隣接車線幅Ｗの値に応じて判定する例について説明したが、位置情報処理ＥＣＵ２０は、先行車２００が自車走行車線から離脱中であるか否かを路側物位置Ｌｇの大きさに応じて直接的に判定しても構わない。例えば、位置情報処理ＥＣＵ２０は、路側物位置Ｌｇが予め定められた閾値以上である場合、離脱フラグをオン状態に設定し、路側物位置Ｌｇが予め定められた閾値未満である場合、離脱フラグをオフ状態に設定しても構わない。このような処理によれば、位置情報処理ＥＣＵ２０は、隣接車線幅Ｗを算出する処理を省略することができるので、比較的少ない処理量で先行車２００が自車走行車線から離脱中であるか否かを判定することができる。
【００５６】
図２の説明に戻り、ステップＡ３において、位置情報処理ＥＣＵ２０は、離脱フラグがオン状態であるか否か判定する。位置情報処理ＥＣＵ２０は、離脱フラグがオン状態であると判定した場合、処理をステップＡ４へ進める。一方、位置情報処理ＥＣＵ２０は、離脱フラグがオフ状態であると判定した場合、処理をステップＡ５へ進める。
【００５７】
ステップＡ４において、位置情報処理ＥＣＵ２０は、検出横位置Ｐ（ｎ）の値を出力横位置Ｐｏｕｔ（ｎ）として設定する。出力横位置Ｐｏｕｔ（ｎ）は、最終的に先行車検出装置１から車両制御装置５０へ出力される先行車の横位置情報である。位置情報処理ＥＣＵ２０は、ステップＡ４の処理を完了すると、処理をステップＡ７へ進める。
【００５８】
ステップＡ５において、位置情報処理ＥＣＵ２０は、フィルタ処理を実行する。具体的には、位置情報処理ＥＣＵ２０は、式（５）に示すように、現時点の検出横位置Ｐ（ｎ）と過去の出力横位置Ｐｏｕｔ（ｎ−１）とを各々フィルタ係数ｋに応じた重みを付けて加算することによって、フィルタ補正位置Ｐｆｔ（ｎ）を算出する。
Ｐｆｔ（ｎ）＝（１−ｋ）×Ｐｏｕｔ（ｎ―１）＋ｋ×Ｐ（ｎ） …（５）
なお、第１の実施形態においては、フィルタ係数ｋの値は位置情報処理ＥＣＵ２０の記憶装置に予め記憶された任意の定数とする。位置情報処理ＥＣＵ２０は、ステップＡ５の処理を完了すると、処理をステップＡ６へ進める。
【００５９】
ステップＡ６において、位置情報処理ＥＣＵ２０は、フィルタ補正位置Ｐｆｔ（ｎ）の値を出力横位置Ｐｏｕｔ（ｎ）として設定する。位置情報処理ＥＣＵ２０は、ステップＡ６の処理を完了すると、処理をステップＡ７へ進める。
【００６０】
ステップＡ７において、位置情報処理ＥＣＵ２０は、Ｐｏｕｔ（ｎ）を出力する。位置情報処理ＥＣＵ２０は、ステップＡ７の処理を完了すると、処理をステップＡ８へ進める。
【００６１】
ステップＡ８において、位置情報処理ＥＣＵ２０は、ＩＧ電源がオフに設定されたか否か判定する。位置情報処理ＥＣＵ２０は、ＩＧ電源がオフに設定されたと判定した場合、図２のフローチャートの処理を終了する。一方、位置情報処理ＥＣＵ２０は、ＩＧ電源がオン状態であると判定した場合、処理をステップＡ１へ戻す。
【００６２】
上記に示した位置情報処理ＥＣＵ２０の処理によれば、先行車２００が自車走行車線から離脱中であると推定された場合、フィルタ補正処理をしていない検出横位置Ｐ（ｎ）の値がそのまま出力横位置Ｐｏｕｔ（ｎ）として車両制御装置５０へ出力される。一方、先行車２００が自車走行車線から離脱中でないと推定された場合、フィルタ補正処理後のフィルタ補正位置Ｐｆｔ（ｎ）の値が出力横位置Ｐｏｕｔ（ｎ）として車両制御装置５０へ出力される。
【００６３】
次いで、図６および図７を参照して、上述の先行車検出装置１によって先行車２００の位置が好適に検出される様子について説明する。以下、先行車２００が、自車走行車線から左側の隣接車線へ離脱して走行する場合を例として説明する。
【００６４】
図６は、先行車２００の実際の走行経路の一例を示す図である。図６に示すように、先行車２００は、時刻ｔ１から時刻ｔ３にかけて自車走行車線を直進し、時刻ｔ３から時刻ｔ５にかけて隣接車線へ車線変更し、時刻ｔ５から時刻ｔ６にかけて隣接車線を直進する。
【００６５】
図７は、図６のように走行する先行車２００を先行車検出装置１および従来のレーダー装置によって検出した結果を示した図である。図７に示すように、ステップＡ５のようなフィルタ補正処理を実行しない従来のレーダー装置によって先行車２００を検出した場合、時刻ｔ３、および時刻ｔ６の時点のように実際の先行車２００の位置に対してずれた位置に先行車２００が存在するものとして検出してしまう（図７中、菱形プロット参照）。
【００６６】
ステップＡ５のようなフィルタ補正処理を常時実行する従来のレーダー装置によって先行車２００を検出した場合、フィルタ補正処理により時刻ｔ３および時刻ｔ６の時点における検出位置のばらつきを抑制することができるため、先行車２００が直進している間は、上述フィルタ補正処理を実行しない従来のレーダー装置に比べて先行車２００の位置を正確に検出することができる。しかしながら、フィルタ補正処理を常時実行する従来のレーダー装置は、先行車２００が車線変更を行っている間にもフィルタ補正処理を実行するため、この間、現時点の検出横位置を前回の検出横位置方向へずらしてしまう。そのため、フィルタ補正処理を常時実行する従来のレーダー装置は、時刻ｔ４から時刻ｔ６にかけて、実際の先行車２００の位置に対して時間的にずれた位置に当該先行車２００が存在するものとして検出してしまう（図７中、正方形プロット参照）。
【００６７】
一方、本発明に係る先行車検出装置１によれば、先行車２００が直進している間はフィルタ補正処理後のフィルタ補正位置Ｐｆｔ（ｎ）の値を出力値とするため、時刻ｔ３および時刻ｔ６の時点における検出位置のばらつきを抑制することができる。また、先行車検出装置１は、先行車２００が車線変更を行っている間はフィルタ補正処理を行っていない検出横位置Ｐ（ｎ）を出力値とするため、時刻ｔ４から時刻ｔ６にかけて高い応答性で先行車２００の横位置を正確に検出することが可能である。
【００６８】
以上に示した通り、本発明の第１の実施形態に係る先行車検出装置１によれば、フィルタ補正処理による補正の度合いを、先行車２００の走行状態に応じて変更することができる。したがって、先行車２００の走行状態に応じて適切な応答速度で当該先行車の位置を検出し、先行車の位置を正確に検出することが可能である。
【００６９】
なお、上記第１の実施形態では、先行車が自車走行車線から離脱していないと判定された場合にのみフィルタ処理を実行する例について説明したが、位置情報処理ＥＣＵ２０はステップＡ３の判定内容に関わらず、先行車の位置を検出する毎にフィルタ処理を実行しても構わない。すなわち、位置情報処理ＥＣＵ２０は、ステップＡ５の処理を、例えばステップＡ１の処理後、ステップＡ２の処理前に実行しても構わない。このような処理を行う場合、位置情報処理ＥＣＵ２０は、ステップＡ３において先行車が離脱していないと判定した際に処理をステップＡ６へ進める。位置情報処理ＥＣＵ２０は、このような処理を行った場合においても、先行車２００が自車走行車線から離脱しているか否かに応じてＰ（ｎ）の値、またはＰｆｔ（ｎ）の値を適宜選択してＰｏｕｔ（ｎ）の値を決定することが可能である。
【００７０】
（第２の実施形態）
上記第１の実施形態では、位置情報処理ＥＣＵ２０が、先行車２００が自車走行車線から離脱するか否かに応じてフィルタ補正処理の実行／停止状態を制御する例について説明したが、位置情報処理ＥＣＵ２０は、先行車２００が自車走行車線から離脱するか否かに応じてフィルタ補正処理の補正の度合いを変更しつつ、常時フィルタ補正処理を実行する制御を行っても構わない。以下、第２の実施形態に係る先行車検出装置について説明する。なお、第２の実施形態に係る先行車検出装置のハードウェア構成は図１に示す第１の実施形態と同様であるため、詳細な説明を省略する。
【００７１】
以下、第２の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理について図８を参照して説明する。なお、図８は、第２の実施形態に係る位置情報処理ＥＣＵ２０が実行する処理の詳細を示すフローチャートの一例である。図８に示す処理において、図２と同様の処理を行うステップについては同様の符号を付し、詳細な説明を省略する。
【００７２】
位置情報処理ＥＣＵ２０は、図８の処理を開始すると、図２と同様にステップＡ１からステップＡ３の処理を実行する。ここで、第２の実施形態に係る位置情報処理ＥＣＵ２０は、ステップＡ３において離脱フラグがオン状態であると判定した場合、処理をステップＢ２へ進める。一方、位置情報処理ＥＣＵ２０は、離脱フラグがオフ状態であると判定した場合、処理をステップＢ１へ進める。
【００７３】
ステップＢ１において位置情報処理ＥＣＵ２０は、フィルタ係数ｋの値を通常値αに設定する。通常値αは、位置情報処理ＥＣＵ２０の記憶装置に予め記憶された任意の定数である。位置情報処理ＥＣＵ２０は、ステップＢ１の処理を完了すると、処理をステップＡ５へ進める。
【００７４】
ステップＢ２において位置情報処理ＥＣＵ２０は、フィルタ係数ｋの値を変更値βに設定する。変更値βは、位置情報処理ＥＣＵ２０の記憶装置に予め記憶された任意の定数である。位置情報処理ＥＣＵ２０は、ステップＢ２の処理を完了すると、処理をステップＡ５へ進める。
【００７５】
上記第２の実施形態に係る位置情報処理ＥＣＵ２０によれば、先行車２００が自車走行車線から離脱している場合、フィルタ係数ｋの大きさを先行車２００が自車走行車線から離脱していない場合に比べて小さな値に変更される。すなわち、先行車２００が自車走行車線から離脱している場合、過去の出力横位置Ｐｏｕｔ（ｎ−１）より現時点の検出横位置Ｐ（ｎ）の重みを比較的大きくして、フィルタ補正位置Ｐｆｔ（ｎ）を算出することができる。つまり、第２の実施形態に係る位置情報処理ＥＣＵ２０は、先行車２００が自車走行車線から離脱中である場合、先行車２００が自車走行車線から離脱中でない場合に比べてフィルタ補正の度合いを弱くし、応答性を高くすることができる。
【００７６】
以上に示した通り、第２の実施形態に係る先行車検出装置によれば、第１の実施形態と同様に、先行車２００が自車走行車線から離脱中であるか否かに応じてフィルタ補正処理を制御し、先行車２００の位置を正確に検出することができる。また、第２の実施形態に係る先行車検出装置によれば、先行車２００が自車走行車線から離脱している間、完全にフィルタ補正処理を停止することなく、所定の度合いでフィルタ補正処理の効果を得ることが可能である。
【００７７】
なお、上記各実施形態では、位置情報処理ＥＣＵ２０が、先行車２００が自車走行車線から隣接車線へ離脱中にフィルタ補正処理を抑制する例について説明したが、位置情報処理ＥＣＵ２０は、先行車２００が隣接車線から自車走行車線へ進入している際にフィルタ補正処理を抑制する制御を行っても構わない。例えば、位置情報処理ＥＣＵ２０は、過去に隣接車線に存在していた先行車２００の位置が、現時点において自車走行車線内へ移動している場合にフィルタ補正処理を抑制しても構わない。また、位置情報処理ＥＣＵ２０は、先行車２００が自車両１００から見て左右方向に移動している場合に、フィルタ補正処理を抑制して構わない。
【００７８】
また、上記各実施形態では、レーダー装置１０によって先行車２００の位置および路側物３００の位置を検出する例について説明したが、自車両の周囲の物体の位置情報を検出可能な装置であれば、レーダー装置に限らず任意の装置を用いて先行車２００の位置および路側物３００の位置を検出しても構わない。例えば、本発明に係る先行車検出装置は、レーダー装置１０の代わりにカメラ装置を搭載する構成としても構わない。このような構成とした先行車検出装置によっても、位置情報処理ＥＣＵ２０が実行する処理によって上述と同様の効果を得ることが可能である。
【産業上の利用可能性】
【００７９】
本発明に係る先行車検出装置は、従来に比して正確に先行車の位置を検出可能な先行車検出装置などとして有用である。
【符号の説明】
【００８０】
１ 先行車検出装置
１０ レーダー装置
２０ 位置情報処理ＥＣＵ
５０ 車両制御装置
１００ 自車両
２００ 先行車
３００ 路側物
【特許請求の範囲】
【請求項１】
自車両の前方を走行する先行車の位置を検出する先行車検出装置であって、
少なくとも前記先行車の左右方向の位置情報を検出する先行車位置検出手段と、
現時点において検出した前記位置情報を補正するフィルタ補正手段と、
前記先行車の走行状態を推定する先行車走行状態推定手段と、
前記フィルタ補正手段による補正の度合いを、前記先行車走行状態推定手段によって推定された前記先行車の走行状態に応じて変更するフィルタ制御手段とを備える、先行車検出装置。
【請求項２】
前記先行車走行状態検出手段は、前記先行車が前記自車両が走行する自車走行車線から離脱中か否かを推定し、
前記フィルタ制御手段は、前記先行車が前記自車走行車線から離脱中であると推定された場合、前記フィルタ補正手段による補正の度合いを前記先行車が前記自車走行車線から離脱中でないと推定された場合に比べて低くすることを特徴とする、請求項１に記載の先行車検出装置。
【請求項３】
前記自車走行車線に隣接する隣接車線が有るか否かを推定する隣接車線推定手段をさらに備え、
前記離脱推定手段は、少なくとも前記隣接車線が有ると推定された場合に、前記先行車が離脱中であると推定することを特徴とする、請求項２に記載の先行車検出装置。
【請求項４】
前記自車両から前記自車両が走行する道路の路側物までの横方向の距離を路側物距離として検出する路側距離検出手段をさらに備え、
前記隣接車線推定手段は、前記路側物距離に基づいて前記隣接車線の有無を推定することを特徴とする、請求項２乃至３の何れか１つに記載の先行車検出装置。
【請求項５】
前記自車走行車線と前記隣接車線との境界位置を推定する車線境界位置推定手段をさらに備え、
前記隣接車線推定手段は、前記隣接車線が存在すると仮定した場合の当該隣接車線の車線幅を前記路側物距離および前記境界位置に基づいて推定し、（Ａ）当該車線幅が所定の車線幅閾値以上である場合、前記隣接車線が有ると判定し、（Ｂ）当該車線幅が所定の車線幅閾値未満である場合、前記隣接車線が無いと判定することを特徴とする、請求項４に記載の先行車検出装置。
【請求項６】
前記先行車までの距離が長いほど、前記車線幅閾値の大きさを大きな値に変更する閾値変更手段をさらに備えることを特徴とする、請求項５に記載の先行車検出装置。
【請求項７】
前記自車両と並走する並走車を検出する並走車検出手段をさらに備え、
前記隣接車線推定手段は、前記並走車を検出した場合、前記隣接車線が有ると判定することを特徴とする、請求項３に記載の先行車検出装置。
【請求項８】
先行車位置検出手段により検出された前記位置情報を記憶する記憶手段をさらに備え、
前記先行車が左右何れの方向へ移動しているかを現在および過去の前記位置情報に基づいて算出する移動方向算出手段をさらに備え、
前記隣接車線推定手段は、前記先行車の移動方向側に前記隣接車線が有るか否かを判定し、
前記フィルタ制御手段は、前記フィルタ補正手段による補正の度合いを、前記先行車の移動方向側に前記隣接車線が有るか否かに応じて変更することを特徴とする、請求項３乃至７の何れか１つに記載の先行車検出装置。
【請求項９】
先行車位置検出手段により検出された前記位置情報を記憶する記憶手段をさらに備え、
前記フィルタ補正手段は、現時点の前記位置情報と、過去の前記位置情報とを各々所定のフィルタ係数に応じた重みを付けて加算することによって、当該現時点の位置情報を補正することを特徴とする、請求項１乃至８の何れか１つに記載の物体検出手段。
【請求項１０】
前記フィルタ制御手段は、前記隣接車線が有ると推定された場合、現時点の前記位置情報の重みが前記隣接車線が無いと推定された場合に比べて重くなるよう前記フィルタ係数の値を変更することによって、当該補正の度合いを弱くするを特徴とする、請求項９に記載の物体検出手段。
【請求項１】
自車両の前方を走行する先行車の位置を検出する先行車検出装置であって、
少なくとも前記先行車の左右方向の位置情報を検出する先行車位置検出手段と、
現時点において検出した前記位置情報を補正するフィルタ補正手段と、
前記先行車の走行状態を推定する先行車走行状態推定手段と、
前記フィルタ補正手段による補正の度合いを、前記先行車走行状態推定手段によって推定された前記先行車の走行状態に応じて変更するフィルタ制御手段とを備える、先行車検出装置。
【請求項２】
前記先行車走行状態検出手段は、前記先行車が前記自車両が走行する自車走行車線から離脱中か否かを推定し、
前記フィルタ制御手段は、前記先行車が前記自車走行車線から離脱中であると推定された場合、前記フィルタ補正手段による補正の度合いを前記先行車が前記自車走行車線から離脱中でないと推定された場合に比べて低くすることを特徴とする、請求項１に記載の先行車検出装置。
【請求項３】
前記自車走行車線に隣接する隣接車線が有るか否かを推定する隣接車線推定手段をさらに備え、
前記離脱推定手段は、少なくとも前記隣接車線が有ると推定された場合に、前記先行車が離脱中であると推定することを特徴とする、請求項２に記載の先行車検出装置。
【請求項４】
前記自車両から前記自車両が走行する道路の路側物までの横方向の距離を路側物距離として検出する路側距離検出手段をさらに備え、
前記隣接車線推定手段は、前記路側物距離に基づいて前記隣接車線の有無を推定することを特徴とする、請求項２乃至３の何れか１つに記載の先行車検出装置。
【請求項５】
前記自車走行車線と前記隣接車線との境界位置を推定する車線境界位置推定手段をさらに備え、
前記隣接車線推定手段は、前記隣接車線が存在すると仮定した場合の当該隣接車線の車線幅を前記路側物距離および前記境界位置に基づいて推定し、（Ａ）当該車線幅が所定の車線幅閾値以上である場合、前記隣接車線が有ると判定し、（Ｂ）当該車線幅が所定の車線幅閾値未満である場合、前記隣接車線が無いと判定することを特徴とする、請求項４に記載の先行車検出装置。
【請求項６】
前記先行車までの距離が長いほど、前記車線幅閾値の大きさを大きな値に変更する閾値変更手段をさらに備えることを特徴とする、請求項５に記載の先行車検出装置。
【請求項７】
前記自車両と並走する並走車を検出する並走車検出手段をさらに備え、
前記隣接車線推定手段は、前記並走車を検出した場合、前記隣接車線が有ると判定することを特徴とする、請求項３に記載の先行車検出装置。
【請求項８】
先行車位置検出手段により検出された前記位置情報を記憶する記憶手段をさらに備え、
前記先行車が左右何れの方向へ移動しているかを現在および過去の前記位置情報に基づいて算出する移動方向算出手段をさらに備え、
前記隣接車線推定手段は、前記先行車の移動方向側に前記隣接車線が有るか否かを判定し、
前記フィルタ制御手段は、前記フィルタ補正手段による補正の度合いを、前記先行車の移動方向側に前記隣接車線が有るか否かに応じて変更することを特徴とする、請求項３乃至７の何れか１つに記載の先行車検出装置。
【請求項９】
先行車位置検出手段により検出された前記位置情報を記憶する記憶手段をさらに備え、
前記フィルタ補正手段は、現時点の前記位置情報と、過去の前記位置情報とを各々所定のフィルタ係数に応じた重みを付けて加算することによって、当該現時点の位置情報を補正することを特徴とする、請求項１乃至８の何れか１つに記載の物体検出手段。
【請求項１０】
前記フィルタ制御手段は、前記隣接車線が有ると推定された場合、現時点の前記位置情報の重みが前記隣接車線が無いと推定された場合に比べて重くなるよう前記フィルタ係数の値を変更することによって、当該補正の度合いを弱くするを特徴とする、請求項９に記載の物体検出手段。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【公開番号】特開２０１１−２３２８１８（Ｐ２０１１−２３２８１８Ａ）
【公開日】平成２３年１１月１７日（２０１１．１１．１７）
【国際特許分類】
【出願番号】特願２０１０−１０００９１（Ｐ２０１０−１０００９１）
【出願日】平成２２年４月２３日（２０１０．４．２３）
【出願人】（０００００３２０７）トヨタ自動車株式会社 (59,920)
【Ｆターム（参考）】
【公開日】平成２３年１１月１７日（２０１１．１１．１７）
【国際特許分類】
【出願日】平成２２年４月２３日（２０１０．４．２３）
【出願人】（０００００３２０７）トヨタ自動車株式会社 (59,920)
【Ｆターム（参考）】
[ Back to top ]