車両用障害物検出装置及び車両制御システム
【課題】検出対象とする障害物が低速で移動する場合であれ、その移動態様を的確に判定する車両用障害物検出装置及び車両制御システムを提供する。
【解決手段】レーザレーダ装置により検出される自車両から障害物までの距離及び自車両を基準とした障害物が位置する方位に基づき、自車両を基準とした障害物の相対位置を所定の周期で検出する。また、車速センサにより検出される自車速、ステアリングセンサにより検出される操舵角、及びヨーレートセンサにより検出されるヨーレートに基づき自車両の移動量を算出し、先に求めた相対位置にこの移動量を加味することで障害物の絶対位置を算出する。そして、障害物の絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合Ｐｄを算出し、このばらつき度合Ｐｄに基づき障害物の移動態様を判定する。
【解決手段】レーザレーダ装置により検出される自車両から障害物までの距離及び自車両を基準とした障害物が位置する方位に基づき、自車両を基準とした障害物の相対位置を所定の周期で検出する。また、車速センサにより検出される自車速、ステアリングセンサにより検出される操舵角、及びヨーレートセンサにより検出されるヨーレートに基づき自車両の移動量を算出し、先に求めた相対位置にこの移動量を加味することで障害物の絶対位置を算出する。そして、障害物の絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合Ｐｄを算出し、このばらつき度合Ｐｄに基づき障害物の移動態様を判定する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、車両用障害物検出装置及び車両制御システムに関する。
【背景技術】
【０００２】
この種の車両用障害物検出装置としては従来、自車両前方に向けて車幅方向の所定角度範囲に渡って例えばレーザ光などの送信波を照射し、該照射された送信波が当該自車両の周辺に存在する障害物で反射される反射波に基づき、その障害物の有無や自車両から障害物までの距離、あるいは障害物の存在する方位を検出する装置が知られている。そして、こうした障害物検出装置は、先行車両などの障害物が検出されると自車両のユーザにその旨を通知すべく警報を発する警報システムや、自車両と先行車両との車間距離を適正に維持すべく自車速を制御する車両制御システムなどに適用されている。
【０００３】
具体的には、例えば特許文献１に記載の装置では、検出対象とする障害物（物標）の相対速度と自車速とを比較し、その速度差が所定の速度差範囲に収まるときこの障害物は例えば路側物などのような停止物であると判定するとともに、その速度差が所定の速度差範囲を逸脱するときこの障害物は例えば先行車両のような移動物であると判定する。これにより、例えば停止している障害物に自車両が過度に接近する可能性があると予想される場合には、その旨をユーザに通知するようにしている。なお、自車速や送信波による測距誤差を考慮して、上記速度差範囲は例えば「５ｋｍ／時」に設定されている。
【特許文献１】特開平７−２６２４９９号公報
【発明の開示】
【発明が解決しようとする課題】
【０００４】
このような従来の装置によれば、自車両が例えば「８０ｋｍ／時」のように高速で移動しているときには、例えば歩行者のような低速で移動する障害物の相対速度との速度差は自ずと小さくなり、上記速度差範囲に収まるため、この障害物は停止物であると判定することとなる。この判定結果は、実際には移動する障害物を停止物と判定するため、誤った判定結果ではあるものの、自車両と障害物との速度差が大きいことから妥当な判定結果である。
【０００５】
しかしながら、自車両が例えば「１０ｋｍ／時」のように低速で移動しているときにあっては、歩行者のような同じく低速で移動する障害物の相対速度との速度差は依然として小さく、上記速度差範囲に収まるため、やはり障害物は停止物であると判定することとなる。自車両が低速度で移動しているときとは通常、市中の走行時など、自車両は歩行者と近接している状況にあることが多い。したがって、実際には移動する障害物を停止物と判定するこの判定結果は、誤った判定結果であり、妥当な判定結果であるとも言い難い。
【０００６】
これに対し、自車速が低い場合には、上記速度差範囲を例えば「１ｋｍ／時」といったより小さな範囲に設定するなど、自車速に応じて上記速度差範囲を可変に設定することも考えられる。確かに、送信波を照射してから反射波が戻ってくるまでの時間を計測する手法によれば、上記速度差範囲をより小さく設定することは、原理上可能ではある。しかし、実際には自車両と障害物との距離を測定し、これを相対速度に変換し、さらには上記速度差に変換するため、こうした変換の際に測距離誤差が増幅されることがある。そのため、上記速度差範囲を小さく設定することは現実的に難しい。
【０００７】
本発明は、こうした実情に鑑みてなされたものであり、その目的は、検出対象とする障害物が低速で移動する場合であれ、その移動態様を的確に判定することのできる障害物検出装置及び車両制御システムを提供することにある。
【課題を解決するための手段】
【０００８】
こうした目的を達成するため、請求項１に記載の発明では、自車両から照射した送信波と、該送信波が検出対象である障害物によって反射された反射波とに基づき、前記自車両から前記障害物までの距離、前記自車両を基準とした前記障害物が位置する方位、及び前記自車両を基準とした前記障害物の相対位置をそれぞれ所定の周期で検出するレーダ手段と、前記自車両が前記周期内に移動する移動量を各周期ごとに検出する移動量検出手段と、前記移動量検出手段により検出される前記自車両の前記移動量を前記レーダ手段により検出される前記障害物の相対位置に加味することで前記障害物の絶対位置を前記周期ごとに算出する絶対位置算出手段と、前記絶対位置算出手段によって前記周期ごとに算出される前記絶対位置を複数用いた前記絶対位置のばらつきの広がりに基づき前記障害物の移動態様を判定する判定手段と、を備えることとした。
【０００９】
前記障害物が例えば移動しない停止物である場合にあっては、前記絶対位置算出手段によって前記周期ごとに算出される前記障害物の絶対位置は、座標平面上のある１点（真値）に集中して分布し、ばらつきの程度は小さい。一方、前記障害物が例えば低速度で移動する低速移動物である場合にあっては、前記周期ごとに算出される前記障害物の絶対位置は、ある程度の広がりをもって座標平面上に分布するため、ある程度ばらつくこととなる。他方、前記障害物が例えば高速度で移動する高速移動物である場合にあっては、前記周期ごとに算出される前記障害物の絶対位置は、座標平面上のより広い範囲に分布するため、大きくばらつくこととなる。したがって、車両用障害物検出装置としての上記構成によれば、前記障害物の絶対位置のばらつきの広がりを前記判定手段を通じて参照することにより、例えば前記障害物が停止物であるか、低速移動物であるか、あるいは高速移動物であるかなど、その移動態様を的確に判定することができるようになる。特に、従来難しかった低速移動物の判定についてもこれを的確に行うことができるようになる。なお、前記障害物の移動態様は、その速度のみに限られない。他に例えば、前記障害物の絶対位置が座標平面で直線状に分布している場合、これを直線運動中の移動物であると判定することができるようになる。
【００１０】
ここで、上記請求項１に記載の構成において、例えば請求項２に記載の発明では、前記絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合を算出するばらつき度合算出手段をさらに備えるとともに、前記判定手段は、前記ばらつき度合算出手段によって算出される前記ばらつき度合に基づき前記障害物の移動態様を判定することとした。これにより、前記ばらつき度合算出手段によって各周期ごとに算出される前記絶対位置のばらつきのひろがりを客観的に評価することができるようになる。
【００１１】
なお、こうした構成において、例えば請求項３に記載の発明によるように、前記移動量検出手段を、前記自車両の自車速を検出する自車速検出手段と、前記自車両の操舵角を検出する操舵角検出手段と、前記自車両のヨーレートを検出するヨーレート検出手段とを有して構成することができる。これにより自車両の移動量を精度欲求めることができるようになるので、前記障害物の絶対位置の精度が向上し、ひいては、より正確な広がり（分布）を取得することができるようになる。
【００１２】
上記請求項３に記載の構成において、例えば請求項４に記載の発明によるように、前記ばらつき度合に対して第１の判定値及び該第１の判定値よりも小さい第２の判定値を設定するとともに、前記判定手段により、前記ばらつき度合が前記第１の判定値を超えるとき前記障害物は高速移動物であると判定し、前記ばらつき度合が前記第１の判定値に達せず前記第２の判定値を超えるとき前記障害物は低速移動物であると判定し、前記ばらつき度合が前記第２の判定値に達しないとき前記障害物は停止物であると判定すれば、前記ばらつき度合の前記第１及び第２の判定値への到達態様に基づき前記障害物の移動態様を直接判定することができるようになる。
【００１３】
上述したように、前記障害物の絶対位置のばらつきの広がりを前記判定手段を通じて参照することで、従来難しかった低速移動物をより的確に判定できるようになる。とはいえ、前記レーダ手段の測距誤差は大きく、しかも、低速度領域にある障害物には、例えば歩行者も含まれる。したがって、低速移動物の判定については、より高い信頼性が求められる。
【００１４】
その点、上記請求項４に記載の構成において、例えば請求項５に記載の発明では、前記判定手段は、前記所定の周期で前記障害物の移動態様を判定するとともに、前記ばらつき度合が前記第１の判定値に達せず前記第２の判定値を超える周期が連続して所定数を超えるとき、前記障害物は低速移動物であると判定することとした。これにより、前記障害物が停止物であるか、あるいは低速移動物であるかについての判定を、より慎重に行うことができ、この判定についての信頼性をより高めることができるようになる。
【００１５】
なお、そうした第１の判定値としては、例えば請求項６に記載の発明によるように、前記レーダ手段により検出される前記距離及び前記方位並びに前記自車速検出手段により検出される前記自車速に基づき検出不能な前記障害物の相対速度の上限値に対応する前記ばらつき度合を採用することが望ましい。
【００１６】
一方、上記請求項３に記載の構成において、例えば請求項７に記載の発明では、前記レーダ手段により検出される前記距離及び前記方位並びに前記自車速検出手段により検出される前記自車速に基づき前記障害物の相対速度を検出する相対速度検出手段をさらに備え、前記相対速度検出手段によって検出される前記障害物の前記相対速度と前記自車速検出手段によって検出される前記自車速との速度差に対し所定範囲を設定するとともに前記ばらつき度合に対して判定値を設定し、前記判定手段により、前記速度差が前記所定範囲を逸脱するとき前記障害物は高速移動物であると判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値を超えるとき前記障害物は低速移動物であると判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値に満たないとき前記障害物は停止物であると判定することとした。これにより、前記障害物の移動態様についての判定にかかる適正性を維持しつつ、演算負荷を低減することができるようになる。
【００１７】
これもまた上述したように、前記障害物の絶対位置のばらつきの広がりを前記判定手段を通じて参照することで、従来難しかった低速移動物をより的確に判定できるようになる。しかしながら、やはり前記レーダ手段の測距誤差は大きく、しかも、低速度領域にある障害物には、例えば歩行者も含まれる。したがって、低速移動物の判定については、より高い信頼性が求められる。
【００１８】
その点、上記請求項７に記載の構成において、例えば請求項８に記載の発明では、前記判定手段は、前記所定の周期で前記障害物の移動態様を判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値を超える周期が連続して所定数を超えるとき、前記障害物は低速移動物であると判定することとした。これにより、前記障害物が停止物であるか、あるいは低速移動物であるかについての判定を、より慎重に行うことができ、この判定についての信頼性をより高めることができるようになる。
【００１９】
なお、そうした所定範囲及び判定値としては、例えば請求項９に記載の発明によるように、前記相対速度検出手段により検出可能な前記障害物の相対速度の下限値及び前記相対速度検出手段により検出不能な前記障害物の相対速度の上限値に対応する前記ばらつき度合よりも小さい値を採用することが望ましい。
【００２０】
他方、車両用障害物検出装置に対しては、低速移動物の中から特に歩行者を峻別することが望まれている。その点、上記請求項４〜９のいずれかに記載の構成において、例えば請求項１０に記載の発明では、前記レーダ手段は、前記送信波及び前記反射波に基づき前記障害物の大きさを検出し、前記判定手段は、低速移動物であると判定された前記障害物の大きさが所定の大きさよりも小さいとき、前記障害物は歩行者であると判定することとした。これにより、歩行者を正確に峻別することが可能となり、例えば歩行者保護用のエアバックシステムや、プリクラッシュシステムなどの実現が容易になる。
【００２１】
なお、請求項１１に記載の発明では、上記請求項１〜１０のいずれかに記載の車両用障害物検出装置と、該車両用障害物検出装置を通じて判定される前記障害物の移動態様に応じて前記自車両を制御する車両制御手段とを備えて車両制御システムを構成することとした。これにより、検出対象とする障害物が低速で移動する場合であれ、その移動態様を的確に判定することができることはもとより、自車両を的確に制御することができるようにもなる。
【発明を実施するための最良の形態】
【００２２】
以下、本発明にかかる車両用障害物検出装置及び車両制御システムにかかる一実施の形態について、図１〜図７を参照して説明する。なお、この実施の形態では、以下に詳述するように、まず、レーザレーダ装置により検出される自車両から障害物までの距離及び自車両を基準とした障害物が位置する方位に基づき、自車両を基準とした障害物の相対位置を所定の周期で検出する。また、車速センサにより検出される自車速、ステアリングセンサにより検出される操舵角、及びヨーレートセンサにより検出されるヨーレートに基づき自車両の移動量を算出し、先に求めた相対位置にこの移動量を加味することで障害物の絶対位置を算出する。そして、障害物の絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合を算出し、このばらつき度合に基づき障害物の移動態様を判定する。このようにして、検出対象とする障害物が低速で移動する場合であれ、その移動態様を的確に判定しようとしている。
【００２３】
図１は、本発明にかかる車両制御システムの一実施の形態について、車両用障害物検出装置も含め、その全体構成を示すブロック図である。まず、この図１を参照しつつ、この実施の形態の構成について説明する。
【００２４】
同図１に示されるように、この実施の形態の車両制御システム１は、車両用障害物検出装置としての機能を備えるコンピュータ４を中心に構成されている。コンピュータ４は、マイクロコンピュータを主な構成として、入出力インターフェース（Ｉ／Ｏ）及び各種の駆動回路や検出回路を有して構成されている。なお、これらは一般的に使用されているため、そのハードウエアに関する詳細な説明を割愛する。
【００２５】
同図１に示されるように、コンピュータ４には、レーザレーダ装置（レーダ手段）５をはじめとして、自車両の速度を検出する車速センサ（自車速検出手段）７、その踏み込み量に応じて自車両に付与される制動力が変化するブレーキペダル（図示略）の設定状態を検出するブレーキスイッチ９、スロットルバルブの開度を検出するスロットル開度センサ１１等々が接続されている。そしてこれら各種センサ及びスイッチは、所定の検出データ及びその設定状態に関する情報をそれぞれコンピュータ４へ出力している。
【００２６】
また、コンピュータ４は、例えば障害物が自車両に接近したときにその旨を報知する警報音発生器１３、レーダレーダ装置５によって検出された自車両から障害物までの距離を表示する距離表示器１５、レーザレーダ装置５に異常がある場合にその旨を報知するセンサ異常表示器１７、自車両に制動力を付与するブレーキを駆動するブレーキ駆動器１９、吸入空気量を調整するためのスロットル駆動器２１、及び自動変速機制御器２３等に所定の駆動信号を出力している。
【００２７】
さらに、コンピュータ４には、図１に示されるように、上記警報音発生器１３から発せられる警報の音量を設定するための警報音量設定器２４、その感度を設定する警報感度設定器２５、クルーズコントロールスイッチ２６、図示しないステアリングホイールの操作量を検出するステアリングセンサ２７、及びヨーレートセンサ２８が接続されている。そして、コンピュータ４には、例えばイグニッションスイッチなどの電源スイッチ２９が接続されており、そのオン操作を通じて後述する各種所定の処理が実行される。
【００２８】
ここで、図１に示されるように、レーザレーダ装置５は、送受信機３１及び該送受信機３１を制御する制御部３３を有して構成されている。このうち、送受信機３１は、制御部３３によって制御されることにより、所定の光軸（中心軸）を中心とした車幅方向の所定角度範囲にレーザ光を不連続に掃引照射（スキャン）するとともに、この照射したレーザ光の反射光を捕捉する部分である。そして制御部３３は、送受信機３１にレーザ光を照射させてからそのレーザ光が自車両の周辺に存在する障害物によって反射される反射光を受信するまでの経過時間を照射角度の別に取得する。そして、照射角度の別に取得した上記経過時間を含め、測距にかかる各種データをコンピュータ４に出力する。なお、送受信機３１により照射するレーザビームの形状は、略円形、楕円形、長方形等、どのような形状でもよい。
【００２９】
このように構成されたコンピュータ４は、例えば、
・自車両の周辺に存在する障害物が所定の警報領域に所定時間存在した場合等に警報を発する警報判定処理。
・障害物が、移動しない停止物であるか、低速で移動する低速移動物であるか、あるいは高速で移動する高速移動物であるか等について判定を行う移動態様判定処理。
・移動態様判定処理を通じて低速移動物であると判定された障害物が歩行者であるか否かについて判定を行う歩行者判定処理。
・移動態様判定処理を通じて高速移動物であると判定された障害物が先行車であるか否かについて、及び移動態様判定処理を通じて低速移動物であると判定された障害物が先行車であるか否かについて判定を行う先行車判定処理。
・先行車判定処理を通じて障害物が先行車であると判定された場合には、ブレーキ駆動器１９、スロットル駆動器２１、及び自動変速制御器２３等に駆動信号を出力することにより、先行車の走行状況に応じて車間を制御するクルーズ制御処理。
等々の各種処理を実行する。
【００３０】
図２に、こうしたコンピュータ４の制御ブロック図を示し、この図２を参照して上記各種処理を実行する各要素の機能についてさらに説明する。
【００３１】
車速演算部４２は、車速センサ７から車速信号の供給を受けて該車速信号に基づき車速を逐次算出する。同じく、ヨーレート演算部４３は、ヨーレートセンサ２８からヨーレート信号の供給を受けて該ヨーレート信号に基づきヨーレートを逐次算出する。また、同じく操舵角演算部４４は、ステアリングセンサ２７から舵角信号の供給を受けて該舵角信号に基づき操舵角を逐次算出する。そしてこれら各演算部４２〜４４はそれぞれ、物体認識部（絶対位置算出手段）４１及びカーブ半径算出部４５に演算結果を供給している。
【００３２】
このうち、物体認識部４１に対しては、レーザレーダ装置５（正確には制御部３３（図１参照））も接続されており、上述した測距にかかる各種データが供給されている。すなわち、物体認識部４１は、車速センサ７で検出（正確には車速演算部４２で演算）された自車速、ヨーレートセンサ２８で検出された（正確にはヨーレート演算部４３で演算された）ヨーレート、及びステアリングセンサ２７で検出された（正確には操舵角演算部４４で演算された）操舵角を用いて、レーザレーダ装置５から供給された各種データを絶対座標系に変換する部分である。
【００３３】
具体的には、物体認識部４１は、レーザレーダ装置５から供給されたデータに基づき自車両から障害物までの距離及び自車両を基準とした障害物が位置する方位（角度）を算出する。そして、この距離及び角度から、自車両に対する障害物の相対位置を算出する。また、物体認識部４１は、車速演算部４２により演算される自車速、ヨーレート演算部４３により演算されるヨーレート、及び操舵角演算部４４により演算される操舵角に基づいて、自車両の移動量を算出する。そして自車両に対する障害物の相対位置に、こうして求められた移動量を加味することで障害物の絶対位置を算出する。なお、物体認識部４１は、レーザレーダ装置５により検出される上記距離及び上記角度の時間的変化に基づき、障害物の相対速度を検出する相対速度検出手段としての機能も併せ有している。また、物体認識部４１にて実行される絶対位置の算出にかかる処理等については、図３を参照して後述する。
【００３４】
一方、カーブ半径算出部４５は、車速演算部４２で演算された自車速、ヨーレート演算部４３で演算されたヨーレート、及び操舵角演算部４４で演算された操舵角に基づき、カーブ半径（曲率半径）Ｒを算出する。こうして算出されたカーブ半径Ｒに関する情報は、車両制御部５０に供給されている。
【００３５】
また、センサ異常検出部４６は、物体認識部４１において絶対座標系に変換されたデータが異常であるかどうかを検出する。そしてそのデータに異常が検出されるとき、センサ異常表示器１７にその旨を表示する。
【００３６】
移動態様判定部（判定手段）４７は、物体認識部４１によって算出される障害物の相対速度と車速演算部４２によって算出される自車速との速度差を算出するとともに、物体認識部４１によって算出される障害物の絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合を算出する。そして、上記速度差が設定した所定範囲を逸脱するとき、障害物は高速移動物であると判定する。また、上記速度差が上記所定範囲に収まるとともに上記ばらつき度合が設定した判定値を超えるとき、障害物は低速移動物であると判定する。また、上記速度差が上記所定範囲に収まるとともに上記ばらつき度合が設定した判定値に満たないとき、障害物は停止物であると判定する。
【００３７】
このような判定方式を採用した理由は、レーザレーダ装置５が測定する距離、さらには、レーザデータ装置５及び各種センサの測定結果に基づいて算出される障害物の絶対位置に誤差が含まれているためである。つまり、レーザレーダ装置５が測定する距離に誤差が含まれることにより、その時間的変化として求められる相対速度も誤差を含む。このため、特に低速で移動する物体について、それが移動物であるか、停止物であるかを精度良く判定することが困難になる。
【００３８】
そこで、この実施の形態では、障害物の絶対位置を算出してそのばらつき度合から低速移動物か停止物かを判定することとした。上述したように、障害物の絶対位置はレーザレーダ装置５の測定結果に基づいて算出されるため、誤差を含む。しかし、複数の絶対位置のばらつきの大きさが上述した誤差に起因する範囲内に収まっている場合には停止物と判定できる。一方、複数の絶対位置のばらつきの大きさが、誤差に起因する範囲を逸脱していると、正確な速度は不明ではあるが、少なくとも低速で移動している低速移動物と判定できる。
【００３９】
このようにして、障害物の移動態様を判定すると、図２に示されるように、歩行者判定部４８及び先行車判定部４９に対し、その判定結果を出力する。なお、こうした移動態様判定処理の具体的な処理手順については、図５を参照して後述する。
【００４０】
歩行者判定部４８は、移動態様判定部４７の判定処理を通じて低速移動物であると判定された障害物に対し、その大きさが所定の大きさを超えるか否かを判定することで、この低速移動物が歩行者であるか否かを判定する。そして、低速移動物であると判定された障害物が歩行者でないと判定されるとき、後述する先行車判定部４９に対しその判定結果を出力する。一方、移動態様判定部４７の判定処理を通じて低速移動物であると判定された障害物が歩行者であると判定されるとき、後述する車両制御部５０に対しその判定結果を出力する。なお、こうした歩行者判定処理の具体的な処理手順については、図６を参照して後述する。
【００４１】
先行車判定部４９は、上記移動態様判定部４７の判定処理を通じて高速移動物であると判定された障害物、上記歩行者判定部４８の判定処理を通じて歩行者でない低速移動物であると判定された障害物に対し、その大きさが所定の大きさを超えるか否かを判定する。そしてその大きさが所定の大きさを超えると判定されるとき、この障害物は先行車であると判定し、車両制御部５０に対しその判定結果を出力する。なお、こうした先行車判定処理の具体的な判定手順については、図７を参照して低速域クルーズ制御処理と併せて後述する。
【００４２】
車両制御部５０は、上記カーブ半径算出部４５で算出されたカーブ半径、上記先行車判定部４９での判定結果、及び上記歩行者判定部４８での判定結果に基づき、警報判定処理及びクルーズ制御処理を実行する。特に、低速域でのクルーズ制御処理については、図７を用いて後述する。
【００４３】
なお、車速演算部４２、ヨーレート演算部４３、操舵角演算部４４、カーブ半径算出部４５、センサ異常検出部４６、物体認識部４１、移動態様判定部４７、歩行者判定部４８、先行車判定部４９、及び車両制御部５０は、コンピュータ４のプログラム上で実現される機能である。ここでは、概念的に各種構成要素として説明した。
【００４４】
図３は、検出対象である障害物の位置及び自車両の位置を含めた絶対座標平面を示す図である。次に、この図３を参照して上記物体認識部４１にて実行される障害物の絶対位置の算出にかかる処理について説明する。
【００４５】
上記物体認識部４１は、基本的には、
（ａ１）レーザレーダ装置５により検出される距離及び角度に基づき障害物の相対位置を算出する処理。
（a２）ステアリングセンサ２７により検出される操舵角及び車速センサ７により検出される自車速に基づき自車両の移動量を算出する処理。
等々の処理を、所定の時間間隔「Δｔ（例えば１００ミリ秒）」毎に実行することで、障害物の絶対座標系の位置（絶対位置）を算出するようにしている。
【００４６】
具体的には、上記（a１）及び（a２）の処理を通じて、下式（１）〜（４）を算出している。
【００４７】
【数１】
ここで、上式（１）〜（４）において、「ｘａｎ」は時刻ｎでの障害物のｘ軸方向の絶対位置を、「ｙａｎ」は時刻ｎでの障害物のｘ軸方向の絶対位置を、「ｘｎ」は時刻ｎでの障害物のｘ軸方向の相対位置を、「ｙｎ」は時刻ｎでの障害物のｙ軸方向の相対位置を、「Ｖｘｎ」は時刻ｎでのｘ軸方向の自車速を、「Ｖｙｎ」は時刻ｎでのｙ軸方向の自車速を、「Δｔ」は測距周期を、それぞれ表す。
【００４８】
また、上式（１）〜（４）において、時刻ｎでのｘ軸方向の自車速「Ｖｘｎ」及び時刻ｎでのｙ軸方向の自車速「Ｖｙｎ」は、時刻ｎでの自車速「Ｖｎ」及び時刻ｎでの操舵角「φｎ」を用いた下式（５）及び（６）に示される関係となっている。
【００４９】
【数２】
なお、この実施の形態では、現時刻「ｎ」から９時点遡った時刻「ｎ−９」まで、すなわち１０時点に渡る各種測距データを使用しているが、このデータ数は任意であり、コンピュータ４に実装されるメモリや演算能力に応じて適宜変更可能な要素である。
【００５０】
このようにして各時点において算出された障害物の絶対位置は、例えば図４（a）〜（ｃ）に示す態様でばらつく（分布する）こととなる。すなわち、障害物が停止物である場合にあっては、図４（ａ）に示されるように、上記物体認識部４１によって所定の周期ごとに算出される障害物の絶対位置は、座標平面上のある１点（真値）に集中して分布し、ばらつきの程度は小さい。一方、障害物が低速度で移動する低速移動物である場合にあっては、図４（ｂ）に示されるように、上記物体認識部４１によって所定の周期ごとに算出される障害物の絶対位置は、ある程度の広がりをもって座標平面上に分布するため、ある程度ばらつくこととなる。他方、障害物が例えば高速度で移動する高速移動物である場合にあっては、図４（ｃ）に示されるように、上記物体認識部４１によって所定の周期ごとに算出される障害物の絶対位置は、座標平面上のより広い範囲に分布するため、大きくばらつくこととなる。したがって、障害物の絶対位置のばらつきに基づくことで、例えば障害物が停止物であるか、低速移動物であるか、あるいは高速移動物であるかなど、その移動態様を判定することができる。なお、この障害物の移動態様は、その速度のみに限られない。他に例えば、障害物の絶対位置が座標平面で直線状に分布している場合、これを直線運動中の移動物であると判定することができるようにもなる。
【００５１】
そうした移動態様を判定する上記移動態様判定部４７について説明する。移動態様判定部４７は、上記物体認識部４１により所定の周期ごとに算出された障害物の絶対位置に関する複数の情報をもとに、その絶対位置のばらつきの広がりに応じた大きさの値を返す例えば下式（７）で表される評価関数を通じてばらつき度合Ｐｄを算出する。これにより、移動態様判定部４７によって各周期ごとに算出される絶対位置のばらつきのひろがりを客観的に評価することができるようになる。
【００５２】
【数３】
なお、上式（７）で示される評価関数を採用すると、移動速度が大きくなるほど、すなわち、障害物が高速移動物であるほど、ばらつき度合Ｐｄは大きくなる。一方、移動速度が小さくなるほど、すなわち、障害物が停止物であるほど、ばらつき度合Ｐｄは小さくなる。
【００５３】
図５に、上記移動態様判定部４７によって実行される移動態様判定処理の具体的な処理手順を示す。なお、この移動態様判定処理も、所定の時間間隔「Δｔ（例えば１００ミリ秒）」で繰り返し実行されている。
【００５４】
障害物の移動態様判定処理が開始されると、移動態様判定部４７は、まず、ステップＳ５０１の処理として、上記物体認識部４１で算出される障害物の相対速度を取り込む。そして、続くステップＳ５０３の処理として、上記相対速度と自車速との速度差を算出する。また、続くステップＳ５０５の処理として、上式（１）〜（４）に基づき障害物の絶対位置を算出する。なお、現時点ｎから所定時点（この実施の形態では９時点）遡った測距データを利用して上式（７）に基づき絶対位置のばらつき度合Ｐｄを算出するため、ステップＳ５０７の処理においては、先のステップＳ５０５の処理において算出した絶対位置をコンピュータ４等に適宜に設けられるメモリに記憶保持する。
【００５５】
そして、移動態様判定部４７は、ステップＳ５０９の判断処理において、上記ステップＳ５０３の処理で算出された上記速度差が所定範囲（例えば「５ｋｍ／時」）に収まるかあるいは逸脱するかを判断する。ここで上記速度差が所定範囲を逸脱すると判断されるとき（Ｎｏ）、続くステップＳ５１１の処理として、移動態様判定部４７は、障害物を高速移動物であると判定する。
【００５６】
一方、先のステップＳ５０９の判断処理において、上記速度差が所定範囲内に収まると判断されるとき（Ｙｅｓ）、移動態様判定部４７は、続くステップＳ５１３の処理に移行し、上式（７）に基づき過去１０点について絶対位置のばらつき度合Ｐｄを算出する。こうしてばらつき度合Ｐｄが算出されると、移動態様判定部４７は、続くステップＳ５１５の判断処理において、ばらつき度合Ｐｄが所定の判定値（例えば「１０」）を超えるか否かを判断する。ここで、ばらつき度合Ｐｄが判定値を超えないと判断されるとき（Ｎｏ）、続くステップＳ５１７の処理として、障害物を停止物であると判定する。
【００５７】
他方、先のステップＳ５１５の判断処理において、ばらつき度合Ｐｄが判定値を超えると判断されるとき（Ｙｅｓ）、移動態様判定部４７は、続くステップＳ５１９の判断処理として、こうした判断がなされた周期が連続して所定数（例えば「３」）を超えるか否かを判断する。ここで所定数に満たないと判断されるとき（Ｎｏ）、先のステップＳ５１７の処理として、障害物を停止物であると判定する。しかしながら、ステップＳ５１９の判断処理において、上記周期が連続して所定数を超えると判断されるとき（Ｙｅｓ）、移動態様判定部４７は、続くステップＳ５２１の処理として、障害物を低速移動物であると判定する。
【００５８】
以上のように、この実施の形態では、高速移動物に対しては、従来から実行されている演算負荷の少ない上記速度差に基づく判定を実行する（ステップＳ５０９の判断処理）とともに、この速度差に基づく判定では的確に判定することの難しかった低速移動物に対しては、上記ばらつき度合Ｐｄに基づく判定（ステップＳ５１５の判断処理）を実行している。これにより、障害物の移動態様についての判定にかかる適正性を維持しつつ、演算負荷を好適に低減することができる。
【００５９】
また、この実施の形態では、上記速度差が上記所定範囲に収まるとともに上記ばらつき度合Ｐｄが上記判定値を超える周期が連続して所定数を超えるとき（ステップＳ５１９の判断処理（図５））、障害物は低速移動物であると判定することとした。これにより、障害物が停止物であるか、あるいは低速移動物であるかについての判定を、より慎重に行うことができ、この判定についての信頼性をより高めることができる。
【００６０】
図６に、上記歩行者判定部４８によって実行される歩行者判定処理の具体的な処理手順を示すフローチャートを示す。なお、この歩行者判定処理も、所定の時間間隔「Δｔ（例えば１００ミリ秒）」で繰り返し実行されている。
【００６１】
同図６に示されるように、歩行者判定部４８は、まず、ステップＳ６０１の判断処理として、上記移動態様判定処理（図５）において障害物は低速移動物であると判定されたか否かを判断する。ここで、低速移動物であると判断されなかったとき（Ｎｏ）、歩行者判定部４８は、そのままこの処理を一旦終了する。
【００６２】
一方、先のステップＳ６０１の判断処理において、障害物が低速移動物であると判断されたとき（Ｙｅｓ）、歩行者判定部４８は、続くステップＳ６０３の処理として、上記物体認識部４１に対し障害物の横幅を算出させる。続くステップＳ６０５の判断処理において、算出された障害物の横幅が所定値（例えば「７５ｃｍ」）を越えるか否かを判断する。ここで、算出した障害物の横幅が所定値を超えると判断されるとき（Ｙｅｓ）、一般的な歩行者の大きさを超えているため、そのままこの処理を一旦終了する。
【００６３】
他方、ステップＳ６０５の判断処理において、先のステップＳ６０３の処理にて算出された障害物の横幅が所定値に満たないと判断されるとき（Ｎｏ）、この障害物は低速で移動するとともにその大きさが一般的な歩行者の大きさに近いため、ステップＳ６０７の処理として、低速移動物を歩行者であると判定する。
【００６４】
以上説明したこの実施の形態の歩行者判定処理によれば、歩行者を正確に峻別することが可能となり、例えば歩行者保護用のエアバックシステムや、プリクラッシュシステムなどの実現が容易になる。
【００６５】
なお、この実施の形態では、上記所定値として例えば「７５ｃｍ」を採用したが、これに限られない。他にも上記所定値として例えば「１ｍ」を採用することとしてもよい。要は、歩行者である旨の判断を行うことのできる値であれば任意である。
【００６６】
図７に、車両制御部５０によって実行される上記車両制御処理のうち、特に低速域でのクルーズ制御処理について具体的な処理手順を示したフローチャートを示す。
【００６７】
この低速域でのクルーズ制御処理が開始される状況としては、例えば自車両が渋滞の最後尾に着いた状況のように、自車両前方に存在する停止物に衝突しないように自車両を停止させた後、あるいは、例えば渋滞に巻き込まれた先行車が発進と停止を繰り返す状況のように、先行車に追従して自車両を停止させた後が挙げられる。いずれの場合であれ、図７に示す低速域クルーズ制御処理は、自車両が一度停止した後に開始される。なお、この低速域クルーズ制御処理も、所定の時間間隔「Δｔ（例えば１００ミリ秒）」で繰り返し実行されている。また、同図７から明らかなように、ステップＳ６０１の判断処理及びステップＳ６０３の処理については、先の図６に示す歩行者判定処理の一部に準じた処理であるため、ここでの説明を割愛する。
【００６８】
車両制御部５０は、ステップＳ７０５の判断処理において、先のステップＳ６０３の処理にて算出した障害物の横幅が所定値（例えば「７５ｃｍ」）を超えるか否かを判断する。ここで、算出された障害物の横幅が所定値を超えると判断されるとき（Ｙｅｓ）、この障害物は低速で移動するとともにその大きさが一般的な歩行者の大きさを超えるため、続くステップＳ７０７の処理として、低速移動物を先行車であると判定する。そして、車両制御部５０は、先行車が低速で移動しているため、続くステップＳ７０９の処理として、自車両を発進させる。
【００６９】
なお、先のステップＳ６０１の判断処理において低速移動物と判定されない（Ｎｏ）、あるいは、先のステップＳ７０５の判断処理において障害物の横幅が所定値を超えない（Ｙｅｓ）と判断されるとき、車両制御部５０は、ステップＳ７１１の処理として、自車両の停止状態を維持する。
【００７０】
以上説明したこの実施の形態の低速域クルーズ制御処理によれば、低速で移動する先行車を的確に判定することができないことに起因して先行車が自車両からかなり離れた後にしか自車両を発進させることができなかった従来技術に比して、低速で移動する先行車が発進してからこれに追従して自車両を発進させるまでに必要とされる時間を短縮することができるようになる。
【００７１】
なお、この実施の形態では、上記所定値として例えば「７５ｃｍ」を採用したが、これに限られない。他にも上記所定値として例えば「１ｍ」を採用することとしてもよい。要は、先行車である旨の判断を行うことのできる値であれば任意である。
（その他の実施の形態）
なお、この発明にかかる車両用障害物検出装置及び車両制御システムは上記実施の形態にて例示した構成に限定されるものではなく、同実施の形態を適宜変更した例えば次の形態として実施することもできる。
【００７２】
上記実施の形態では、先の図５に示すように、上記速度差に対する上記所定範囲として例えば「５ｋｍ／時」を採用するとともに、上記ばらつき度合Ｐｄに対する上記判定値として例えば「１０」を採用していたが、これらの値に限られない。上記所定範囲としては、物体認識部４１により検出可能な障害物の相対速度の下限値を採用し、上記判定値としては、物体認識部４１により検出不能な障害物の相対速度の上限値に対応するばらつき度合よりも小さな値を採用することができる。
【００７３】
また、上記実施の形態では、先の図５に示した移動態様判定処理を上記移動態様判定部４７により実行することで障害物の移動態様を判定することとしたが、他に例えば、図８に示す移動態様判定処理を上記移動態様判定部４７により実行することで障害物の移動態様判定してもよい。すなわち、図８に示されるように、上記速度差が所定範囲に収まるか逸脱するかを判断したステップＳ５０９の判断処理（図５）に替えて、ばらつき度合Ｐｄが第１の判定値（例えば「５０」）を超えるか否かを判断するステップＳ８０９の判断処理を実行してもよい。これにより、ばらつき度合Ｐｄの第１の判定値及び第２の判定値（例えば「１０」、ステップＳ５１５ａの処理）への到達態様に基づき、障害物の移動態様を直接判定することができるようになる。
【００７４】
なお、この変形例において採用される第１及び第２の判定値も変更可能である。すなわち、上記第１の判定値としては、レーザレーダ装置５により検出される自車両から障害物までの距離及び自車両を基準とした障害物の位置する方位並びに車速センサ７により検出される自車速に基づき検出不能な障害物の相対速度の上限値に対応するばらつき度合を採用することができる。
【００７５】
上記実施の形態（変形例も含む）では、同一の判断が行われた周期が所定数を超えるか否かの判断処理（ステップＳ５１９（図５）、あるいはステップＳ８１９（図８））を実行していたが、これを割愛してもよい。そもそも、ばらつき度合Ｐｄは、過去所定回数に渡った検出結果に基づく値であるため、その信頼性が高い。したがって、この処理を割愛しても、障害物の移動態様を的確に判断することはできる。
【００７６】
上記実施の形態（変形例も含む）では、移動量検出手段として、自車両の自車速を検出する車速センサ７、自車両の操舵角を検出するステアリングセンサ２７、及び自車両のヨーレートを検出するヨーレートセンサ２８により構成することとしたが、ステアリングセンサ２７及びヨーレートセンサ２８のいずれか一方を割愛する構成としても、自車両の移動量を検出することはできる。
【００７７】
上記実施の形態（変形例も含む）では、移動態様判定部４７による判定を通じて低速移動物であると判定された障害物が歩行者であるか否かについて判定を行う歩行者判定処理（図６）を実行する歩行者判定部４８を備えることとしたが、これを割愛してもよい。割愛した構成によっても、所期の目的を達成することはできる。
【００７８】
上記実施の形態（変形例も含む）では、絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数として上式（７）で表される関数を採用したが、これに限らない。他に例えば、標準偏差、あるいは分散などの評価関数を適宜に採用することができる。要は、絶対位置のばらつきの広がりを客観的に評価できる評価関数であれば、その関数は任意である。
【図面の簡単な説明】
【００７９】
【図１】本発明にかかる車両用障害物検出装置及び車両制御システムの一実施の形態について、その全体の構成を示すブロック図。
【図２】同実施の形態で採用されるコンピュータの制御ブロック図。
【図３】同実施の形態において、検出対象である障害物の位置及び自車両の位置を含めた絶対座標平面を示す図。
【図４】（ａ）は、検出した障害物が停止物である場合について、その絶対位置のばらつきを示した図。（ｂ）は、検出した障害物が低速移動物である場合について、その絶対位置のばらつきを示した図。（ｃ）は、検出した障害物が高速移動物である場合について、その絶対位置のばらつきを示した図。
【図５】同実施の形態において、検出した障害物の移動態様を判定する移動態様判定処理の処理手順を示すフローチャート。
【図６】同実施の形態において、低速移動物であると判定した障害物が歩行者であるか否かを判定する歩行者判定処理の処理手順を示すフローチャート。
【図７】同実施の形態において、低速移動物であると判定した障害物が先行車であるときに実行される低速度域クルーズ制御処理の処理手順を示すフローチャート。
【図８】同実施の形態の変形例として、検出した障害物の移動態様を判定する移動態様判定処理について、処理手順を示すフローチャート。
【符号の説明】
【００８０】
１…車両制御システム（車両用障害物検出装置）、４…コンピュータ、５…レーザレーダ装置（レーダ手段）、７…車速センサ（自車速検出手段、移動量検出手段）、９…ブレーキスイッチ、１１…スロットル開度センサ、１３…警報音発生器、１５…距離表示器、１７…センサ異常表示器、１９…ブレーキ駆動器、２１…スロットル駆動器、２３…自動変速制御器、２４…警報音量設定器、２５…警報感度設定器、２６…クルーズコントロールスイッチ、２７…ステアリングセンサ（操舵角検出手段、移動量検出手段）、２８…ヨーレートセンサ（ヨーレート検出手段、移動量検出手段）、２９…電源スイッチ、３１…送受信機、３３…制御部、４１…物体認識部（絶対位置算出手段、相対位置算出手段、相対速度検出手段）、４２…車速演算部、４３…ヨーレート演算部、４４…操舵角演算部、４５…カーブ半径算出部、４６…センサ異常検出部、４７…移動態様判定部（判定手段、ばらつき度合算出手段）、４８…歩行者判定部、４９…先行車判定部、５０…車両制御部（車両制御手段）。
【技術分野】
【０００１】
本発明は、車両用障害物検出装置及び車両制御システムに関する。
【背景技術】
【０００２】
この種の車両用障害物検出装置としては従来、自車両前方に向けて車幅方向の所定角度範囲に渡って例えばレーザ光などの送信波を照射し、該照射された送信波が当該自車両の周辺に存在する障害物で反射される反射波に基づき、その障害物の有無や自車両から障害物までの距離、あるいは障害物の存在する方位を検出する装置が知られている。そして、こうした障害物検出装置は、先行車両などの障害物が検出されると自車両のユーザにその旨を通知すべく警報を発する警報システムや、自車両と先行車両との車間距離を適正に維持すべく自車速を制御する車両制御システムなどに適用されている。
【０００３】
具体的には、例えば特許文献１に記載の装置では、検出対象とする障害物（物標）の相対速度と自車速とを比較し、その速度差が所定の速度差範囲に収まるときこの障害物は例えば路側物などのような停止物であると判定するとともに、その速度差が所定の速度差範囲を逸脱するときこの障害物は例えば先行車両のような移動物であると判定する。これにより、例えば停止している障害物に自車両が過度に接近する可能性があると予想される場合には、その旨をユーザに通知するようにしている。なお、自車速や送信波による測距誤差を考慮して、上記速度差範囲は例えば「５ｋｍ／時」に設定されている。
【特許文献１】特開平７−２６２４９９号公報
【発明の開示】
【発明が解決しようとする課題】
【０００４】
このような従来の装置によれば、自車両が例えば「８０ｋｍ／時」のように高速で移動しているときには、例えば歩行者のような低速で移動する障害物の相対速度との速度差は自ずと小さくなり、上記速度差範囲に収まるため、この障害物は停止物であると判定することとなる。この判定結果は、実際には移動する障害物を停止物と判定するため、誤った判定結果ではあるものの、自車両と障害物との速度差が大きいことから妥当な判定結果である。
【０００５】
しかしながら、自車両が例えば「１０ｋｍ／時」のように低速で移動しているときにあっては、歩行者のような同じく低速で移動する障害物の相対速度との速度差は依然として小さく、上記速度差範囲に収まるため、やはり障害物は停止物であると判定することとなる。自車両が低速度で移動しているときとは通常、市中の走行時など、自車両は歩行者と近接している状況にあることが多い。したがって、実際には移動する障害物を停止物と判定するこの判定結果は、誤った判定結果であり、妥当な判定結果であるとも言い難い。
【０００６】
これに対し、自車速が低い場合には、上記速度差範囲を例えば「１ｋｍ／時」といったより小さな範囲に設定するなど、自車速に応じて上記速度差範囲を可変に設定することも考えられる。確かに、送信波を照射してから反射波が戻ってくるまでの時間を計測する手法によれば、上記速度差範囲をより小さく設定することは、原理上可能ではある。しかし、実際には自車両と障害物との距離を測定し、これを相対速度に変換し、さらには上記速度差に変換するため、こうした変換の際に測距離誤差が増幅されることがある。そのため、上記速度差範囲を小さく設定することは現実的に難しい。
【０００７】
本発明は、こうした実情に鑑みてなされたものであり、その目的は、検出対象とする障害物が低速で移動する場合であれ、その移動態様を的確に判定することのできる障害物検出装置及び車両制御システムを提供することにある。
【課題を解決するための手段】
【０００８】
こうした目的を達成するため、請求項１に記載の発明では、自車両から照射した送信波と、該送信波が検出対象である障害物によって反射された反射波とに基づき、前記自車両から前記障害物までの距離、前記自車両を基準とした前記障害物が位置する方位、及び前記自車両を基準とした前記障害物の相対位置をそれぞれ所定の周期で検出するレーダ手段と、前記自車両が前記周期内に移動する移動量を各周期ごとに検出する移動量検出手段と、前記移動量検出手段により検出される前記自車両の前記移動量を前記レーダ手段により検出される前記障害物の相対位置に加味することで前記障害物の絶対位置を前記周期ごとに算出する絶対位置算出手段と、前記絶対位置算出手段によって前記周期ごとに算出される前記絶対位置を複数用いた前記絶対位置のばらつきの広がりに基づき前記障害物の移動態様を判定する判定手段と、を備えることとした。
【０００９】
前記障害物が例えば移動しない停止物である場合にあっては、前記絶対位置算出手段によって前記周期ごとに算出される前記障害物の絶対位置は、座標平面上のある１点（真値）に集中して分布し、ばらつきの程度は小さい。一方、前記障害物が例えば低速度で移動する低速移動物である場合にあっては、前記周期ごとに算出される前記障害物の絶対位置は、ある程度の広がりをもって座標平面上に分布するため、ある程度ばらつくこととなる。他方、前記障害物が例えば高速度で移動する高速移動物である場合にあっては、前記周期ごとに算出される前記障害物の絶対位置は、座標平面上のより広い範囲に分布するため、大きくばらつくこととなる。したがって、車両用障害物検出装置としての上記構成によれば、前記障害物の絶対位置のばらつきの広がりを前記判定手段を通じて参照することにより、例えば前記障害物が停止物であるか、低速移動物であるか、あるいは高速移動物であるかなど、その移動態様を的確に判定することができるようになる。特に、従来難しかった低速移動物の判定についてもこれを的確に行うことができるようになる。なお、前記障害物の移動態様は、その速度のみに限られない。他に例えば、前記障害物の絶対位置が座標平面で直線状に分布している場合、これを直線運動中の移動物であると判定することができるようになる。
【００１０】
ここで、上記請求項１に記載の構成において、例えば請求項２に記載の発明では、前記絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合を算出するばらつき度合算出手段をさらに備えるとともに、前記判定手段は、前記ばらつき度合算出手段によって算出される前記ばらつき度合に基づき前記障害物の移動態様を判定することとした。これにより、前記ばらつき度合算出手段によって各周期ごとに算出される前記絶対位置のばらつきのひろがりを客観的に評価することができるようになる。
【００１１】
なお、こうした構成において、例えば請求項３に記載の発明によるように、前記移動量検出手段を、前記自車両の自車速を検出する自車速検出手段と、前記自車両の操舵角を検出する操舵角検出手段と、前記自車両のヨーレートを検出するヨーレート検出手段とを有して構成することができる。これにより自車両の移動量を精度欲求めることができるようになるので、前記障害物の絶対位置の精度が向上し、ひいては、より正確な広がり（分布）を取得することができるようになる。
【００１２】
上記請求項３に記載の構成において、例えば請求項４に記載の発明によるように、前記ばらつき度合に対して第１の判定値及び該第１の判定値よりも小さい第２の判定値を設定するとともに、前記判定手段により、前記ばらつき度合が前記第１の判定値を超えるとき前記障害物は高速移動物であると判定し、前記ばらつき度合が前記第１の判定値に達せず前記第２の判定値を超えるとき前記障害物は低速移動物であると判定し、前記ばらつき度合が前記第２の判定値に達しないとき前記障害物は停止物であると判定すれば、前記ばらつき度合の前記第１及び第２の判定値への到達態様に基づき前記障害物の移動態様を直接判定することができるようになる。
【００１３】
上述したように、前記障害物の絶対位置のばらつきの広がりを前記判定手段を通じて参照することで、従来難しかった低速移動物をより的確に判定できるようになる。とはいえ、前記レーダ手段の測距誤差は大きく、しかも、低速度領域にある障害物には、例えば歩行者も含まれる。したがって、低速移動物の判定については、より高い信頼性が求められる。
【００１４】
その点、上記請求項４に記載の構成において、例えば請求項５に記載の発明では、前記判定手段は、前記所定の周期で前記障害物の移動態様を判定するとともに、前記ばらつき度合が前記第１の判定値に達せず前記第２の判定値を超える周期が連続して所定数を超えるとき、前記障害物は低速移動物であると判定することとした。これにより、前記障害物が停止物であるか、あるいは低速移動物であるかについての判定を、より慎重に行うことができ、この判定についての信頼性をより高めることができるようになる。
【００１５】
なお、そうした第１の判定値としては、例えば請求項６に記載の発明によるように、前記レーダ手段により検出される前記距離及び前記方位並びに前記自車速検出手段により検出される前記自車速に基づき検出不能な前記障害物の相対速度の上限値に対応する前記ばらつき度合を採用することが望ましい。
【００１６】
一方、上記請求項３に記載の構成において、例えば請求項７に記載の発明では、前記レーダ手段により検出される前記距離及び前記方位並びに前記自車速検出手段により検出される前記自車速に基づき前記障害物の相対速度を検出する相対速度検出手段をさらに備え、前記相対速度検出手段によって検出される前記障害物の前記相対速度と前記自車速検出手段によって検出される前記自車速との速度差に対し所定範囲を設定するとともに前記ばらつき度合に対して判定値を設定し、前記判定手段により、前記速度差が前記所定範囲を逸脱するとき前記障害物は高速移動物であると判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値を超えるとき前記障害物は低速移動物であると判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値に満たないとき前記障害物は停止物であると判定することとした。これにより、前記障害物の移動態様についての判定にかかる適正性を維持しつつ、演算負荷を低減することができるようになる。
【００１７】
これもまた上述したように、前記障害物の絶対位置のばらつきの広がりを前記判定手段を通じて参照することで、従来難しかった低速移動物をより的確に判定できるようになる。しかしながら、やはり前記レーダ手段の測距誤差は大きく、しかも、低速度領域にある障害物には、例えば歩行者も含まれる。したがって、低速移動物の判定については、より高い信頼性が求められる。
【００１８】
その点、上記請求項７に記載の構成において、例えば請求項８に記載の発明では、前記判定手段は、前記所定の周期で前記障害物の移動態様を判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値を超える周期が連続して所定数を超えるとき、前記障害物は低速移動物であると判定することとした。これにより、前記障害物が停止物であるか、あるいは低速移動物であるかについての判定を、より慎重に行うことができ、この判定についての信頼性をより高めることができるようになる。
【００１９】
なお、そうした所定範囲及び判定値としては、例えば請求項９に記載の発明によるように、前記相対速度検出手段により検出可能な前記障害物の相対速度の下限値及び前記相対速度検出手段により検出不能な前記障害物の相対速度の上限値に対応する前記ばらつき度合よりも小さい値を採用することが望ましい。
【００２０】
他方、車両用障害物検出装置に対しては、低速移動物の中から特に歩行者を峻別することが望まれている。その点、上記請求項４〜９のいずれかに記載の構成において、例えば請求項１０に記載の発明では、前記レーダ手段は、前記送信波及び前記反射波に基づき前記障害物の大きさを検出し、前記判定手段は、低速移動物であると判定された前記障害物の大きさが所定の大きさよりも小さいとき、前記障害物は歩行者であると判定することとした。これにより、歩行者を正確に峻別することが可能となり、例えば歩行者保護用のエアバックシステムや、プリクラッシュシステムなどの実現が容易になる。
【００２１】
なお、請求項１１に記載の発明では、上記請求項１〜１０のいずれかに記載の車両用障害物検出装置と、該車両用障害物検出装置を通じて判定される前記障害物の移動態様に応じて前記自車両を制御する車両制御手段とを備えて車両制御システムを構成することとした。これにより、検出対象とする障害物が低速で移動する場合であれ、その移動態様を的確に判定することができることはもとより、自車両を的確に制御することができるようにもなる。
【発明を実施するための最良の形態】
【００２２】
以下、本発明にかかる車両用障害物検出装置及び車両制御システムにかかる一実施の形態について、図１〜図７を参照して説明する。なお、この実施の形態では、以下に詳述するように、まず、レーザレーダ装置により検出される自車両から障害物までの距離及び自車両を基準とした障害物が位置する方位に基づき、自車両を基準とした障害物の相対位置を所定の周期で検出する。また、車速センサにより検出される自車速、ステアリングセンサにより検出される操舵角、及びヨーレートセンサにより検出されるヨーレートに基づき自車両の移動量を算出し、先に求めた相対位置にこの移動量を加味することで障害物の絶対位置を算出する。そして、障害物の絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合を算出し、このばらつき度合に基づき障害物の移動態様を判定する。このようにして、検出対象とする障害物が低速で移動する場合であれ、その移動態様を的確に判定しようとしている。
【００２３】
図１は、本発明にかかる車両制御システムの一実施の形態について、車両用障害物検出装置も含め、その全体構成を示すブロック図である。まず、この図１を参照しつつ、この実施の形態の構成について説明する。
【００２４】
同図１に示されるように、この実施の形態の車両制御システム１は、車両用障害物検出装置としての機能を備えるコンピュータ４を中心に構成されている。コンピュータ４は、マイクロコンピュータを主な構成として、入出力インターフェース（Ｉ／Ｏ）及び各種の駆動回路や検出回路を有して構成されている。なお、これらは一般的に使用されているため、そのハードウエアに関する詳細な説明を割愛する。
【００２５】
同図１に示されるように、コンピュータ４には、レーザレーダ装置（レーダ手段）５をはじめとして、自車両の速度を検出する車速センサ（自車速検出手段）７、その踏み込み量に応じて自車両に付与される制動力が変化するブレーキペダル（図示略）の設定状態を検出するブレーキスイッチ９、スロットルバルブの開度を検出するスロットル開度センサ１１等々が接続されている。そしてこれら各種センサ及びスイッチは、所定の検出データ及びその設定状態に関する情報をそれぞれコンピュータ４へ出力している。
【００２６】
また、コンピュータ４は、例えば障害物が自車両に接近したときにその旨を報知する警報音発生器１３、レーダレーダ装置５によって検出された自車両から障害物までの距離を表示する距離表示器１５、レーザレーダ装置５に異常がある場合にその旨を報知するセンサ異常表示器１７、自車両に制動力を付与するブレーキを駆動するブレーキ駆動器１９、吸入空気量を調整するためのスロットル駆動器２１、及び自動変速機制御器２３等に所定の駆動信号を出力している。
【００２７】
さらに、コンピュータ４には、図１に示されるように、上記警報音発生器１３から発せられる警報の音量を設定するための警報音量設定器２４、その感度を設定する警報感度設定器２５、クルーズコントロールスイッチ２６、図示しないステアリングホイールの操作量を検出するステアリングセンサ２７、及びヨーレートセンサ２８が接続されている。そして、コンピュータ４には、例えばイグニッションスイッチなどの電源スイッチ２９が接続されており、そのオン操作を通じて後述する各種所定の処理が実行される。
【００２８】
ここで、図１に示されるように、レーザレーダ装置５は、送受信機３１及び該送受信機３１を制御する制御部３３を有して構成されている。このうち、送受信機３１は、制御部３３によって制御されることにより、所定の光軸（中心軸）を中心とした車幅方向の所定角度範囲にレーザ光を不連続に掃引照射（スキャン）するとともに、この照射したレーザ光の反射光を捕捉する部分である。そして制御部３３は、送受信機３１にレーザ光を照射させてからそのレーザ光が自車両の周辺に存在する障害物によって反射される反射光を受信するまでの経過時間を照射角度の別に取得する。そして、照射角度の別に取得した上記経過時間を含め、測距にかかる各種データをコンピュータ４に出力する。なお、送受信機３１により照射するレーザビームの形状は、略円形、楕円形、長方形等、どのような形状でもよい。
【００２９】
このように構成されたコンピュータ４は、例えば、
・自車両の周辺に存在する障害物が所定の警報領域に所定時間存在した場合等に警報を発する警報判定処理。
・障害物が、移動しない停止物であるか、低速で移動する低速移動物であるか、あるいは高速で移動する高速移動物であるか等について判定を行う移動態様判定処理。
・移動態様判定処理を通じて低速移動物であると判定された障害物が歩行者であるか否かについて判定を行う歩行者判定処理。
・移動態様判定処理を通じて高速移動物であると判定された障害物が先行車であるか否かについて、及び移動態様判定処理を通じて低速移動物であると判定された障害物が先行車であるか否かについて判定を行う先行車判定処理。
・先行車判定処理を通じて障害物が先行車であると判定された場合には、ブレーキ駆動器１９、スロットル駆動器２１、及び自動変速制御器２３等に駆動信号を出力することにより、先行車の走行状況に応じて車間を制御するクルーズ制御処理。
等々の各種処理を実行する。
【００３０】
図２に、こうしたコンピュータ４の制御ブロック図を示し、この図２を参照して上記各種処理を実行する各要素の機能についてさらに説明する。
【００３１】
車速演算部４２は、車速センサ７から車速信号の供給を受けて該車速信号に基づき車速を逐次算出する。同じく、ヨーレート演算部４３は、ヨーレートセンサ２８からヨーレート信号の供給を受けて該ヨーレート信号に基づきヨーレートを逐次算出する。また、同じく操舵角演算部４４は、ステアリングセンサ２７から舵角信号の供給を受けて該舵角信号に基づき操舵角を逐次算出する。そしてこれら各演算部４２〜４４はそれぞれ、物体認識部（絶対位置算出手段）４１及びカーブ半径算出部４５に演算結果を供給している。
【００３２】
このうち、物体認識部４１に対しては、レーザレーダ装置５（正確には制御部３３（図１参照））も接続されており、上述した測距にかかる各種データが供給されている。すなわち、物体認識部４１は、車速センサ７で検出（正確には車速演算部４２で演算）された自車速、ヨーレートセンサ２８で検出された（正確にはヨーレート演算部４３で演算された）ヨーレート、及びステアリングセンサ２７で検出された（正確には操舵角演算部４４で演算された）操舵角を用いて、レーザレーダ装置５から供給された各種データを絶対座標系に変換する部分である。
【００３３】
具体的には、物体認識部４１は、レーザレーダ装置５から供給されたデータに基づき自車両から障害物までの距離及び自車両を基準とした障害物が位置する方位（角度）を算出する。そして、この距離及び角度から、自車両に対する障害物の相対位置を算出する。また、物体認識部４１は、車速演算部４２により演算される自車速、ヨーレート演算部４３により演算されるヨーレート、及び操舵角演算部４４により演算される操舵角に基づいて、自車両の移動量を算出する。そして自車両に対する障害物の相対位置に、こうして求められた移動量を加味することで障害物の絶対位置を算出する。なお、物体認識部４１は、レーザレーダ装置５により検出される上記距離及び上記角度の時間的変化に基づき、障害物の相対速度を検出する相対速度検出手段としての機能も併せ有している。また、物体認識部４１にて実行される絶対位置の算出にかかる処理等については、図３を参照して後述する。
【００３４】
一方、カーブ半径算出部４５は、車速演算部４２で演算された自車速、ヨーレート演算部４３で演算されたヨーレート、及び操舵角演算部４４で演算された操舵角に基づき、カーブ半径（曲率半径）Ｒを算出する。こうして算出されたカーブ半径Ｒに関する情報は、車両制御部５０に供給されている。
【００３５】
また、センサ異常検出部４６は、物体認識部４１において絶対座標系に変換されたデータが異常であるかどうかを検出する。そしてそのデータに異常が検出されるとき、センサ異常表示器１７にその旨を表示する。
【００３６】
移動態様判定部（判定手段）４７は、物体認識部４１によって算出される障害物の相対速度と車速演算部４２によって算出される自車速との速度差を算出するとともに、物体認識部４１によって算出される障害物の絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合を算出する。そして、上記速度差が設定した所定範囲を逸脱するとき、障害物は高速移動物であると判定する。また、上記速度差が上記所定範囲に収まるとともに上記ばらつき度合が設定した判定値を超えるとき、障害物は低速移動物であると判定する。また、上記速度差が上記所定範囲に収まるとともに上記ばらつき度合が設定した判定値に満たないとき、障害物は停止物であると判定する。
【００３７】
このような判定方式を採用した理由は、レーザレーダ装置５が測定する距離、さらには、レーザデータ装置５及び各種センサの測定結果に基づいて算出される障害物の絶対位置に誤差が含まれているためである。つまり、レーザレーダ装置５が測定する距離に誤差が含まれることにより、その時間的変化として求められる相対速度も誤差を含む。このため、特に低速で移動する物体について、それが移動物であるか、停止物であるかを精度良く判定することが困難になる。
【００３８】
そこで、この実施の形態では、障害物の絶対位置を算出してそのばらつき度合から低速移動物か停止物かを判定することとした。上述したように、障害物の絶対位置はレーザレーダ装置５の測定結果に基づいて算出されるため、誤差を含む。しかし、複数の絶対位置のばらつきの大きさが上述した誤差に起因する範囲内に収まっている場合には停止物と判定できる。一方、複数の絶対位置のばらつきの大きさが、誤差に起因する範囲を逸脱していると、正確な速度は不明ではあるが、少なくとも低速で移動している低速移動物と判定できる。
【００３９】
このようにして、障害物の移動態様を判定すると、図２に示されるように、歩行者判定部４８及び先行車判定部４９に対し、その判定結果を出力する。なお、こうした移動態様判定処理の具体的な処理手順については、図５を参照して後述する。
【００４０】
歩行者判定部４８は、移動態様判定部４７の判定処理を通じて低速移動物であると判定された障害物に対し、その大きさが所定の大きさを超えるか否かを判定することで、この低速移動物が歩行者であるか否かを判定する。そして、低速移動物であると判定された障害物が歩行者でないと判定されるとき、後述する先行車判定部４９に対しその判定結果を出力する。一方、移動態様判定部４７の判定処理を通じて低速移動物であると判定された障害物が歩行者であると判定されるとき、後述する車両制御部５０に対しその判定結果を出力する。なお、こうした歩行者判定処理の具体的な処理手順については、図６を参照して後述する。
【００４１】
先行車判定部４９は、上記移動態様判定部４７の判定処理を通じて高速移動物であると判定された障害物、上記歩行者判定部４８の判定処理を通じて歩行者でない低速移動物であると判定された障害物に対し、その大きさが所定の大きさを超えるか否かを判定する。そしてその大きさが所定の大きさを超えると判定されるとき、この障害物は先行車であると判定し、車両制御部５０に対しその判定結果を出力する。なお、こうした先行車判定処理の具体的な判定手順については、図７を参照して低速域クルーズ制御処理と併せて後述する。
【００４２】
車両制御部５０は、上記カーブ半径算出部４５で算出されたカーブ半径、上記先行車判定部４９での判定結果、及び上記歩行者判定部４８での判定結果に基づき、警報判定処理及びクルーズ制御処理を実行する。特に、低速域でのクルーズ制御処理については、図７を用いて後述する。
【００４３】
なお、車速演算部４２、ヨーレート演算部４３、操舵角演算部４４、カーブ半径算出部４５、センサ異常検出部４６、物体認識部４１、移動態様判定部４７、歩行者判定部４８、先行車判定部４９、及び車両制御部５０は、コンピュータ４のプログラム上で実現される機能である。ここでは、概念的に各種構成要素として説明した。
【００４４】
図３は、検出対象である障害物の位置及び自車両の位置を含めた絶対座標平面を示す図である。次に、この図３を参照して上記物体認識部４１にて実行される障害物の絶対位置の算出にかかる処理について説明する。
【００４５】
上記物体認識部４１は、基本的には、
（ａ１）レーザレーダ装置５により検出される距離及び角度に基づき障害物の相対位置を算出する処理。
（a２）ステアリングセンサ２７により検出される操舵角及び車速センサ７により検出される自車速に基づき自車両の移動量を算出する処理。
等々の処理を、所定の時間間隔「Δｔ（例えば１００ミリ秒）」毎に実行することで、障害物の絶対座標系の位置（絶対位置）を算出するようにしている。
【００４６】
具体的には、上記（a１）及び（a２）の処理を通じて、下式（１）〜（４）を算出している。
【００４７】
【数１】
ここで、上式（１）〜（４）において、「ｘａｎ」は時刻ｎでの障害物のｘ軸方向の絶対位置を、「ｙａｎ」は時刻ｎでの障害物のｘ軸方向の絶対位置を、「ｘｎ」は時刻ｎでの障害物のｘ軸方向の相対位置を、「ｙｎ」は時刻ｎでの障害物のｙ軸方向の相対位置を、「Ｖｘｎ」は時刻ｎでのｘ軸方向の自車速を、「Ｖｙｎ」は時刻ｎでのｙ軸方向の自車速を、「Δｔ」は測距周期を、それぞれ表す。
【００４８】
また、上式（１）〜（４）において、時刻ｎでのｘ軸方向の自車速「Ｖｘｎ」及び時刻ｎでのｙ軸方向の自車速「Ｖｙｎ」は、時刻ｎでの自車速「Ｖｎ」及び時刻ｎでの操舵角「φｎ」を用いた下式（５）及び（６）に示される関係となっている。
【００４９】
【数２】
なお、この実施の形態では、現時刻「ｎ」から９時点遡った時刻「ｎ−９」まで、すなわち１０時点に渡る各種測距データを使用しているが、このデータ数は任意であり、コンピュータ４に実装されるメモリや演算能力に応じて適宜変更可能な要素である。
【００５０】
このようにして各時点において算出された障害物の絶対位置は、例えば図４（a）〜（ｃ）に示す態様でばらつく（分布する）こととなる。すなわち、障害物が停止物である場合にあっては、図４（ａ）に示されるように、上記物体認識部４１によって所定の周期ごとに算出される障害物の絶対位置は、座標平面上のある１点（真値）に集中して分布し、ばらつきの程度は小さい。一方、障害物が低速度で移動する低速移動物である場合にあっては、図４（ｂ）に示されるように、上記物体認識部４１によって所定の周期ごとに算出される障害物の絶対位置は、ある程度の広がりをもって座標平面上に分布するため、ある程度ばらつくこととなる。他方、障害物が例えば高速度で移動する高速移動物である場合にあっては、図４（ｃ）に示されるように、上記物体認識部４１によって所定の周期ごとに算出される障害物の絶対位置は、座標平面上のより広い範囲に分布するため、大きくばらつくこととなる。したがって、障害物の絶対位置のばらつきに基づくことで、例えば障害物が停止物であるか、低速移動物であるか、あるいは高速移動物であるかなど、その移動態様を判定することができる。なお、この障害物の移動態様は、その速度のみに限られない。他に例えば、障害物の絶対位置が座標平面で直線状に分布している場合、これを直線運動中の移動物であると判定することができるようにもなる。
【００５１】
そうした移動態様を判定する上記移動態様判定部４７について説明する。移動態様判定部４７は、上記物体認識部４１により所定の周期ごとに算出された障害物の絶対位置に関する複数の情報をもとに、その絶対位置のばらつきの広がりに応じた大きさの値を返す例えば下式（７）で表される評価関数を通じてばらつき度合Ｐｄを算出する。これにより、移動態様判定部４７によって各周期ごとに算出される絶対位置のばらつきのひろがりを客観的に評価することができるようになる。
【００５２】
【数３】
なお、上式（７）で示される評価関数を採用すると、移動速度が大きくなるほど、すなわち、障害物が高速移動物であるほど、ばらつき度合Ｐｄは大きくなる。一方、移動速度が小さくなるほど、すなわち、障害物が停止物であるほど、ばらつき度合Ｐｄは小さくなる。
【００５３】
図５に、上記移動態様判定部４７によって実行される移動態様判定処理の具体的な処理手順を示す。なお、この移動態様判定処理も、所定の時間間隔「Δｔ（例えば１００ミリ秒）」で繰り返し実行されている。
【００５４】
障害物の移動態様判定処理が開始されると、移動態様判定部４７は、まず、ステップＳ５０１の処理として、上記物体認識部４１で算出される障害物の相対速度を取り込む。そして、続くステップＳ５０３の処理として、上記相対速度と自車速との速度差を算出する。また、続くステップＳ５０５の処理として、上式（１）〜（４）に基づき障害物の絶対位置を算出する。なお、現時点ｎから所定時点（この実施の形態では９時点）遡った測距データを利用して上式（７）に基づき絶対位置のばらつき度合Ｐｄを算出するため、ステップＳ５０７の処理においては、先のステップＳ５０５の処理において算出した絶対位置をコンピュータ４等に適宜に設けられるメモリに記憶保持する。
【００５５】
そして、移動態様判定部４７は、ステップＳ５０９の判断処理において、上記ステップＳ５０３の処理で算出された上記速度差が所定範囲（例えば「５ｋｍ／時」）に収まるかあるいは逸脱するかを判断する。ここで上記速度差が所定範囲を逸脱すると判断されるとき（Ｎｏ）、続くステップＳ５１１の処理として、移動態様判定部４７は、障害物を高速移動物であると判定する。
【００５６】
一方、先のステップＳ５０９の判断処理において、上記速度差が所定範囲内に収まると判断されるとき（Ｙｅｓ）、移動態様判定部４７は、続くステップＳ５１３の処理に移行し、上式（７）に基づき過去１０点について絶対位置のばらつき度合Ｐｄを算出する。こうしてばらつき度合Ｐｄが算出されると、移動態様判定部４７は、続くステップＳ５１５の判断処理において、ばらつき度合Ｐｄが所定の判定値（例えば「１０」）を超えるか否かを判断する。ここで、ばらつき度合Ｐｄが判定値を超えないと判断されるとき（Ｎｏ）、続くステップＳ５１７の処理として、障害物を停止物であると判定する。
【００５７】
他方、先のステップＳ５１５の判断処理において、ばらつき度合Ｐｄが判定値を超えると判断されるとき（Ｙｅｓ）、移動態様判定部４７は、続くステップＳ５１９の判断処理として、こうした判断がなされた周期が連続して所定数（例えば「３」）を超えるか否かを判断する。ここで所定数に満たないと判断されるとき（Ｎｏ）、先のステップＳ５１７の処理として、障害物を停止物であると判定する。しかしながら、ステップＳ５１９の判断処理において、上記周期が連続して所定数を超えると判断されるとき（Ｙｅｓ）、移動態様判定部４７は、続くステップＳ５２１の処理として、障害物を低速移動物であると判定する。
【００５８】
以上のように、この実施の形態では、高速移動物に対しては、従来から実行されている演算負荷の少ない上記速度差に基づく判定を実行する（ステップＳ５０９の判断処理）とともに、この速度差に基づく判定では的確に判定することの難しかった低速移動物に対しては、上記ばらつき度合Ｐｄに基づく判定（ステップＳ５１５の判断処理）を実行している。これにより、障害物の移動態様についての判定にかかる適正性を維持しつつ、演算負荷を好適に低減することができる。
【００５９】
また、この実施の形態では、上記速度差が上記所定範囲に収まるとともに上記ばらつき度合Ｐｄが上記判定値を超える周期が連続して所定数を超えるとき（ステップＳ５１９の判断処理（図５））、障害物は低速移動物であると判定することとした。これにより、障害物が停止物であるか、あるいは低速移動物であるかについての判定を、より慎重に行うことができ、この判定についての信頼性をより高めることができる。
【００６０】
図６に、上記歩行者判定部４８によって実行される歩行者判定処理の具体的な処理手順を示すフローチャートを示す。なお、この歩行者判定処理も、所定の時間間隔「Δｔ（例えば１００ミリ秒）」で繰り返し実行されている。
【００６１】
同図６に示されるように、歩行者判定部４８は、まず、ステップＳ６０１の判断処理として、上記移動態様判定処理（図５）において障害物は低速移動物であると判定されたか否かを判断する。ここで、低速移動物であると判断されなかったとき（Ｎｏ）、歩行者判定部４８は、そのままこの処理を一旦終了する。
【００６２】
一方、先のステップＳ６０１の判断処理において、障害物が低速移動物であると判断されたとき（Ｙｅｓ）、歩行者判定部４８は、続くステップＳ６０３の処理として、上記物体認識部４１に対し障害物の横幅を算出させる。続くステップＳ６０５の判断処理において、算出された障害物の横幅が所定値（例えば「７５ｃｍ」）を越えるか否かを判断する。ここで、算出した障害物の横幅が所定値を超えると判断されるとき（Ｙｅｓ）、一般的な歩行者の大きさを超えているため、そのままこの処理を一旦終了する。
【００６３】
他方、ステップＳ６０５の判断処理において、先のステップＳ６０３の処理にて算出された障害物の横幅が所定値に満たないと判断されるとき（Ｎｏ）、この障害物は低速で移動するとともにその大きさが一般的な歩行者の大きさに近いため、ステップＳ６０７の処理として、低速移動物を歩行者であると判定する。
【００６４】
以上説明したこの実施の形態の歩行者判定処理によれば、歩行者を正確に峻別することが可能となり、例えば歩行者保護用のエアバックシステムや、プリクラッシュシステムなどの実現が容易になる。
【００６５】
なお、この実施の形態では、上記所定値として例えば「７５ｃｍ」を採用したが、これに限られない。他にも上記所定値として例えば「１ｍ」を採用することとしてもよい。要は、歩行者である旨の判断を行うことのできる値であれば任意である。
【００６６】
図７に、車両制御部５０によって実行される上記車両制御処理のうち、特に低速域でのクルーズ制御処理について具体的な処理手順を示したフローチャートを示す。
【００６７】
この低速域でのクルーズ制御処理が開始される状況としては、例えば自車両が渋滞の最後尾に着いた状況のように、自車両前方に存在する停止物に衝突しないように自車両を停止させた後、あるいは、例えば渋滞に巻き込まれた先行車が発進と停止を繰り返す状況のように、先行車に追従して自車両を停止させた後が挙げられる。いずれの場合であれ、図７に示す低速域クルーズ制御処理は、自車両が一度停止した後に開始される。なお、この低速域クルーズ制御処理も、所定の時間間隔「Δｔ（例えば１００ミリ秒）」で繰り返し実行されている。また、同図７から明らかなように、ステップＳ６０１の判断処理及びステップＳ６０３の処理については、先の図６に示す歩行者判定処理の一部に準じた処理であるため、ここでの説明を割愛する。
【００６８】
車両制御部５０は、ステップＳ７０５の判断処理において、先のステップＳ６０３の処理にて算出した障害物の横幅が所定値（例えば「７５ｃｍ」）を超えるか否かを判断する。ここで、算出された障害物の横幅が所定値を超えると判断されるとき（Ｙｅｓ）、この障害物は低速で移動するとともにその大きさが一般的な歩行者の大きさを超えるため、続くステップＳ７０７の処理として、低速移動物を先行車であると判定する。そして、車両制御部５０は、先行車が低速で移動しているため、続くステップＳ７０９の処理として、自車両を発進させる。
【００６９】
なお、先のステップＳ６０１の判断処理において低速移動物と判定されない（Ｎｏ）、あるいは、先のステップＳ７０５の判断処理において障害物の横幅が所定値を超えない（Ｙｅｓ）と判断されるとき、車両制御部５０は、ステップＳ７１１の処理として、自車両の停止状態を維持する。
【００７０】
以上説明したこの実施の形態の低速域クルーズ制御処理によれば、低速で移動する先行車を的確に判定することができないことに起因して先行車が自車両からかなり離れた後にしか自車両を発進させることができなかった従来技術に比して、低速で移動する先行車が発進してからこれに追従して自車両を発進させるまでに必要とされる時間を短縮することができるようになる。
【００７１】
なお、この実施の形態では、上記所定値として例えば「７５ｃｍ」を採用したが、これに限られない。他にも上記所定値として例えば「１ｍ」を採用することとしてもよい。要は、先行車である旨の判断を行うことのできる値であれば任意である。
（その他の実施の形態）
なお、この発明にかかる車両用障害物検出装置及び車両制御システムは上記実施の形態にて例示した構成に限定されるものではなく、同実施の形態を適宜変更した例えば次の形態として実施することもできる。
【００７２】
上記実施の形態では、先の図５に示すように、上記速度差に対する上記所定範囲として例えば「５ｋｍ／時」を採用するとともに、上記ばらつき度合Ｐｄに対する上記判定値として例えば「１０」を採用していたが、これらの値に限られない。上記所定範囲としては、物体認識部４１により検出可能な障害物の相対速度の下限値を採用し、上記判定値としては、物体認識部４１により検出不能な障害物の相対速度の上限値に対応するばらつき度合よりも小さな値を採用することができる。
【００７３】
また、上記実施の形態では、先の図５に示した移動態様判定処理を上記移動態様判定部４７により実行することで障害物の移動態様を判定することとしたが、他に例えば、図８に示す移動態様判定処理を上記移動態様判定部４７により実行することで障害物の移動態様判定してもよい。すなわち、図８に示されるように、上記速度差が所定範囲に収まるか逸脱するかを判断したステップＳ５０９の判断処理（図５）に替えて、ばらつき度合Ｐｄが第１の判定値（例えば「５０」）を超えるか否かを判断するステップＳ８０９の判断処理を実行してもよい。これにより、ばらつき度合Ｐｄの第１の判定値及び第２の判定値（例えば「１０」、ステップＳ５１５ａの処理）への到達態様に基づき、障害物の移動態様を直接判定することができるようになる。
【００７４】
なお、この変形例において採用される第１及び第２の判定値も変更可能である。すなわち、上記第１の判定値としては、レーザレーダ装置５により検出される自車両から障害物までの距離及び自車両を基準とした障害物の位置する方位並びに車速センサ７により検出される自車速に基づき検出不能な障害物の相対速度の上限値に対応するばらつき度合を採用することができる。
【００７５】
上記実施の形態（変形例も含む）では、同一の判断が行われた周期が所定数を超えるか否かの判断処理（ステップＳ５１９（図５）、あるいはステップＳ８１９（図８））を実行していたが、これを割愛してもよい。そもそも、ばらつき度合Ｐｄは、過去所定回数に渡った検出結果に基づく値であるため、その信頼性が高い。したがって、この処理を割愛しても、障害物の移動態様を的確に判断することはできる。
【００７６】
上記実施の形態（変形例も含む）では、移動量検出手段として、自車両の自車速を検出する車速センサ７、自車両の操舵角を検出するステアリングセンサ２７、及び自車両のヨーレートを検出するヨーレートセンサ２８により構成することとしたが、ステアリングセンサ２７及びヨーレートセンサ２８のいずれか一方を割愛する構成としても、自車両の移動量を検出することはできる。
【００７７】
上記実施の形態（変形例も含む）では、移動態様判定部４７による判定を通じて低速移動物であると判定された障害物が歩行者であるか否かについて判定を行う歩行者判定処理（図６）を実行する歩行者判定部４８を備えることとしたが、これを割愛してもよい。割愛した構成によっても、所期の目的を達成することはできる。
【００７８】
上記実施の形態（変形例も含む）では、絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数として上式（７）で表される関数を採用したが、これに限らない。他に例えば、標準偏差、あるいは分散などの評価関数を適宜に採用することができる。要は、絶対位置のばらつきの広がりを客観的に評価できる評価関数であれば、その関数は任意である。
【図面の簡単な説明】
【００７９】
【図１】本発明にかかる車両用障害物検出装置及び車両制御システムの一実施の形態について、その全体の構成を示すブロック図。
【図２】同実施の形態で採用されるコンピュータの制御ブロック図。
【図３】同実施の形態において、検出対象である障害物の位置及び自車両の位置を含めた絶対座標平面を示す図。
【図４】（ａ）は、検出した障害物が停止物である場合について、その絶対位置のばらつきを示した図。（ｂ）は、検出した障害物が低速移動物である場合について、その絶対位置のばらつきを示した図。（ｃ）は、検出した障害物が高速移動物である場合について、その絶対位置のばらつきを示した図。
【図５】同実施の形態において、検出した障害物の移動態様を判定する移動態様判定処理の処理手順を示すフローチャート。
【図６】同実施の形態において、低速移動物であると判定した障害物が歩行者であるか否かを判定する歩行者判定処理の処理手順を示すフローチャート。
【図７】同実施の形態において、低速移動物であると判定した障害物が先行車であるときに実行される低速度域クルーズ制御処理の処理手順を示すフローチャート。
【図８】同実施の形態の変形例として、検出した障害物の移動態様を判定する移動態様判定処理について、処理手順を示すフローチャート。
【符号の説明】
【００８０】
１…車両制御システム（車両用障害物検出装置）、４…コンピュータ、５…レーザレーダ装置（レーダ手段）、７…車速センサ（自車速検出手段、移動量検出手段）、９…ブレーキスイッチ、１１…スロットル開度センサ、１３…警報音発生器、１５…距離表示器、１７…センサ異常表示器、１９…ブレーキ駆動器、２１…スロットル駆動器、２３…自動変速制御器、２４…警報音量設定器、２５…警報感度設定器、２６…クルーズコントロールスイッチ、２７…ステアリングセンサ（操舵角検出手段、移動量検出手段）、２８…ヨーレートセンサ（ヨーレート検出手段、移動量検出手段）、２９…電源スイッチ、３１…送受信機、３３…制御部、４１…物体認識部（絶対位置算出手段、相対位置算出手段、相対速度検出手段）、４２…車速演算部、４３…ヨーレート演算部、４４…操舵角演算部、４５…カーブ半径算出部、４６…センサ異常検出部、４７…移動態様判定部（判定手段、ばらつき度合算出手段）、４８…歩行者判定部、４９…先行車判定部、５０…車両制御部（車両制御手段）。
【特許請求の範囲】
【請求項１】
自車両から照射した送信波と、該送信波が検出対象である障害物によって反射された反射波とに基づき、前記自車両から前記障害物までの距離及び前記自車両を基準とした前記障害物が位置する方位を含む前記自車両を基準とした前記障害物の相対位置を所定の周期で検出するレーダ手段と、
前記自車両が前記周期内に移動する移動量を各周期ごとに検出する移動量検出手段と、
前記移動量検出手段により検出される前記自車両の前記移動量を前記レーダ手段により検出される前記障害物の相対位置に加味することで前記障害物の絶対位置を前記周期ごとに算出する絶対位置算出手段と、
前記絶対位置算出手段によって前記周期ごとに算出される前記絶対位置を複数用いた前記絶対位置のばらつきの広がりに基づき前記障害物の移動態様を判定する判定手段と、を備える
ことを特徴とする車両用障害物検出装置。
【請求項２】
請求項１において、
前記絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合を算出するばらつき度合算出手段をさらに備え、
前記判定手段は、前記ばらつき度合算出手段によって算出される前記ばらつき度合に基づき前記障害物の移動態様を判定する
ことを特徴とする車両用障害物検出装置。
【請求項３】
前記移動量検出手段は、前記自車両の自車速を検出する自車速検出手段と、前記自車両の操舵角を検出する操舵角検出手段と、前記自車両のヨーレートを検出するヨーレート検出手段と、を有して構成される
請求項１または２に記載の車両用障害物検出手段。
【請求項４】
前記判定手段は、前記ばらつき度合に対して第１の判定値及び該第１の判定値よりも小さい第２の判定値を設定するとともに、前記ばらつき度合が前記第１の判定値を超えるとき前記障害物は高速移動物であると判定し、前記ばらつき度合が前記第１の判定値に達せず前記第２の判定値を超えるとき前記障害物は低速移動物であると判定し、前記ばらつき度合が前記第２の判定値に達しないとき前記障害物は停止物であると判定する
請求項３に記載の車両用障害物検出装置。
【請求項５】
前記判定手段は、前記所定の周期で前記障害物の移動態様を判定し、前記ばらつき度合が前記第１の判定値に達せず前記第２の判定値を超える周期が連続して所定数を超えるとき、前記障害物は低速移動物であると判定する
請求項４に記載の車両用障害物検出装置。
【請求項６】
前記第１の判定値は、前記レーダ手段により検出される前記距離及び前記方位並びに前記自車速検出手段により検出される前記自車速に基づき検出不能な前記障害物の相対速度の上限値に対応する前記ばらつき度合に設定されてなる
請求項４または５に記載の車両用障害物検出装置。
【請求項７】
請求項３に記載の車両用障害物検出装置において、
前記レーダ手段により検出される前記距離及び前記方位並びに前記自車速検出手段により検出される前記自車速に基づき前記障害物の相対速度を検出する相対速度検出手段をさらに備え、
前記判定手段は、前記相対速度検出手段によって検出される前記障害物の前記相対速度と前記自車速検出手段によって検出される前記自車速との速度差に対し所定範囲を設定するとともに前記ばらつき度合に対して判定値を設定し、前記速度差が前記所定範囲を逸脱するとき前記障害物は高速移動物であると判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値を超えるとき前記障害物は低速移動物であると判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値に満たないとき前記障害物は停止物であると判定する
ことを特徴とする車両用障害物検出装置。
【請求項８】
前記判定手段は、所定の周期で前記障害物の移動態様を判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値を超える周期が連続して所定数を超えるとき、前記障害物は低速移動物であると判定する
請求項７に記載の車両用障害物検出装置。
【請求項９】
前記所定範囲は、前記相対速度検出手段により検出可能な前記障害物の相対速度の下限値に設定されており、
前記判定値は、前記相対速度検出手段により検出不能な前記障害物の相対速度の上限値に対応する前記ばらつき度合よりも小さい値に設定されている
請求項７または８に記載の車両用障害物検出装置。
【請求項１０】
前記レーダ手段は、前記送信波及び前記反射波に基づき前記障害物の大きさを検出し、前記判定手段は、低速移動物であると判定された前記障害物の大きさが所定の大きさよりも小さいとき、前記障害物は歩行者であると判定する
請求項４〜９のいずれか一項に記載の車両用障害物検出装置。
【請求項１１】
請求項１〜１０のいずれか一項に記載の車両用障害物検出装置と、該車両用障害物検出装置を通じて判定される前記障害物の移動態様に応じて前記自車両を制御する車両制御手段と、を備える
ことを特徴とする車両制御システム。
【請求項１】
自車両から照射した送信波と、該送信波が検出対象である障害物によって反射された反射波とに基づき、前記自車両から前記障害物までの距離及び前記自車両を基準とした前記障害物が位置する方位を含む前記自車両を基準とした前記障害物の相対位置を所定の周期で検出するレーダ手段と、
前記自車両が前記周期内に移動する移動量を各周期ごとに検出する移動量検出手段と、
前記移動量検出手段により検出される前記自車両の前記移動量を前記レーダ手段により検出される前記障害物の相対位置に加味することで前記障害物の絶対位置を前記周期ごとに算出する絶対位置算出手段と、
前記絶対位置算出手段によって前記周期ごとに算出される前記絶対位置を複数用いた前記絶対位置のばらつきの広がりに基づき前記障害物の移動態様を判定する判定手段と、を備える
ことを特徴とする車両用障害物検出装置。
【請求項２】
請求項１において、
前記絶対位置のばらつきの広がりに応じた大きさの値を返す評価関数を通じてばらつき度合を算出するばらつき度合算出手段をさらに備え、
前記判定手段は、前記ばらつき度合算出手段によって算出される前記ばらつき度合に基づき前記障害物の移動態様を判定する
ことを特徴とする車両用障害物検出装置。
【請求項３】
前記移動量検出手段は、前記自車両の自車速を検出する自車速検出手段と、前記自車両の操舵角を検出する操舵角検出手段と、前記自車両のヨーレートを検出するヨーレート検出手段と、を有して構成される
請求項１または２に記載の車両用障害物検出手段。
【請求項４】
前記判定手段は、前記ばらつき度合に対して第１の判定値及び該第１の判定値よりも小さい第２の判定値を設定するとともに、前記ばらつき度合が前記第１の判定値を超えるとき前記障害物は高速移動物であると判定し、前記ばらつき度合が前記第１の判定値に達せず前記第２の判定値を超えるとき前記障害物は低速移動物であると判定し、前記ばらつき度合が前記第２の判定値に達しないとき前記障害物は停止物であると判定する
請求項３に記載の車両用障害物検出装置。
【請求項５】
前記判定手段は、前記所定の周期で前記障害物の移動態様を判定し、前記ばらつき度合が前記第１の判定値に達せず前記第２の判定値を超える周期が連続して所定数を超えるとき、前記障害物は低速移動物であると判定する
請求項４に記載の車両用障害物検出装置。
【請求項６】
前記第１の判定値は、前記レーダ手段により検出される前記距離及び前記方位並びに前記自車速検出手段により検出される前記自車速に基づき検出不能な前記障害物の相対速度の上限値に対応する前記ばらつき度合に設定されてなる
請求項４または５に記載の車両用障害物検出装置。
【請求項７】
請求項３に記載の車両用障害物検出装置において、
前記レーダ手段により検出される前記距離及び前記方位並びに前記自車速検出手段により検出される前記自車速に基づき前記障害物の相対速度を検出する相対速度検出手段をさらに備え、
前記判定手段は、前記相対速度検出手段によって検出される前記障害物の前記相対速度と前記自車速検出手段によって検出される前記自車速との速度差に対し所定範囲を設定するとともに前記ばらつき度合に対して判定値を設定し、前記速度差が前記所定範囲を逸脱するとき前記障害物は高速移動物であると判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値を超えるとき前記障害物は低速移動物であると判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値に満たないとき前記障害物は停止物であると判定する
ことを特徴とする車両用障害物検出装置。
【請求項８】
前記判定手段は、所定の周期で前記障害物の移動態様を判定し、前記速度差が前記所定範囲に収まるとともに前記ばらつき度合が前記判定値を超える周期が連続して所定数を超えるとき、前記障害物は低速移動物であると判定する
請求項７に記載の車両用障害物検出装置。
【請求項９】
前記所定範囲は、前記相対速度検出手段により検出可能な前記障害物の相対速度の下限値に設定されており、
前記判定値は、前記相対速度検出手段により検出不能な前記障害物の相対速度の上限値に対応する前記ばらつき度合よりも小さい値に設定されている
請求項７または８に記載の車両用障害物検出装置。
【請求項１０】
前記レーダ手段は、前記送信波及び前記反射波に基づき前記障害物の大きさを検出し、前記判定手段は、低速移動物であると判定された前記障害物の大きさが所定の大きさよりも小さいとき、前記障害物は歩行者であると判定する
請求項４〜９のいずれか一項に記載の車両用障害物検出装置。
【請求項１１】
請求項１〜１０のいずれか一項に記載の車両用障害物検出装置と、該車両用障害物検出装置を通じて判定される前記障害物の移動態様に応じて前記自車両を制御する車両制御手段と、を備える
ことを特徴とする車両制御システム。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【図２】
【図３】
【図４】
【図５】
【図６】
【図７】
【図８】
【公開番号】特開２００８−２６０３０（Ｐ２００８−２６０３０Ａ）
【公開日】平成２０年２月７日（２００８．２．７）
【国際特許分類】
【出願番号】特願２００６−１９６１２７（Ｐ２００６−１９６１２７）
【出願日】平成１８年７月１８日（２００６．７．１８）
【出願人】（０００００４２６０）株式会社デンソー (27,639)
【Ｆターム（参考）】
【公開日】平成２０年２月７日（２００８．２．７）
【国際特許分類】
【出願日】平成１８年７月１８日（２００６．７．１８）
【出願人】（０００００４２６０）株式会社デンソー (27,639)
【Ｆターム（参考）】
[ Back to top ]