(57)【特許請求の範囲】
【請求項１】
自車両の車両状態を検出する車両状態検出手段と、
前記車両状態検出手段が検出した前記車両状態に基づいて自車両の進行軌跡を推定する軌跡推定手段と、
自車両の進行方向前方に存在する複数の物体を検知する物体検知手段と、
該物体検知手段にて検知した前記複数の物体を移動物あるいは静止物の何れかに判別する物体種別判定手段と、
前記軌跡推定手段によって推定された前記進行軌跡内において前記物体検知手段によって検知され、前記物体種別判定手段によって移動物であると判別された物体を、自車両が追従すべき先行車両であると判定する先行車両判定手段とを備えた車両の追従走行装置であって、
前記物体検知手段によって検知され、前記物体種別判定手段によって移動物であると判別された複数の物体の各移動履歴を記憶する履歴記憶手段を備え、
前記先行車両判定手段は、前記先行車両として設定されていた前記物体が前記進行軌跡内から逸脱したときに、前記先行車両とは異なる他の物体が、前記物体検知手段により前記進行軌跡内の位置で検知されると共に前記物体種別判定手段により静止物であると判定されるとき、
前記履歴記憶手段に記憶された前記他の物体の移動履歴に基づき、前記他の物体が前記静止物であると判定される以前に移動物であった場合には、前記他の物体を自車両が追従すべき先行車両であると判定することを特徴とする車両の追従走行装置。
【請求項２】
前記先行車両判定手段は、前記進行軌跡内において前記物体種別判定手段によって複数の前記物体が移動物であると判別された場合に、
前記物体検知手段の検知結果から算出される自車両と前記物体との間の距離に基づき、前記複数の前記物体の中、自車両の現在位置に最も近い前記物体を自車両が追従すべき前記先行車両であると判定することを特徴とする請求項１に記載の車両の追従走行装置。
【請求項３】
前記先行車両判定手段は、前記先行車両として設定されていた前記物体が前記進行軌跡内から逸脱した位置で検知された時点からの経過時間が所定の時間以内においては、前記進行軌跡内から逸脱した前記物体が前記進行軌跡内に位置すると判定することを特徴とする請求項１に記載の車両の追従走行装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、自車両が追従すべき先行車両を設定して追従制御を行う車両の追従走行装置に関する。
【０００２】
【従来の技術】
従来、例えば特開平１１−４８８２６号公報に開示された車両の速度制御装置のように、自車の前方の先行車両との間の車間距離を検出する車間距離検出手段を備え、自車の前方の先行車両を自動的に追尾すべく自車の速度を制御して、先行車両との間に所定の車間距離を保つ車両の速度制御装置が知られている。
このような車両の速度制御装置は、例えば特開平９−２６３１５９号公報に開示された車両の速度制御装置等のように、自車の前方に存在する物体が移動物あるいは静止物の何れかであることを物体の速度に基づいて判別し、移動物であれば、所定の車間距離を保つために目標車速を算出するように設定されている。
【０００３】
【発明が解決しようとする課題】
ところで、上述したような従来技術に係る車両の速度制御装置では、自車が追従すべき先行車両を決定する際に、基本的に自車の予測移動軌跡内において静止物であると判別された物体を追従しないように設定されている。このため、自車が追従すべき先行車両として設定された移動物が、例えば自車の予測移動軌跡内から逸脱した場合には、この移動物を先行車両とする設定は解除され、自車の予測移動軌跡内に存在する他の移動物が先行車両として設定され、先行車両の切り替えが行われる。
すなわち、先行車両の選択時に自車の予測移動軌跡内での静止物を先行車両の対象外とするように設定されていると、例えば直前まで移動物であった物体が一時的に停止している場合であっても、この物体は、単に予測移動軌跡内での静止物であると判別され、この物体を先行車両とする設定は禁止される場合がある。この場合、自車の予測移動軌跡内にて移動の可能性がある物体に対して自車の追従が望まれる状況において、例えば追従制御が停止されたり、例えば他の移動物に追従するように車両が加速されてしまう等の不具合が生じる虞がある。
本発明は上記事情に鑑みてなされたもので、追従すべき物体の運動状態に応じて適切な追従制御を行うことが可能な車両の追従走行装置を提供することを目的としている。
【０００４】
【課題を解決するための手段】
上記課題を解決して係る目的を達成するために、請求項１に記載の本発明の車両の追従走行装置は、自車両の車両状態を検出する車両状態検出手段（例えば、後述する実施の形態におけるヨーレートセンサ１２、車輪速センサ１３）と、前記車両状態検出手段が検出した前記車両状態に基づいて自車両の進行軌跡を推定する軌跡推定手段（例えば、後述する実施の形態における軌跡推定手段２２）と、自車両の進行方向前方に存在する複数の物体を検知する物体検知手段（例えば、後述する実施の形態におけるミリ波レーダ・ＥＣＵ１６、ステレオカメラ・ＥＣＵ１５）と、該物体検知手段にて検知した前記複数の物体を移動物あるいは静止物の何れかに判別する物体種別判定手段（例えば、後述する実施の形態における先行車両決定手段２１）と、前記軌跡推定手段によって推定された前記進行軌跡内において前記物体検知手段によって検知され、前記物体種別判定手段によって移動物であると判別された物体を、自車両が追従すべき先行車両であると判定する先行車両判定手段（例えば、後述する実施の形態においては、先行車両決定手段２１が兼ねる）とを備えた車両の追従走行装置であって、前記物体検知手段によって検知され、前記物体種別判定手段によって移動物であると判別された複数の物体の各移動履歴を記憶する履歴記憶手段（例えば、後述する実施の形態においては、先行車両決定手段２１が兼ねる）を備え、前記先行車両判定手段は、前記先行車両として設定されていた前記物体が前記進行軌跡内から逸脱したときに、前記先行車両とは異なる他の物体が、前記物体検知手段により前記進行軌跡内の位置で検知されると共に前記物体種別判定手段により静止物であると判定されるとき、前記履歴記憶手段に記憶された前記他の物体の移動履歴に基づき、前記他の物体が前記静止物であると判定される以前に移動物であった場合には、前記他の物体を自車両が追従すべき先行車両であると判定することを特徴としている。
【０００５】
上記構成の車両の追従走行装置によれば、先行車両判定手段は、自車両が追従すべき先行車両を設定する際に、自車両の進行軌跡内で検知される静止物であっても、この静止物が過去に移動物であったか否かを移動履歴から判定し、追従すべき先行車両として設定することができる。すなわち、物体検知手段によって検知される物体の移動履歴を記憶しておくことで、例えばこの物体が一時的に停止している場合であっても、単なる静止物ではなく、移動の可能性がある物体であると認識することができる。これにより、物体検知手段によって検知される物体の停止状態を含む多様な運動状態に応じて適切に追従すべき先行車両を設定することができる。
【０００６】
さらに、請求項２に記載の本発明の車両の追従走行装置では、前記先行車両判定手段は、前記進行軌跡内において前記物体種別判定手段によって複数の前記物体が移動物であると判別された場合に、前記物体検知手段の検知結果から算出される自車両と前記物体との間の距離に基づき、前記複数の前記物体の中、自車両の現在位置に最も近い前記物体を自車両が追従すべき前記先行車両であると判定することを特徴としている。
【０００７】
上記構成の車両の追従走行装置によれば、物体検知手段によって検知される物体の移動履歴を参照すると共に、自車両の進行軌跡内において自車両の現在位置に最も近い物体を自車両が追従すべき先行車両であると設定することによって、より一層、適切な追従制御を行うことができる。
【０００８】
さらに、請求項３に記載の本発明の車両の追従走行装置では、前記先行車両判定手段は、前記先行車両として設定されていた前記物体が前記進行軌跡内から逸脱した位置で検知された時点からの経過時間が所定の時間以内においては、前記進行軌跡内から逸脱した前記物体が前記進行軌跡内に位置すると判定することを特徴としている。
【０００９】
上記構成の車両の追従走行装置によれば、先行車両として設定されていた物体に対しては、一時的に進行軌跡内から逸脱した場合であっても、所定の時間以内においては進行軌跡内に位置すると判定することによって、先行車両判定手段による先行車両としての設定が直ちに解除されてしまうことを防止することができる。
これにより、追従すべき先行車両の多様な運動状態に応じて適切な追従制御を行うことができる。
【００１０】
【発明の実施の形態】
以下、本発明の一実施形態に係る車両の追従走行装置について添付図面を参照しながら説明する。図１は本発明の一実施形態に係る車両の追従走行装置１０を備えた車両１の斜視図であり、図２は本発明の一実施形態に係る車両の追従走行装置１０の構成図である。
本実施の形態による車両の追従走行装置１０は、例えば、制御ＥＣＵ１１と、ヨーレートセンサ１２と、車輪速センサ１３と、操作スイッチ１４と、ステレオカメラ・ＥＣＵ１５と、ミリ波レーダ・ＥＣＵ１６と、ブレーキ油圧アクチュエータ１７と、スロットルアクチュエータ１８と、インジケータ１９とを備えて構成されている。
【００１１】
ヨーレートセンサ１２は、例えば後車軸上近傍に設けられ、水平面内での自車両の向きや鉛直方向に対する傾斜角度の角度変化量等を検出する圧電素子やジャイロセンサー等からなり、車両重心の上下方向軸回りの回転角速度であるヨーレートを検出し、この検出結果の大きさに応じた信号を制御ＥＣＵ１１へ出力する。
車輪速センサ１３は、自車両の車輪速を検知し、この検知結果の大きさに応じた信号を制御ＥＣＵ１１へ出力する。
操作スイッチ１４は、例えば運転席前方の所定部位に設けられており、運転者の入力操作に応じた信号を制御ＥＣＵ１１へ出力する。
【００１２】
ステレオカメラ・ＥＣＵ１５は、ステレオカメラとＥＣＵ（電子制御装置）が一体的に設けられてなり、ステレオカメラから出力される撮像信号を受信したＥＣＵは、所定の検知エリア内にて認識された物体（検知対象物）と車両１との相対距離及び相対速度を算出すると共に、後述するミリ波の反射波を受信した時のミリ波の発信方向に基づいて検知対象物の方位を算出して、これらの算出結果を制御ＥＣＵ１１へ送出する。
ステレオカメラは、車室内のフロントガラス近傍のルームミラーの位置に設けられており、一対の撮像装置でフロントガラス越しに自車両の前方を撮影し、撮影により得られた撮像信号をＥＣＵへ出力する。
ステレオカメラ用のＥＣＵは、ステレオカメラから出力される撮像信号に所定に処理を行い、自車両の進行方向の相対的に近距離の領域における検知対象物までの距離や相対速度等を算出する。そして、検知対象までの距離や相対速度等の算出結果を制御ＥＣＵ１１へ出力する。
なお、相対速度は、例えば距離の時間微分等の処理によって算出される。
【００１３】
ミリ波レーダ・ＥＣＵ１６は、ミリ波レーダとＥＣＵ（電子制御装置）が一体的に設けられてなり、例えば自車両のボディのノーズ部に内蔵されており、自車両の前方に向けてミリ波を発信すると共に、この発信信号が前方の検知対象物によって反射されることで生じた反射信号を受信し、反射信号と発信信号とを混合してビート信号を発生させ、このビート信号の周波数ｆ（「ビート周波数」）に基づいて、相対的に遠距離の領域における検知対象物までの距離や相対速度等を算出する。
また、ミリ波レーダ用のＥＣＵは、反射信号を受信した際のミリ波の発信方向に基づいて検知対象の方位を算出する。そして、検知対象の幅や検知対象までの相対距離や相対速度や方位等の算出結果を制御ＥＣＵ１１へ出力する。
なお、相対速度は、例えばドップラー効果や算出した距離の時間微分等の処理によって算出される。
【００１４】
制御ＥＣＵ１１は、例えば、先行車両決定手段２１と、軌跡推定手段２２とを備えて構成されており、後述するように、ミリ波レーダやステレオカメラの所定の検知エリア内にて認識された複数の検知対象物の移動履歴に基づいて、自車両が追従する先行車両を設定する。
先行車両決定手段２１は、ミリ波レーダやステレオカメラの所定の検知エリア内にて認識された検知対象物を、自車両が追従する先行車両を決定する際の候補であるターゲット候補に設定し、ターゲット候補が移動物あるいは静止物の何れであるかを判別すると共に、各ターゲット候補の移動履歴を記憶する。
なお、先行車両決定手段２１は、各ターゲット候補の移動履歴を記憶する際に、例えばターゲット候補が所定の検知エリア内から逸脱した場合であっても、所定周期による所定回数の補間処理を行って移動履歴の記憶を継続するように設定されている。
【００１５】
そして、先行車両決定手段２１は、後述する軌跡推定手段２２にて推定された自車両の推定走行軌跡内に存在する各ターゲット候補に対し、記憶した移動履歴に基づいて、自車両に対する追従対象として設定するためのロック条件の成立または不成立を決定する。
さらに、先行車両決定手段２１は、ロック条件が成立しているターゲット候補の中から、自車両が追従する先行車両とされる制御ターゲットを選択する。
【００１６】
軌跡推定手段２２は、例えば車輪速センサ１３にて検知された車輪速から求めた自車両の速度と、ヨーレートセンサ１２にて検出された自車両のヨーレートとに基づいて、自車両の進行軌跡（推定走行軌跡）を予測する。
例えば、軌跡推定手段２２は、下記数式（１）に示すように、自車両の速度ｖとヨーレートｙとによってｒ：コーナＲを算出し、このコーナＲによって規定される軌跡に対して所定の車線幅を設定して得た領域を、自車両の推定走行軌跡として設定する。
【００１７】
【数１】
0003946598.tif 000002
【００１８】
さらに、制御ＥＣＵ１１は、先行車両決定手段２１にて設定された先行車両に対して、この先行車両の停止状態を含む適宜の運動状態に応じて自車両を追従させるように、ブレーキ油圧アクチュエータ１７およびスロットルアクチュエータ１８を駆動制御すると共に、インジケータ１９に各種の情報及び警報等を表示させる。
【００１９】
ブレーキ油圧アクチュエータ１７は、制御ＥＣＵ１１から出力される制御信号に基づいて自車両の制動力を制御する。
スロットルアクチュエータ１８は、制御ＥＣＵ１１から出力される制御信号に基づいて自車両の加減速を制御する。
インジケータ１９は、例えば自車両のインストルメントパネル内に設けられた液晶表示装置等をなしており、各種の情報及び警報等を表示する。
【００２０】
本実施の形態による車両の追従走行装置１０は上記構成を備えており、次に、この車両の追従走行装置１０の動作について添付図面を参照しながら説明する。
図３は車両の追従走行装置１０の動作を示すフローチャートであり、図４は図３に示すロック条件成立判断処理を示すフローチャートであり、図５は図３に示す制御ターゲット選択処理を示すフローチャートである。
【００２１】
先ず、図３に示すステップＳ０１において、ロック条件成立判断処理を実行する。ここでは、後述するように、認識されたすべてのターゲット候補に対して、ロック条件が成立しているか否かを判断する。
そして、ステップＳ０２において、制御ターゲット選択処理を行い、一連の処理を終了する。
この制御ターゲット選択処理においては、後述するように、ロック条件が成立しているターゲット候補の中から制御ターゲットつまり追従対象となる先行車両を選択する。
なお、上述したステップＳ０１〜ステップＳ０２の処理は、所定時間周期（例えば、１００ｍｓ等）によって繰り返し実行されるように設定されている。
【００２２】
以下に、上述したステップＳ０１における、ロック条件成立判断処理について説明する。
先ず、図４に示すステップＳ１１においては、所定の検知エリア内で認識したターゲット候補が、自車両の推定走行軌跡内に存在するか否かを判定する。
この判定結果が「ＮＯ」の場合には、後述するステップＳ１６に進む。
一方、この判定結果が「ＹＥＳ」の場合には、ステップＳ１２に進む。
【００２３】
ステップＳ１２においては、自車両の推定走行軌跡内に存在するターゲット候補が、自車両の進行方向に移動する走行物体であるか否かを、例えば自車両の速度やターゲット候補に対する相対速度等に基づいて判定する。
この判定結果が「ＹＥＳ」の場合には、ステップＳ１３に進み、ターゲット候補に対してロック条件が成立していると判断して、一連の処理を終了する。ここでは、ターゲット候補が停止している場合であっても、このターゲット候補の移動履歴から、過去に走行物体であって、自車両の進行方向に移動する可能性がある場合には、判定結果が「ＹＥＳ」とされる。
一方、この判定結果が「ＮＯ」の場合、例えばターゲット候補が停止車両あるいは対向車両等である場合には、ステップＳ１４に進む。
【００２４】
ステップＳ１４においては、ターゲット候補が前回の処理における制御ターゲットであったか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、上述したステップＳ１３に進む。これにより、例えば追従対象とされている先行車両が停止した場合には、自車両も追従して停止することができる。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ１５に進む。
【００２５】
ステップＳ１５においては、ターゲット候補が過去に走行物体として設定されており、かつ、この走行物体としての設定が解除されてからの経過時間が所定時間以内か否かを判定する。
この判定結果が「ＹＥＳ」の場合には、上述したステップＳ１３に進む。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ１６に進む。
ステップＳ１６においては、ターゲット候補に対してロック条件が成立していないと判断して、一連の処理を終了する。
【００２６】
すなわち、自車両の推定走行軌跡内に存在するターゲット候補が、例えば停止車両や対向車両等のように、現時点で制御ターゲットとして設定されていない場合であっても、少なくとも所定時間以内の過去において、走行物体として設定されていた場合には、ロック条件を成立させる。
これにより、例えばガードレールや電柱等の路側物や対向車両に対してはロック条件を成立させないようにしつつ、単に、自車両の進行方向に移動していないという条件のみで、ターゲット候補をロック条件の成立対象から除外してしまうことを防止して、追従対象である先行車両の多様な走行状態に応じて、適切な追従制御を行うことが可能となる。
【００２７】
以下に、上述したステップＳ０２における制御ターゲット選択処理について説明する。
先ず、図５に示すステップＳ２１においては、ロック条件が成立しているターゲット候補の中から、自車両の現在位置に最も近い位置に存在するターゲット候補を最有力ターゲット候補として設定する。
【００２８】
そして、ステップＳ２２においては、最有力ターゲット候補が、前回の処理における制御ターゲットと同一であるか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、ステップＳ２３に進み、最有力ターゲットを今回の処理における制御ターゲットに設定して、一連の処理を終了する。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ２４に進む。
【００２９】
ステップＳ２４においては、最有力ターゲット候補の現在位置と自車両の現在位置との間の距離が、前回の処理における制御ターゲットの現在位置と自車両の現在位置との間の距離以下であるか否かを判定する。
この判定結果が「ＹＥＳ」の場合、例えば最有力ターゲット候補が前回の処理における制御ターゲットと自車両との間に割り込んできた車両である場合等には、上述したステップＳ２３に進む。
一方、この判定結果が「ＮＯ」の場合には、ステップＳ２５に進む。
【００３０】
ステップＳ２５においては、最有力ターゲット候補と、前回の処理における制御ターゲットとが同一ではないと判定されてから、所定の時間（例えば、１．５秒等）以上経過したか否かを判定する。
この判定結果が「ＹＥＳ」の場合には、上述したステップＳ２３に進む。
一方、この判定結果が「ＮＯ」の場合、例えば前回の処理における制御ターゲットが、一時的に自車両の推定走行軌跡内から逸脱した後に、再度、自車両の推定走行軌跡内に戻った場合等には、ステップＳ２６に進み、前回の処理における制御ターゲットを今回の処理における制御ターゲットに設定して、一連の処理を終了する。
【００３１】
すなわち、ロック条件が成立しているターゲット候補中から、最も自車両に接近している最有力ターゲット候補を選択したときに、この最有力ターゲット候補が、前回の処理における制御ターゲットと異なる場合には、直ちに最有力ターゲット候補を制御ターゲットに設定するのではなく、前回の処理における制御ターゲットを今回の処理における制御ターゲットとして維持する。そして、所定時間以上に亘って継続して最有力ターゲット候補が変化しないことを確認してから、最有力ターゲット候補を制御ターゲットに設定する。これにより、自車両および追従対象となる先行車両の走行状態の変化度合いに応じて、適切な追従制御を行うことが可能となる。
【００３２】
また、例えば、図６に示すように、制御ターゲットとして設定されていた先行車両ＶＡが、前方の交差点にて左折するために車線変更を行ったことによって、自車両ＶＢの検知エリアα内ではあるが、自車両ＶＢの推定走行軌跡β内から外れる位置に移動すると、この先行車両ＶＡに対するロック条件が不成立となって、先行車両ＶＡは制御ターゲットではなくなる。
このとき、例えば図６および図７に示すように、先行車両ＶＡの前方において、自車両ＶＢの推定走行軌跡β内で直前まで走行中であった先々行車両ＶＣが停止した場合には、直ちに先々行車両ＶＣを推定走行軌跡β内の単なる静止物であると判定してロック条件を不成立に設定するのではなく、この先々行車両ＶＣが、少なくとも所定時間以内の過去において移動物であったか否かを移動履歴によって判定する。そして、この判定結果において過去に移動物であった場合には、移動の可能性があると判断してロック条件を成立させる。
これにより、例えばガードレール等の路側物に対してロック条件を成立させること無しに、ターゲット候補の停止状態をも含む多様な走行状態に応じて、適切に追従制御を行うことができる。
【００３３】
上述したように、本実施の形態による車両の追従走行装置によれば、単に、自車両の進行方向に移動していないという条件のみで、ターゲット候補をロック条件の成立対象から除外してしまうことを防止して、ターゲット候補の移動履歴に基づき、停止状態をも含む多様な走行状態に応じて、適切に追従制御を行うことができる。
【００３４】
【発明の効果】
以上説明したように、請求項１に記載の本発明の車両の追従走行装置によれば、物体検知手段によって検知される物体の移動履歴を記憶しておくことで、例えばこの物体が一時的に停止している場合であっても、単なる静止物ではなく、移動の可能性がある物体であると認識することができる。これにより、物体検知手段によって検知される物体の停止状態を含む多様な運動状態に応じて適切に追従すべき先行車両を設定することができる。
【００３５】
さらに、請求項２に記載の本発明の車両の追従走行装置によれば、物体検知手段によって検知される物体の移動履歴を参照すると共に、自車両の進行軌跡内において自車両の現在位置に最も近い物体を自車両が追従すべき先行車両であると設定することによって、より一層、適切な追従制御を行うことができる。
さらに、請求項３に記載の本発明の車両の追従走行装置によれば、先行車両判定手段による先行車両としての設定が直ちに解除されてしまうことを防止して、追従すべき先行車両の多様な運動状態に応じて適切な追従制御を行うことができる。
【図面の簡単な説明】
【図１】  本発明の一実施形態に係る車両の追従走行装置を備えた車両の斜視図である。
【図２】  本発明の一実施形態に係る車両の追従走行装置の構成図である。
【図３】  車両の追従走行装置の動作を示すフローチャートである。
【図４】  図３に示すロック条件成立判断処理を示すフローチャートである。
【図５】  図３に示す制御ターゲット選択処理を示すフローチャートである。
【図６】  自車両ＶＢと先行車両ＶＡおよび先々行車両ＶＣとの相対位置の一例を示すグラフ図である。
【図７】  自車両ＶＢと先行車両ＶＡおよび先々行車両ＶＣとの相対位置の一例を示すグラフ図である。
【符号の説明】
１０  車両の追従走行装置
１２  ヨーレートセンサ（車両状態検出手段）
１３  車輪速センサ（車両状態検出手段）
１５  ステレオカメラ・ＥＣＵ（物体検知手段）
１６  ミリ波レーダ・ＥＣＵ（物体検知手段）
２１  先行車両決定手段（物体種別判定手段、先行車両判定手段、履歴記憶手段）
２２  軌跡推定手段
【図１】
0003946598.tif 000003
【図２】
0003946598.tif 000004
【図３】
0003946598.tif 000005
【図４】
0003946598.tif 000006
【図５】
0003946598.tif 000007
【図６】
0003946598.tif 000008
【図７】
0003946598.tif 000009