(57)【特許請求の範囲】
【請求項１】
道路上の移動体を検出する移動体検出手段と、
該移動体検出手段によって道路上を横断する移動体が検出されたときに、該移動体の移動ベクトルに基づいて該移動体と自車両との衝突位置を予測する衝突位置予測手段と、を備え、
自車両が右折又は左折した際に、進入した道路上を横断する移動体が検出された場合、前記衝突位置予測手段による衝突位置の予測に用いる該移動体の移動ベクトルの方向を、進入した道路に対して垂直方向に設定し、
自車両が右折又は左折した際に、進入した道路上を横断する移動体が検出された場合、該移動体の位置情報から算出される移動ベクトルを、自車両が進入した道路方向成分と該道路に対して垂直方向成分とに分解し、該垂直方向成分を、前記衝突位置予測手段による衝突位置の予測に用いる該移動体の移動ベクトルとすることを特徴とする衝突位置予測装置。
【請求項２】
自車両が右折又は左折して進入した道路に横断歩道が形成されており、前記移動体検出手段によって検出された道路上を横断する移動体が該横断歩道上に存在している場合、前記衝突位置予測手段による該移動体と自車両との衝突位置の予測に用いる該移動体の移動ベクトルの方向を、進入した道路に対する垂直方向に優先して、該横断歩道の方向に設定することを特徴とする請求項１に記載の衝突位置予測装置。
【請求項３】
前記移動体検出手段によって検出された道路上を横断する移動体が前記横断歩道上に存在している場合、該移動体の位置情報から算出される移動ベクトルを、横断歩道方向成分と該横断歩道に対して垂直方向成分とに分解し、該横断歩道方向成分を、前記衝突位置予測手段による衝突位置の予測に用いる該移動体の移動ベクトルとすることを特徴とする請求項２に記載の衝突位置予測装置。
【請求項４】
自車両が右折又は左折した際に、進入した道路の形状を取得する取得手段と、
前記取得手段によって取得された道路形状に基づいて自車両が進入した道路に対する垂直方向を算出する算出手段と、
をさらに備えたことを特徴とする請求項１から３のいずれか一項に記載の衝突位置予測装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、移動体と自車両との衝突位置を予測する衝突位置予測装置に関する。
【背景技術】
【０００２】
従来、歩行者や自転車等の道路上を横断する移動体と自車両との衝突を回避すべく運転支援を行なうために、該移動体と自車両との衝突位置を予測する衝突位置予測装置が開発されている。【０００３】
特許文献１には、地図データから自車両が右折又は左折する交差点の交差点ベクトルを設定すると共に、歩行者情報から歩行者の進行方向ベクトルを設定し、両ベクトルから自車両と歩行者との衝突位置を予測する技術が開示されている。さらに、特許文献１には、歩行者から送信される位置情報を用いて歩行者の進行方法ベクトルを設定する技術、及び、歩行者の位置情報から検出される歩行者の進行方向が複数回継続して同一方向であった場合、その進行方向に進行方向ベクトルを設定する技術が開示されている。【０００４】
特許文献２には、歩行者の相対移動方向に、自車両の進行方向に対する直角方向への移動成分がある場合は、警報装置によって警報を発生させる技術が開示されている。また、特許文献３には、移動物体と横断歩道との間の距離が所定値以下である時に、該移動物体が該横断歩道を横断すると判断する技術が開示されている。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２００８−０６５４８２号公報
【特許文献２】特開２００８−１９７７２０号公報
【特許文献３】特開２００４−１７８６１０号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
道路上を横断する移動体と自車両との衝突位置を予測する場合、該移動体の移動ベクトルを求める必要がある。しかしながら、移動体の位置情報に基づいてその移動ベクトルを算出した場合、以下のような問題が生じる虞がある。【０００７】
図８は、所定の時間間隔で検出した複数の位置情報に基づいて移動体の移動ベクトルを算出した場合を示している。道路上を横断する移動体は常に一定の方向に進むわけではなく、ふらつきながら移動する場合がある。この場合、今回の位置情報と前回の位置情報とを結びつけることで移動体の移動ベクトルを算出すると、図８に示すように、各移動ベクトルの方向にばらつきが生じる。このような方向にばらつきのある複数の移動ベクトルに基づいて移動体と自車両との衝突位置を高精度で予測することは困難である。【０００８】
また、例えば、移動体の移動ベクトルとして複数回連続して一定方向のベクトルが算出されたときに異なる方向のベクトルが一回算出されたような場合は、異なる方向のベクトルを除外する処理を行なうことにより一定方向の移動ベクトルを求めることが可能である。しかしながら、図８に示すように、移動ベクトルの方向が頻繁に変化する場合は、このような処理を適用することも困難である。【０００９】
また、図９は、ミリ波レーダやステレオカメラ等のセンサによって道路上を横断する移動体（図９では歩行者）の位置情報を検出し、検出された位置情報に基づいて該移動体の移動ベクトルを算出した場合を示している。このようなセンサによって移動体の位置情報を検出した場合、図９に示すように、同一の移動体上における異なる位置の位置情報を該移動体の位置情報として検出する場合がある。このように検出された位置情報に基づいて移動体の移動ベクトルを算出した場合、算出された移動ベクトルの方向と実際の移動ベクトルの方向との間に誤差が生じる虞がある。さらに、センサの特性に起因して位置情報に誤差が生じる虞もある。これらの誤差が生じた場合も、算出された移動ベクトルに基づいて移動体と自車両との衝突位置を高精度で予測することは困難となる。【００１０】
本発明は、上記問題に鑑みてなされたものであって、道路上を横断する移動体と自車両との衝突位置をより高精度で予測することが可能な技術を提供することを目的とする。
【課題を解決するための手段】
【００１１】
本発明は、自車両が右折又は左折した際に、進入した道路上を横断する移動体が検出された場合、該移動体の移動ベクトルの方向を自車両が右折又は左折した道路の形状に基づいて設定した方向に固定し、その方向を固定した移動ベクトルに基づいて該移動体と自車両との衝突位置を予測するものである。【００１２】
より詳しくは、本発明に係る衝突位置予測装置は、
道路上の移動体を検出する移動体検出手段と、
該移動体検出手段によって道路上を横断する移動体が検出されたときに、該移動体の移動ベクトルに基づいて該移動体と自車両との衝突位置を予測する衝突位置予測手段と、を備え、
自車両が右折又は左折した際に、進入した道路上を横断する移動体が検出された場合、前記衝突位置予測手段による衝突位置の予測に用いる該移動体の移動ベクトルの方向を、自車両が右折又は左折した道路の形状に基づいて設定することを特徴とする。【００１３】
本発明によれば、移動体と自車両との衝突位置を予測する際に、該移動体がふらつきながら移動していたとしても、その移動ベクトルの方向は一定の方向に固定される。従って、道路上を横断する移動体と自車両との衝突位置をより高精度で予測することができる。【００１４】
本発明において、自車両が右折又は左折した際に、進入した道路上を横断する移動体が検出された場合、衝突位置予測手段による衝突位置の予測に用いる該移動体の移動ベクトルの方向を、進入した道路に対して垂直方向に設定してもよい。【００１５】
道路上を横断する移動体は、ふらつきながら移動していたとしても、基本的には道路に対して垂直方向に進む可能性が非常に高い。そのため、道路に対して垂直方向を移動体の移動ベクトルの方向として設定することで、該移動体と自車両との衝突位置をより高精度で予測することができる。【００１６】
この場合、移動体の位置情報から算出される移動ベクトルを、自車両が進入した道路方向成分と該道路に対して垂直方向成分とに分解し、該垂直方向成分を、衝突位置予測手段による衝突位置の予測に用いる該移動体の移動ベクトルとしてもよい。【００１７】
また、自車両が右折又は左折して進入した道路に横断歩道が形成されており、移動体検出手段によって検出された道路上を横断する移動体が該横断歩道上に存在している場合、該移動体は横断歩道の方向に進む可能性が非常に高い。そこで、この場合、衝突位置予測手段による該移動体と自車両との衝突位置の予測に用いる該移動体の移動ベクトルの方向を、道路の形状に優先して、横断歩道の方向に設定してもよい。これにより、移動体と自車両との衝突位置をより高精度で予測することができる。【００１８】
上記の場合、移動体の位置情報から算出される移動ベクトルを、横断歩道方向成分と該横断歩道に対して垂直方向成分とに分解し、該横断歩道方向成分を、衝突位置予測手段による衝突位置の予測に用いる該移動体の移動ベクトルとしてもよい。
【発明の効果】
【００１９】
本発明によれば、道路上を横断する移動体と自車両との衝突位置をより高精度で予測することができる。
【図面の簡単な説明】
【００２０】
【図１】実施例１に係る衝突位置予測システムの概略構成を示すブロック図である。
【図２】実施例１に係る、自車両が右折した際に、進入した道路上に横断移動体が検出されたときの様子を示す図である。
【図３】実施例１に係る、衝突位置の予測に用いる横断移動体の移動ベクトルの演算方法を示す図である。
【図４】実施例１に係る衝突位置予測フローを示すフローチャートである。
【図５】実施例２に係る衝突位置予測システムの概略構成を示すブロック図である。
【図６】実施例２に係る、衝突位置の予測に用いる横断移動体の移動ベクトルの演算方法を示す図である。
【図７】実施例２に係る衝突位置予測フローを示すフローチャートである。
【図８】所定の時間間隔で検出した複数の位置情報に基づいて算出した移動体の移動ベクトルを示す図である。
【図９】センサによって検出された位置情報に基づいて算出した歩行者の移動ベクトルを示す図である。
【発明を実施するための形態】
【００２１】
以下、本発明の具体的な実施形態について図面に基づいて説明する。本実施例に記載されている構成部品の寸法、材質、形状、その相対配置等は、特に記載がない限りは発明の技術的範囲をそれらのみに限定する趣旨のものではない。
【００２２】
＜実施例１＞
本発明に係る衝突位置予測装置の実施例１について図１〜４に基づいて説明する。
【００２３】
（概略構成）
図１は、本実施例に係る衝突位置予測システムの概略構成を示すブロック図である。衝突位置予測システム１は、道路を走行する車両に搭載されている。衝突位置予測システム１は、道路上に存在する物標と自車両との衝突位置を予測すると共に、該物標と自車両とが衝突する可能性があるときは運転者への警告及び衝突回避制御を実施する装置である。衝突位置予測システム１は、ミリ波レーダ２、レーダＥＣＵ３、操舵角センサ４、ヨーレートセンサ５、車輪速センサ６、ナビゲーションシステム７及びシステムＥＣＵ８を備えている。
【００２４】
ミリ波レーダ２は、自車両の前側に設けられており、自車両の前方に存在する物標の自車両からの方向及び距離を検出するものである。ミリ波レーダ２は、自車両の前方の所定範囲においてミリ波を走査して、その反射波を受信することにより、反射波を検出した夫々の方向について、物標までの距離を検出する。このミリ波レーダ２による検出は所定時間毎に行われる。ミリ波レーダ２は、検出した方向及び距離に応じた信号をレーダＥＣＵ３に逐次出力する。
【００２５】
レーダＥＣＵ３は、自車両の前方に存在する物標の自車両に対する位置を演算するものである。レーダＥＣＵ３は、ＣＰＵ、ＲＯＭ及びＲＡＭ等を含むコンピュータを主体として構成される。レーダＥＣＵ３は、物標相対位置演算部３１及び物標相対速度演算部３２を備えている。
【００２６】
物標相対位置演算部３１は、ミリ波レーダ２から入力された信号に基づいて、ミリ波レーダ２によって検出された物標の自車両に対する位置（相対位置）を演算する。この相対位置は距離及び横位置として算出される。ここで、距離及び横位置は、物標と自車両との間の直線距離を自車両の前後方向の成分と自車両の横方向の成分とに分けたものであって、該前後方向の成分を「距離」とし、該横方向の成分を「横位置」とする。物標相対位置演算部３１は、この演算結果に応じた信号をシステムＥＣＵ８へ出力する。
【００２７】
物標相対速度演算部３２は、ミリ波レーダ２によって検出された物標の自車両に対する速度（相対速度）を演算する。物標相対速度演算部３２は、この演算結果に応じた信号をシステムＥＣＵ８へ出力する。
【００２８】
操舵角センサ４は、自車両のステアリングシャフトに設けられており、自車両のステアリングの操舵角を検出する。操舵角センサ４は、ロータリエンコーダ等を備えており、自車両の運転者が入力した操舵角の方向及び大きさを検出する。また、操舵角センサ４は、検出した操舵角の方向及び大きさに応じた操舵角信号をシステムＥＣＵ８へ出力する。
【００２９】
ヨーレートセンサ５は、自車両の車体の中央部に設けられており、自車両のヨーレートを検出する。また、ヨーレートセンサ５は、検出したヨーレートに応じた信号をシステムＥＣＵ８へ出力する。
【００３０】
車輪速センサ６は、自車両の各車輪に設けられており、車輪速パルスを検出する。また、車輪速センサ６は、検出した車輪速パルスに応じた車輪速パルス信号をシステムＥＣＵ８へ出力する。
【００３１】
ナビゲーションシステム７は、人工衛星からの信号を受信することにより自車両の現在位置を演算するシステムである。ナビゲーションシステム７には、道路情報（道路地図）が予め記憶されている。そして、ナビゲーションシステム７は、該道路情報上における自車両の現在位置を演算する。また、ナビゲーションシステム７は、この演算結果に応じた信号をシステムＥＣＵ８へ出力する。
【００３２】
システムＥＣＵ８は、ミリ波レーダ２によって検出された物標と自車両との衝突位置を予測すると共に、該物標と自車両とが衝突する可能性があるか否かを判定するものである。システムＥＣＵ８は、ＣＰＵ、ＲＯＭ及びＲＡＭ等を含むコンピュータを主体として構成されている。システムＥＣＵ８は、レーダＥＣＵ３、操舵角センサ４、ヨーレートセンサ５、車輪速センサ６及びナビゲーションシステム７から入力された信号に基づいて所定の処理を実行することにより衝突位置を予測する。システムＥＣＵ８は、右左折判定演算部８１、横断移動体判定演算部８２、道路形状取得部８３、道路方向・道路垂直方向演算部８４、移動ベクトル演算部８５、衝突位置演算部８６及び衝突判定演算部８７を備えている。各部の詳細については後述する。
【００３３】
システムＥＣＵ８によって物標と自車両とが衝突する可能性があると判定された場合、該システムＥＣＵ８から作動デバイス９にＯＮ信号が送信される。作動デバイス９は、警報装置９１及びブレーキ制御装置９２を含んでいる。警報装置９１は、該ＯＮ信号を受信すると、モニタへの表示や音声等による運転者への警告を実行する。また、ブレーキ制御装置９２は、該ＯＮ信号を受信すると、自車両のブレーキを自動で作動させる。尚、作動デバイス９には、自動操舵装置等のような衝突回避制御を実行する他の装置が含まれてもよい。さらに、作動デバイス９には、シートベルト制御装置、シート位置制御装置及びエアバッグ制御装置等のような衝突被害低減制御を実行する装置が含まれてもよい。
【００３４】
（衝突位置予測方法）
次に、本実施例において、自車両が右折又は左折した際に、進入した道路上を横断する移動体（以下、横断移動体と称する場合もある）がミリ波レーダ２によって検出されたときの該横断移動体と自車両との衝突位置を予測する方法について図２及び３に基づいて説明する。図２は、自車両１００が右折した際に、進入した道路上に横断移動体Ａが検出されたときの様子を示している。図２において、横断移動体Ａは全て同一の移動体であって、各点はミリ波レーダ２によって所定の間隔で検出された横断移動体Ａの位置を表している。
【００３５】
本実施例では、横断移動体の移動ベクトル及び自車両の速度等に基づいて横断移動体と自車両との衝突位置を予測する。しかしながら、横断移動体は常に一定の方向に進むわけではなく、図２に示すようにふらつきながら移動する場合がある。このように横断移動体Ａがふらつきながら進んでいる場合、該横断移動体Ａの実際の移動ベクトルの方向は、図２において破線矢印で示すように頻繁に変化する。このように方向が頻繁に変化する移動ベクトルに基づいて横断移動体Ａと自車両１００との衝突位置を高精度で予測することは困難である。
【００３６】
そこで、本実施例では、横断移動体Ａと自車両１００との衝突位置との予測に用いる横断移動体Ａの移動ベクトルの方向を自車両１００が右折した道路（自車両が左折した場合は左折した道路）の形状に基づいて設定する。より詳しくは、図２において実線矢印で示すように、横転移動体Ａの移動ベクトルの方向を、自車両１００が進入した道路、即ち横断移動体Ａが移動している道路に対し垂直方向（以下、道路垂直方向と称する場合もある）に設定する。
【００３７】
図３は、本実施例に係る、衝突位置の予測に用いる横断移動体Ａの移動ベクトルの演算方法を示す図である。図３に示すように、本実施例では、先ず、レーダＥＣＵ３の物標相対位置演算部３１から入力される横断移動体Ａについての今回の位置と前回の位置とを結びつけることで移動ベクトルＶｖを算出する（以下、このように位置情報に基づいて算出される移動ベクトルを仮移動ベクトルと称する場合もある）。次に、算出された仮移動ベクトルＶｖを道路垂直方向成分Ｖａと道路方向成分Ｖｂとに分解する。そして、該道路垂直方向成分Ｖａを、衝突位置予測に用いる横断移動体Ａの移動ベクトルとする。
【００３８】
横断移動体は、ふらつきながら移動していたとしても、基本的には道路垂直方向に進む可能性が非常に高い。また、上記のように横断移動体の移動ベクトルを演算することで、該移動ベクトルの方向を道路垂直方向に固定することができる。従って、このように算出された移動ベクトルに基づいて横断移動体と自車両との衝突位置を予測することで、その衝突位置を高精度で予測することが可能となる。
【００３９】
（衝突位置予測フロー）
本実施例に係る衝突位置予測フローについて図４に示すフローチャートに基づいて説明する。本フローは、システムＥＣＵ８に予め記憶されており、システムＥＣＵ８によって所定の間隔で繰り返し実行される。
【００４０】
本フローでは、先ずステップＳ１０１において、自車両が右折状態又は左折状態にあるか否かが判定される。本実施例では、操舵角センサ４又はヨーレートセンサ５の少なくともいずれかの検出値に基づいて該判定が行なわれる。尚、衝突位置予測システム１が、自車両の前方の画像を撮像する画像センサを備えている場合は、該画像センサによって撮像された画像に基づいて該判定を行なうこともできる。さらに、ウィンカー等の右折又は左折時にＯＮとなる車載スイッチの状態、或いは画像センサ又はナビゲーションシステム７によって検出される自車両の走行レーン等に基づいて該判定を行なうこともできる。
【００４１】
本実施例では、自車両が右折状態の時は右左折状態フラグの値が「１」となり、自車両が左折状態の時は右左折状態フラグの値が「２」となり、自車両が直進状態の時は右左折状態フラグの値が「０」となる。ステップＳ１０１においては、右左折状態フラグの値が「１」又は「２」のときは肯定判定され、次にステップＳ１０２の処理が実行される。一方、右左折状態フラグの値が「０」のときは否定判定され、次にステップＳ１０６の処理が実行される。
【００４２】
ステップＳ１０２においては、ミリ波レーダ２で検出された物標が横断移動体であるか否かが判定される。該判定は、例えば、レーダＥＣＵ３の物標相対位置演算部３１及び物標相対速度演算部３２での演算結果に基づいて行われる。また、ミリ波レーダ２によって受信された受信波の強度に基づいて物標が歩行者又は自転車であるか否かを判定してもよい。この場合、物標が歩行者又は自転車であると判定された場合、該物標は横断移動体であると判定される。
【００４３】
本実施例では、物標が横断移動体の時は横断移動体フラグの値が「１」となり、物標が横断移動体でない時は横断移動体フラグの値が「０」となる。ステップＳ１０２においては、横断移動体フラグの値が「１」のときは肯定判定され、次にステップＳ１０３の処理が実行される。一方、横断移動体フラグの値が「０」のときは否定判定され、次にステップＳ１０６の処理が実行される。
【００４４】
上記ステップＳ１０１及びＳ１０２において否定判定された後のステップＳ１０６では、ミリ波レーダ２によって検出された物標と自車両との衝突位置が従来の方法により予測される。つまり、物標の位置情報に基づいて算出される移動ベクトルに基づいて衝突位置が予測される。
【００４５】
ステップ１０３においては、ナビゲーションシステム７によって算出された自車両の現在位置及びその道路情報に基づいて、自車両が右折又は左折した道路の形状が取得される。尚、衝突位置予測システム１が、自車両の前方の画像を撮像する画像センサを備えている場合は、該画像センサによって撮像された画像から該道路形状を取得してもよい。また、ミリ波レーダ２から入力される信号に基づいて該道路形状を取得してもよい。また、道路又は道路周辺の構造物に通信媒体を設置し、該通信媒体から受信する情報に基づいて該道路形状を取得してもよい。
【００４６】
次に、ステップＳ１０４において、ステップ１０３で取得された道路形状に基づいて、自車両が右折又は左折して進入した道路についての道路方向及び道路垂直方向が算出される。
【００４７】
次に、ステップＳ１０５において、衝突位置の予測に用いる横断移動体の移動ベクトルが算出される。つまり、横断移動体の仮移動ベクトルが算出され、更に該仮移動ベクトルがステップＳ１０４で算出された道路方向及び道路垂直方向の各成分に分解される。そして、仮移動ベクトルの道路垂直方向成分が、衝突位置の予測に用いる横断移動体の移動ベクトルとして算出される。
【００４８】
次に、ステップＳ１０６において、ステップＳ１０５で算出された横断移動体の移動ベクトル及び自車両の速度等に基づいて、横断移動体と自車両との衝突位置が予測される。
【００４９】
尚、システムＥＣＵ８では、右左折判定演算部８１によって上記ステップ１０１の処理が実行され、横断移動体判定演算部８２によって上記ステップＳ１０２の処理が実行される。また、道路形状取得部８３によって上記ステップＳ１０３の処理が実行され、道路方向・道路垂直方向演算部８４によって上記ステップＳ１０４の処理が実行される。また、移動ベクトル演算部８５によってステップＳ１０５の処理が実行され、衝突位置演算部８６によってステップＳ１０６の処理が実行される。
【００５０】
そして、上記フローによって予測された横断移動体と自車両との衝突位置が所定の条件を満たすか否かに基づいて、該横断移動体と自車両とが衝突する可能性があるか否かが判定される。ここで、所定の条件とは、例えば、予測された衝突位置が自車両が走行する道路上に存在することである。この判定は、衝突判定演算部８７によって行なわれる。
【００５１】
尚、本実施例では、ミリ波レーダ２が、本発明に係る移動体検出手段に相当する。ミリ波レーダ２に代えて、又はミリ波レーダ２に加えて、画像センサ等の物標を検出することが可能な他のセンサを、本発明に係る移動体検出手段として用いることも可能である。また、本実施例では、システムＥＣＵ８の衝突位置演算部８６が、本発明に係る衝突位置予測手段に相当する。
【００５２】
＜実施例２＞
本発明に係る衝突位置予測装置の実施例２について図５〜７に基づいて説明する。尚、ここでは、実施例１と異なる点についてのみ説明する。
【００５３】
（概略構成）
図５は、本実施例に係る衝突位置予測システムの概略構成を示すブロック図である。本実施例に係る衝突位置予測システム１は、画像センサ１０を備えている。画像センサ１０は、自車両の前側に設けられており、自車両の前方の画像を撮像するセンサである。また、画像センサ１０は、撮像した画像をシステムＥＣＵ８へ出力する。
【００５４】
尚、本実施例では、ミリ波レーダ２による検出結果及び画像センサ１０によって撮像された画像に基づいて、自車両の前方に存在する物標を検出してもよい。
【００５５】
また、本実施例に係るシステムＥＣＵ８は、横断歩道検出部８８及び横断歩道方向・横断歩道垂直方向演算部８９を備えている。各部の詳細については後述する。
【００５６】
（衝突位置予測方法）
自車両が右折又は左折して進入した道路に横断歩道が形成されている場合がある。ここで、本実施例において、自車両が右折又は左折して進入した道路に横断歩道が形成されており、且つミリ波レーダ２によって検出された横断移動体が該横断歩道上に存在するときの該横断移動体と自車両との衝突位置を予測する方法について図６に基づいて説明する。
【００５７】
横断移動体が横断歩道上に存在する場合、該横断移動体がふらつきながら進んでいたとしても、その道路形状にかかわらず該横断移動体は横断歩道の方向に進む可能性が非常に高い。そこで、このような場合、本実施例では、横断移動体と自車両との衝突位置との予測に用いる横断移動体の移動ベクトルの方向を、道路の形状に優先して、横断歩道方向に設定する。
【００５８】
図６は、本実施例に係る、衝突位置の予測に用いる横断移動体Ａの移動ベクトルの演算方法を示す図である。図６に示すように、本実施例においても、実施例１の場合と同様、先ず、レーダＥＣＵ３の物標相対位置演算部３１から入力される横断移動体Ａについての今回の位置と前回の位置とを結びつけることで仮移動ベクトルＶｖを算出する。次に、算出された仮移動ベクトルＶｖを横断歩道方向成分Ｖａ´と横断歩道垂直方向成分Ｖｂ´とに分解する。そして、該横断歩道方向成分Ｖａ´を、衝突位置予測に用いる横断移動体Ａの移動ベクトルとする。
【００５９】
このように横断移動体の移動ベクトルを演算することで、該移動ベクトルの方向を、横断移動体の基本的な進行方向である横断歩道方向に固定することができる。従って、このように算出された移動ベクトルに基づいて横断移動体と自車両との衝突位置を予測することで、その衝突位置を高精度で予測することが可能となる。
【００６０】
（衝突位置予測フロー）
本実施例に係る衝突位置予測フローについて図７に示すフローチャートに基づいて説明する。本フローは、システムＥＣＵ８に予め記憶されており、システムＥＣＵ８によって所定の間隔で繰り返し実行される。尚、本フローは、図４に示すフローにステップＳ２０３〜Ｓ２０５を追加したものである。そのため、図４に示すフローと異なる点についてのみ説明し、同一の処理を行なうステップについては同一の参照番号を付してその説明を省略する。
【００６１】
本実施例では、ステップＳ１０２において、ミリ波レーダ２で検出された物標が横断移動体であると判定された場合、次にステップＳ２０３の処理が実行される。ステップＳ２０３においては、画像センサ１０によって撮像された画像に基づいて、自車両が進入した道路に横断歩道が形成されているか否かが判定される。
【００６２】
本実施例では、画像センサ１０によって撮像された自車両が進入した道路の画像から横断歩道検出部８８によって横断歩道が検出された場合、横断歩道フラグの値が「１」となり、該画像から横断歩道が検出されない場合、横断歩道フラグの値が「０」となる。ステップＳ２０３においては、横断歩道フラグの値が「１」のときは肯定判定され、次にステップＳ２０４の処理が実行される。一方、横断歩道フラグの値が「０」のときは否定判定され、次にステップＳ１０３の処理が実行される。
【００６３】
ステップＳ２０４においては、横断移動体が横断歩道上に存在しているか否かが判定される。横断移動体が横断歩道上に存在している時は移動体位置フラグの値が「１」となり、横断移動体が横断歩道上に存在していない時は移動体位置フラグの値が「０」となる。ステップＳ２０４においては、移動体位置フラグの値が「１」のときは肯定判定され、次にステップＳ２０５の処理が実行される。一方、移動体位置フラグの値が「０」のときは否定判定され、次にステップＳ１０３の処理が実行される。
【００６４】
ステップＳ２０５においては、画像センサ１０によって撮像された画像に基づいて、横断移動体が存在している横断歩道についての横断歩道方向及び横断歩道垂直方向が算出される。尚、システムＥＣＵ８では、横断歩道方向・横断歩道垂直方向演算部８９によって該ステップＳ２０５の処理が実行される。
【００６５】
次に、ステップＳ１０５において、衝突位置の予測に用いる横断移動体の移動ベクトルが算出される。この場合、ステップＳ１０５では、横断移動体の仮移動ベクトルが算出され、更に該仮移動ベクトルがステップＳ２０５で算出された横断歩道方向及び横断歩道垂直方向の各成分に分解される。そして、仮移動ベクトルの横断歩道方向成分が、衝突位置の予測に用いる横断移動体の移動ベクトルとして算出される。
【符号の説明】
【００６６】
１・・・衝突位置予測システム
２・・・ミリ波レーダ
３・・・レーダＥＣＵ
４・・・操舵角センサ
５・・・ヨーレートセンサ
６・・・車輪速センサ
７・・・ナビゲーションシステム
８・・・システムＥＣＵ
１０・・画像センサ
３１・・物標相対位置演算部
３２・・物標相対速度演算部
８１・・右左折判定演算部
８２・・横断移動体判定演算部
８３・・道路形状取得部
８４・・道路方向・道路垂直方向演算部
８５・・移動ベクトル演算部
８６・・衝突位置演算部
８７・・衝突判定演算部
８８・・横断歩道検出部
８９・・横断歩道方向・横断歩道垂直方向演算部
【図１】
0005505427.tif 000002
【図２】
0005505427.tif 000003
【図３】
0005505427.tif 000004
【図４】
0005505427.tif 000005
【図５】
0005505427.tif 000006
【図６】
0005505427.tif 000007
【図７】
0005505427.tif 000008
【図８】
0005505427.tif 000009
【図９】
0005505427.tif 000010