(57)【特許請求の範囲】
【請求項１】
自車と先行車または物標との距離及び方位角度を検出するレーダと、
自車角速度及び自車速度を検出するセンサと、
前記レーダから入力した自車と先行車または物標との距離及び方位角度、並びに前記センサから入力した自車角速度及び前記自車速度に基づいて自車と先行車または物標との曲率半径の差を求め、車線幅の２分の１よりも前記曲率半径の差の絶対値が小さい場合は、先行車が自車の車線内に存在すると判断し、当該判断結果に基づいて自車の走行を制御する制御装置と、
を有する自動車の制御システム。
【請求項２】
自車と先行車または物標との距離及び方位角度を検出するレーダと、
自車角速度及び自車速度を検出するセンサと、
前記レーダから入力した自車と先行車または物標との距離及び方位角度、並びに前記センサから入力した自車角速度及び前記自車速度に基づいて自車と先行車または物標との曲率半径の差を求め、車線幅の２分の１よりも前記曲率半径の差の絶対値が小さい場合は、先行車が自車の車線内に存在すると判断し、当該判断結果に応じて警報を発生する制御装置と、
を有する自動車の制御システム。
【請求項３】
請求項１または２のいずれかに記載の自動車の制御システムであって、
前記制御装置は、前記距離をＴR、前記方位角度をα、前記自車角速度をωS、前記自車速度をＶSとし、Ｒ＝ＶS／ωS，ＴC＝ＴRsinα，ＴD＝ＴRcosαとしたときに、
【数１】
0003658519.tif 000006
によって曲率半径の差ΔＲを求める自動車の制御システム。
【請求項４】
請求項１または２のいずれかに記載の自動車の制御システムであって、
前記制御装置は、前記自車角速度の微分フィルタ処理の結果が正である場合には前記曲率半径値が小さくなるように補正し、前記結果が負である場合には前記曲率半径値が大きくなるように補正する自動車の制御システム。
【請求項５】
自車と先行車または物標との距離及び方位角度を検出するレーダと、
自車角速度及び自車速度を検出するセンサと、
前記レーダから入力した自車と先行車または物標との距離及び方位角度、並びに前記センサから入力した自車角速度及び前記自車速度に応じて自車と先行車または物標との位置関係を示すパラメータを求め、当該パラメータに基づいて警報の発生有無を決定する制御装置と、
を有する自動車の制御システムであって、
前記制御装置は、カーブ入口および出口で前記パラメータの補正量を変更する自動車の制御システム。
【請求項６】
レーダから入力した自車と先行車または物標との距離及び方位角度、並びにセンサから入力した自車角速度及び前記自車速度に基づいて自車と先行車または物標との曲率半径の差を求め、車線幅の２分の１よりも前記曲率半径の差の絶対値が小さい場合は、先行車が自車の車線内に存在すると判断し、当該判断結果に基づいて自車の走行を制御する自動車の制御装置。
【請求項７】
レーダから入力した自車と先行車または物標との距離及び方位角度、並びにセンサから入力した自車角速度及び前記自車速度に基づいて自車と先行車または物標との曲率半径の差を求め、車線幅の２分の１よりも前記曲率半径の差の絶対値が小さい場合は、先行車が自車の車線内に存在すると判断し、当該判断結果に応じて警報を発生する自動車の制御装置。
【請求項８】
請求項５または６のいずれかに記載の自動車の制御装置であって、
前記制御装置は、前記距離をＴR、前記方位角度をα、前記自車角速度をωS、前記自車速度をＶSとし、Ｒ＝ＶS／ωS，ＴC＝ＴRsinα，ＴD＝ＴRcosαとしたときに、
【数１】
0003658519.tif 000007
によって曲率半径の差ΔＲを求める自動車の制御装置。
【請求項９】
請求項５または６のいずれかに記載の自動車の制御装置であって、
前記自車角速度の微分フィルタ処理の結果が正である場合には前記曲率半径値が小さくなるように補正され、前記結果が負である場合には前記曲率半径値が大きくなるように補正される自動車の制御装置。
【請求項１０】
レーダから入力した自車と先行車または物標との距離及び方位角度、並びにセンサから入力した自車角速度及び前記自車速度に応じて自車と先行車または物標との位置関係を示すパラメータを求め、当該パラメータに基づいて警報の発生有無を決定する自動車の制御装置であって、
カーブ入口および出口で前記パラメータの補正量を変更する自動車の制御装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明は、自動車用の危険物を検出するためのレーダなどを用いた推定装置に関する。特に、本発明は、典型的な自動車運転環境において一般に遭遇する種々の非危険物および真正な危険物を識別する装置に関する。
【０００２】
【従来の技術】
信頼し得る危険物識別を行う多くの試みが、危険物の距離およびその相対速度計測を行う車両レーダ・システムの分野においてなされていた。特開平6−     282798号公報には、運行体の周辺を探索して目標を捕捉し、運行体に対する目標の相対位置を得る目標捕捉手段と、運行体の旋回運動において、運行体の円軌道を推定する円軌道推定手段と、前記目標捕捉手段が得た目標の相対位置と、前記円軌道推定手段が推定した運行体（４）の円軌道とをもとに、前記目標が前記円軌道上に位置しているかどうかを判定し、前記運行体の進路上に位置する目標を識別する制御手段とを有することを特徴とする目標捜索装置が記載されている。また、特開平8−83400号公報には、第１の車線で走行する車両に対して接近位置の１つ以上の物体の存在を検出することが可能である路面車両レーダ・システムにおいて車両に対する危険物となる物体を車両に対する危険物ではない物体から識別する方法において、前記第１の車線に隣接する第２の車線における物体を照射するに充分なビーム幅を有する、車両の運動方向と実質的に直角をなす第１の軸に沿って少なくとも一部が生成されるレーダ・ビームを生成するステップと、照射された物体からの反射信号を受信するステップと、反射信号に基づいて車両の運行方向と実質的に並行な第２の軸（ｘ）の方向における車両速度に関する照射された物体の速度を推定するステップと、少なくとも１つの速度センサを用いて車両の速度を計測するステップと、計測された車両速度と推定された並行物体の速度との和が予め定めた閾値より大きければ、照射された物体が危険であると判定するステップと、計測された車両速度と推定された並行物体の速度との和が予め定めた閾値より小さければ、照射された物体が危険でないと判定するステップとを含む方法が記載されている。
【０００３】
【発明が解決しようとする課題】
自車線前方の先行車（停止車両，物体を含む。以下、物標という。）を検知して、先行車との距離が目標値になるように制御する（ＡＣＣ：Adaptive Cruise Control)、あるいは先行車あるいは物標に接近し過ぎた場合に警報音を発生して衝突警報を発するようなシステムに必要なセンシング要件を考える。次の３段階の考察が必要と考えられる。
【０００４】
第１段階：検知能力、すなわち前方の物標(車両や路側物)が見えるか？
ｉ）物標との距離（特に最大），相対速度及び角度の検知能力
ii）自車線／他車線の車線判断の精度
第２段階：識別能力、すなわち前方物標が何であるか、が分かるか？
特に、前方自車線上にある前方静止物が何であるか識別する（ex：静止車両、コーナーポールや標識などの路側物，高架橋などの路上物を見分ける）ことができるか。
【０００５】
第３段階：意思判断、すなわちドライバーはどの方向に向かおうとしているのか？その前方障害物は、ドライバー意思に基づく将来の走行軌跡に含まれているのか（含まれない場合、警報を発生させる必要はない。）
本発明は、かかる点に鑑みて、自車線／他車線の車線判断精度を向上させ、自車線前方の先行車あるいは物標を検知して、先行車との距離が目標値になるように制御し、あるいは物標の衝突を予防するための衝突警報を精確に発することのできる先行車または物標の車線位置推定装置を提供することを目的とする。また、本発明は、前方自車線上にある前方静止物を危険物であるか、および自車線上にあるかを精確に認識することのできる前方静止物の車線位置推定装置を提供することを目的とする。
【０００６】
また、本発明は、停止している先行車と路側にある標識や高架橋などの静止物を区別し、自車前方にある停止車両に対して警報あるいは制御（減速）を行うことができるようにすることを目的とする。
【０００７】
【課題を解決するための手段】
このため、本発明は、
・レーダが捉えた先行車の動きやその他のセンサ情報をもとに、カーブ路などでも正確な自車線推定、及び位置補正が必要な場合には正確な補正ができる推定アルゴリズムを提供し、
・車両側からの各種データを受信し、ミリ波レーダにより得た検知情報と合わせて先行車の車線位置推定を行い、警報または制御指令情報を車両側に送信できる通信ネットワーク機能及び判断・制御機能を内蔵した一体型のミリ波レーダ装置を提供する。
【０００８】
本発明は、具体的には次に掲げる装置を提供する。
【０００９】
本発明は、レーダから入力した自車と先行車または物標との距離及び方位角度、並びにセンサから入力した自車角速度及び前記自車速度に基づいて自車と先行車または物標との曲率半径の差を求め、車線幅の２分の１よりも前記曲率半径の差の絶対値が小さい場合は、先行車が自車の車線内に存在すると判断し、当該判断結果に基づいて自車の走行を制御する、または当該判断結果に応じて警報を発生する自動車の制御装置またはシステムである。
【００１０】
好ましくは、前記制御装置は、前記距離をＴR 、前記方位角度をα、前記自車角速度をωS、前記自車速度をＶSとし、Ｒ＝ＶS／ωS，ＴC＝ＴRsinα，ＴD＝ＴRcosαとしたときに、
【数１】
0003658519.tif 000002
によって曲率半径の差ΔＲを求めることである。
【００１１】
また好ましくは、前記自車角速度の微分フィルタ処理の結果が正である場合には前記曲率半径値が小さくなるように補正され、前記結果が負である場合には前記曲率半径値が大きくなるように補正されることである。
【００１２】
また本発明は、レーダから入力した自車と先行車または物標との距離及び方位角度、並びにセンサから入力した自車角速度及び前記自車速度に応じて自車と先行車または物標との位置関係を示すパラメータを求め、当該パラメータに基づいて警報の発生有無を決定する自動車の制御装置またはシステムであって、
カーブ入口および出口で前記パラメータの補正量を変更するものである。
【００２２】
【発明の実施の形態】
以下、本発明にかかる実施例を図面に基づいて説明する。
【００２３】
図１は、ミリ波レーダ，シャイロセンサ，ステアリングセンサを使用した車間距離警報システム１を示す。図は、自車２から先行車３に向けてアンテナユニット４からミリ波レーダ信号を発し、接近時警報を行う場合のシステム構成を示している。ミリ波レーダのアンテナユニット４によって公知方法により先行車３との車間距離・相対速度・角度計測５を行う。また、ジャイロセンサ６により角速度計測８を行い、ステアリングセンサ７により舵角計測９を行う。計測された角速度および舵角により、後述するアルゴリズムに従い車線判断１０を行う。計測された車間距離・相対速度・角度（先行車３）と車線判断により先行車判定１１および自車前方の静止物判定１２を行う。これらの判定に基づき、警報判定アルゴリズム１３を使用し、および車速信号，ブレーキ信号２６を使用して警報判断１４を行う。警報判断に基づいて警報指示１５を作り、警報信号１６を発してドライバディスプレイ１７において警報音発生，点灯及び表示を行う。
【００２４】
図２は、他の実施例で、ミリ波レーダ，ジャイロセンサ，ステアリングセンサを使用し、先行車と一定の車間距離を保ちつつ追従走行を行うＡＣＣシステム２１を示す。自車２から走行車３に向けてアンテナユニット４からミリ波レーダ信号を発し、計測された車間距離・相対速度・角度と車線判断により先行車検知２２および静止物検知２３を行う。これらの検知に基づき、車間距離制御アルゴリズム２４を使用し、かつ車速信号，ブレーキ信号２６を使用して加減速判断２５を行う。その判断結果に基づいて車速維持，加速減速信号２７を発し、スロットル制御２９，Ａ／Ｔシステム制御３０，ブレーキ制御３１からなる車間距離制御２８を行っている。
【００２５】
なお、図１，図２のシステム、すなわち警報システムとＡＣＣシステムは、必ずしも別個のシステムとしてのみ存在するのではなく、両者の機能を合わせて有するシステム構成を取ることもできる。
【００２６】
次に、図３は図１および図２に示すシステム実施例を実現するためのハードウエア構成をブロック図で示したものである。図に示す構成は、一体型ミリ波レーダ装置３５，車両側制御部３６、およびドライバディスプレイ３７からなる。
【００２７】
該一体型ミリ波レーダ装置３５は、例えばＣＡＮを用いた通信ネットワーク機能を有し、車両側制御部３６，ドライバディスプレイ３７と通信ネットワークを構成している。図において、３５に内蔵される送信アンテナ４１，受信アンテナ４２及び高周波回路４３により得たレーダ検知信号およびジャイロセンサ６からのアナログ信号はＡ／Ｄ変換４４され、ディジタル信号処理回路(ＣＰＵ,ＤＳＰ等で構成）４５により信号処理される。該ディジタル信号処理回路４５は、内蔵ソフトウェア４７として、レーダ信号処理，先行車捕捉，自車線判断等に基づき、警報においては危険度判断，警報指令、ＡＣＣにおいてはＡＣＣ追従指令，加速減速指令などの処理を行うためのソフトウェアを内蔵している。これらの各種信号は、データ通信部４６を介して通信ネットワーク３８を介して通信される。ドライバディスプレイ３７は、受信した通信信号にしたがい、警報音の発生や点灯，先行車との車間距離表示などを行う。逆にドライバの設定変更に応じて、警報においては警報発生距離の調整、ＡＣＣにおいては先行車との目標車間距離の調整信号などを送出し、３５に送る。３５のディジタル信号処理回路では、該調整信号に基づき、各種パラメータの変更が実施される。
【００２８】
車両側制御部３６は、ＡＣＣシステムを構成する場合に用いられる。これは、エンジンコントロールユニット５１，ＡＴコントロールユニット５２およびブレーキコントロールユニット５３からなり、一体型ミリ波レーダ装置３５からの信号を受けて、加速減速を行うために、エンジン出力，ＡＴシフト位置、及び大きな減速を行うために自動ブレーキなどを行う。３６には車両側制御で必要な各種センサ信号、例えばジャイロセンサ信号６，ステアリングセンサ信号７，車速センサ信号２６・ブレーキ信号２６０，車輪速度センサ信号５４，シフトポジションセンサ信号５５および加速度センサ信号５６などが入力されている。そして、一体型ミリ波レーダ装置３５側で必要な信号、例えば車速センサ信号２６やステアリングセンサ７は通信ネットワーク３８を介して送出される。
【００２９】
これらのシステム構成において、特に車両側制御部３６については公知技術であるのでこれ以上詳しくは述べない。
【００３０】
次に、前記内蔵ソフトウエア４７において、特にカーブでの車線判断を行う方法および演算式の導出について説明する。
【００３１】
図４は、曲率半径Ｒs の円曲線上にある自車とＲf 上にある先行車の関係を示している。自車からみて先行車が自車線上にあるか、隣接車線上にあるかは本来は自車と先行車の曲率半径の差ΔＲで判断できる。
【００３２】
演算の方法は以下の通りである。
【００３３】
１．ミリ波レーダを用いて、距離ＴR と方位角度α、内蔵ジャイロセンサ６で自車角速度ωs 及び自車速度ｖs を計測する。
【００３４】
２．横変位ＴC ，縦変位ＴD 及び自車曲率半径Ｒs を次式で計算する。
【００３５】
ＴC＝ＴRsinα，ＴD＝ＴRcosα，Ｒs＝ｖs／ωs
３．図４に示すように先行車の回転半径Ｒf は、次式が成立する。
【００３６】
0003658519.tif 000003
４．よって、次式より求める。
【００３７】
【数２】
0003658519.tif 000004
【００３８】
今、車線幅としてＬｙを仮定すると、
【００３９】
【数３】
0003658519.tif 000005
【００４０】
のとき自車線と判断する。Ｌｙの値は、自車が車線中央を走っているとは限らないので、自車に対して左右対称の半車線幅とは限らない。その設定方法については後述の実施例で開示される。
【００４１】
次に、図５および図６を使用して先行車の曲率半径Ｒｆについての補正について説明する。現在、カーブ中の先行車の位置をジャイロセンサで測定した角速度をもとに補正し、先行車の車線位置を推定している。自車の角速度を用いるこの補正法では、先行車が現在の自車と同一の位置の回転中心から引いた円周上にあるとして計算されている。
【００４２】
しかしながら、実際の道路は直線とカーブのみで構成されるのではなく、その間を徐々にＲを変えながらつないで行く「緩和曲線」区間がかならず存在する。
したがって角速度が十分精度よく測定できたとしても、正しい測定ができるのは、先行車，自車とも直線にいるか円曲線内にあるときのみである。したがって、この緩和曲線の存在を検知してＲ補正することが重要になる。
【００４３】
図５は、直線区間６１につらなる緩和区間６２，一定Ｒ区間６３，緩和区間６４，該緩和区間６４につらなる直線区間６５を示す。すなわち、緩和区間６２ではＲが徐々に小さくなり（角速度が増大）し、一定Ｒ区間(円曲線区間)６３で一定Ｒ（角速度一定）となり、逆緩和区間６４に入って徐々にＲが増大していき（角速度減少）直線区間に復帰する。(直線ではＲ＝∞)したがって、もし自車と先行車が同一の車線中央を走っていたとしても、自車が緩和区間６２のときは、先行車はこれより小さいＲを走行し、逆に６４にいるときは先行車のＲは自車の検出Ｒより大きくなっている。
【００４４】
図６（ａ)(ｂ）は、このようなカーブに入ってからの検出された角速度ωR の変化、及び曲率半径Ｒの変化とこのＲの補正方向を示す。図に示すように緩和区間６２でＲを小さく補正して（Ｒ−ΔＲ）とし、一定Ｒ区間６３でＲのままとし、緩和区間６３でＲを大きく補正して (Ｒ＋ΔＲ) として先行車の車線推定に反映させる。
【００４５】
いま、先行車に相対速度のない状態で追従走行しているとする。このときＲの補正を行うためには、
１．先行車との距離ｄ，方位角度θ及びその変化Δθ
２．時々刻々の角速度ωRとその変化ΔωR
３．ステアリングの舵角φとその変化速度δφ
のセンサ情報を用いてなされる。
【００４６】
図７は、補正手順を示すフローチャートである。まず、ステップ７０１において時刻ｔでの先行車との距離ｄ(ｔ)，先行車方位角度θ(ｔ)，角速度ωR(ｔ），ステアリング舵角φ(ｔ)を検知し記憶する。次にステップ７０２において過去の時刻歴ｔ−１，ｔ−２，…を用いて微分フィルタ処理を行い、θ(ｔ),ωR(ｔ),φ(ｔ)の変化Δθ(ｔ)，ΔωR(ｔ)，δφ(ｔ）を求める。ステップ７０３において、Δθ(ｔ)とδφ(ｔ)の絶対値｜Δθ(ｔ)｜と｜δφ(ｔ)｜を判定する。共に大きく変化した場合、車線変更と判断され、補正処理の対象から外す（ステップ７０４）。一方、そのように判断されない場合は、補正処理の対象とする。ステップ７０５において、ΔωR(ｔ)の正負を判断する。ΔωR＞０の場合、自車は緩和区間６２にあると判定され、Ｒ→（Ｒ−ΔＲ）と小さく補正される。（ステップ７０６)，ΔωR＜０の場合逆緩和区間６４にあると判定され、Ｒ→(Ｒ＋ΔＲ)と大きく補正される。(ステップ７０７），ΔωR＝０の場合、円曲線区間６１にあると判定され、Ｒ補正は実施されない（ステップ７０８）。
【００４７】
ところで、ミリ波レーダをキーセンサとして警報及びＡＣＣシステムを構成する場合、走行中の先行車などの移動物対象については比較的問題が少ない。しかしながら、前方静止物に対する警報もしくはＡＣＣ減速制御を行うのはきわめて難しい問題をはらんでいる。なぜならば、ミリ波レーダは物標との距離や相対速度及び角度を正確に測定することはできても、それが何であるか認識することはできない。例えば、前方にカーブがある場合、前方進行方向上に静止物を捉えたとしても、それが自車線上の停止車両か路側や路上にある標識などであるか判断することは難しい。このように、ミリ波レーダのみで判断できない場合が往々にして存在する。
【００４８】
そこで、図８は、静止物に対する警報判断を正確にするために、図１の実施例に別種のセンサであるＣＣＤカメラを加えた場合の実施例である。先に示した実施例の構成と同一の構成には同一番号を付し、説明を繰り返さない。図は、ミリ波レーダ，ジャイロセンサ，ステアリングセンサおよびＣＣＤカメラからの信号を使用して構成する車間距離警報システム７０を示す。図において、ＣＣＤカメラ７１は、通常はその写真画像から白線認識７２に用いられ、ズーミング機能を有している。一方、ミリ波レーダは距離や相対速度及び角度から静止物検知を行っている。今、ミリ波が前方に静止物２３を検知した場合、カメラは白線認識７２を一時中断し、ミリ波が捉えた前方静止物をズーミングする。そして、静止物認識７３を行い、停止車両など障害物であるか、走行路外の標識や高架橋などの非障害物であるかを判定する。この静止物認識に基づいて警報判断１４がなされ、静止物に対する警報指示１５を行い警報信号１６をドライバディスプレイ１７に送る。
【００４９】
図９は、同様に、ミリ波レーダ，ジャイロセンサ，ステアリングセンサおよびＣＣＤカメラからの信号を使用して構成するＡＣＣシステム７５を示す。図８同様の静止物検知−認識を行い、静止物認識７３信号に基づいて車両の加減速判断２５（静止物に対しては減速判断）がなされる。
【００５０】
図１０は、静止物の一例として高架橋と停止車両との区別を行った場合である。ミリ波レーダは、かなり前方、数値的には１００−１５０［ｍ］手前で高架橋を検知する。この時点では、前方静止物は高架橋であるか停止車両であるか判別できない。もしも検知した静止物が停止車両であった場合には、時速１００km以上での高速走行においては、減速には時間がかかるのでこの時点で警報することが必要になる。そこで、カメラを用いた画像処理により高架橋であるか停止車両などの路上障害物であるか判断させる。画像処理で行うのは、パターンマッチングにより物標を識別することであり検知精度は要求されない。識別の結果、高架橋と判断された場合には、警報出力はしない。このように、ミリ波による物標検知とカメラ画像処理による物標識別を組合わせることで、警報の精度を向上させることができる。
【００５１】
ところで、前方静止物が何であるか分かり、それが車線上にある停止車両など障害物であったとしても、警報を出すか否かの判断材料としては、完全ではない。例えば、前方に分岐路がありその片側に停止車両がある場合などは、その車両がどちらのコースを選択するかわからないと警報を出すべきかどうか正確な判断はできない。そこで、図１１は、ミリ波レーダ，ジャイロセンサ，ステアリングセンサ，ＣＣＤカメラに加えナビゲーションシステムからの信号を使用して構成する車間距離警報システム７６を示している。図において、ナビゲーションシステム７７を使用して経路判断７８を行う。ナビゲーションシステム以外のセンサにより静止物検知，静止物認識がなされ、停止車両などの警報対象物と判定されたとする。このとき、ナビゲーションシステム７７の経路判断機能７８によりその警報対象物が将来の走行車線上にあるか判断する。そして、走行車線上にあると判断された場合にのみ警報指示１５を行う。これによって警報指示１５の精度が向上する。
【００５２】
図１２は、同様に、ミリ波レーダ，ジャイロセンサ，ステアリングセンサ，
ＣＣＤカメラおよびナビゲーションシステムからの信号を使用して構成するACCシステム７５を示す。図において、経路判断７８による信号に基づいて加減速判断２５がなされる。これによって、車間距離制御が精度高く行われることになる。
【００５３】
前述した、図８〜図１１の実施例においては、ミリ波レーダに加えてカメラ及びナビゲーションシステムを付加することで、静止物に対する警報もしくは制御を高精度化することを実現した。以下は、図１，図２のミリ波レーダ及びサブセンサとしてジャイロセンサ，ステアリングセンサのみを用いたシステムを前提とする。この場合、状況は限定されるとしても以下の問題を解決することにより、高精度の警報もしくは制御を実現できる。
【００５４】
１．自車前方から始まるカーブを予測できないか？
２．自車は自車線の中央または端のどこを走行しているか推定できないか？
３．移動物の関係から自車線上に静止障害物があるか判定できないか？
以下、図面に基づいて説明する。
【００５５】
図１３（ａ)(ｂ）は、複数の走行車線を有する道路において、自車の前方を走行する車両が横方向に移動していく２つの場合を示している。図１３（ａ）は、自車がカーブ手前にあり前方車がカーブ路に差し掛かった場合、図１３（ｂ）は先行車が車線変更を行った場合である。図１３（ａ）は、先行車は引き続き警報もしくは追従対象であり、図１３（ｂ）においては先行車は対象から外れることになる。両方とも自車から見ると先行車が横方向に移動していくように見えるが、他の車両の動きと比較して区別することができる。すなわち、前方車１および前方車２と先行車が同一横方向の動きをするか検知し、同一横方向の動きをしたときにカーブ、異なる動きをしたときに車線変更と判定する。
【００５６】
図１４は、図１３（ａ）及び図１３（ｂ）を識別する手順を示すフローチャートである。
【００５７】
まずステップ１４０１は時刻ｔでの先行車１との車間距離，方位角度、及び自車速度と相対速度から先行車速度、（ｄ１(ｔ)，θ１(ｔ)，Ｖｆ１（ｔ））を検知する。同様に、自車線以外の前方車２，３についても
(ｄ２(ｔ)，θ２(ｔ)，Ｖｆ２(ｔ))，（ｄ３(ｔ)，θ３(ｔ)，Ｖｆ３(ｔ)）、を検知する。（ここでは検出する前方車を２台としたがもっと検知できている場合には検出台数を増やしても構わない。）
次に、ステップ１４０２において、過去の時刻歴ｔ−１，ｔ−２，…のデータを用いて微分フィルタ処理を行い、θ１(ｔ)，θ２(ｔ)，θ３(ｔ)の変化Δθ１(ｔ)，Δθ２(ｔ)，Δθ３(ｔ)を求める。ステップ１４０３では、（Δθ１(ｔ)／Ｖｆ１(ｔ)），（Δθ２(ｔ)／Ｖｆ２(ｔ)），（Δθ３(ｔ)／Ｖｆ３(ｔ)）を求める。これは各車両が距離あたり変化する角度に相当し各車両の車速に依存しない量である。これを用いて、ステップ１４０４では、先行車と前方車１，２の移動量ΔＭ１２＝｜（Δθ１／Ｖｆ１）−（Δθ２／Ｖｆ２）｜，ΔＭ１３＝｜（Δθ１／Ｖｆ１）−（Δθ３／Ｖｆ３）｜を求め判定する。ΔＭ１２ともΔＭ１３の値が一定値以下であれば、カーブによる移動であると判定する（ステップ１４０５）。一方、ある値より大きい場合、車線変更が生じたと判定する（ステップ１４０６）。
【００５８】
ここでは３車線の中央を自車及び先行車が走行し、左右車線に１台ずつ走行している例を示したが、２車線以上で先行車以外の前方車を捉えていれば同様の推定ができる。ただし、捕捉車両が多いほど推定精度は向上する。特に前方車が車線変更を行った場合など仮定が異なってくるが、捕捉対象車両を増やすことによりこうした誤推定を回避できる。
【００５９】
ところで、図４や図１３（ａ),（ｂ）などでは、自車線推定にあたっては自車が車線中央を走っていると仮定して先行車の車線位置を判断している。例えば、図１３（ａ）に示すように、先行車や前方車が車線中央を走っており、各車両の横方向距離が車線幅Ｌｙにほぼ等しい場合などは問題がない。しかしながら、図１３（ｂ）のように自車，先行車，前方車が車線の片端に偏って走行している場合などはどちらが先行車かわからないことになる。この場合も含め、自車の白線に対する走行位置を推定し、それに応じて自車線の範囲を左右いずれかにオフセットさせて先行車判断に反映させることが重要である。
【００６０】
図１５は、この自車位置推定ならびに推定結果に基づき自車線位置を左右いずれかの方向にオフセットさせる方法に関するフローチャートである。まずステップ１６０１において先行車として認識している１台（図１３（ｂ）のように判断できない場合には方位角度の小さい側を先行車とする）以外の、左右前方車の横方向距離ＹＬ(ｔ)，ＹＲ(ｔ)を求める。ステップ１６０２において、過去一定回数サンプルしたＹＬ(ｔ)，ＹＲ(ｔ)の移動平均値＜ＹＬ(ｔ)＞，＜ＹＲ(ｔ)＞を求める。ステップ１６０３において、得られた＜ＹＬ(ｔ)＞，＜ＹＲ(ｔ)＞に対して、
Ｌｙ＋ΔＬｙ＜{(＜ＹＬ(ｔ)＞＋＜ＹＲ(ｔ)＞)／２＞}＜Ｌｙ−Δｌｙ
（ここで、Ｌｙ：１車線幅，Δｌｙ：１車線幅より小さい値。）
であるかどうか判定する。条件が満たされない場合は、信頼性が低いデータであるとして採用されない。
【００６１】
条件が満たされた場合、ステップ１６０４にうつり、次式にしたがい判定する。
【００６２】
・{＜ＹＬ(ｔ)＞−Ｌｙ}＞ΔＬｙかつ{＜ＹＲ(ｔ)＞−Ｌｙ}＜ΔＬｙ、のとき右側寄り
・{＜ＹＬ(ｔ)＞−Ｌｙ}＜ΔＬｙかつ{＜ＹＲ(ｔ)＞−Ｌｙ}＞ΔＬｙ、のとき左側寄り
・{＜ＹＬ(ｔ)＞−Ｌｙ}＜ΔＬｙかつ{＜ＹＲ(ｔ)＞−Ｌｙ}＜ΔＬｙ、のとき中央
ステップ１６０５ではその結果に応じて、自車線判定の範囲を右側もしくは左側にオフセットさせるかそのまま維持とするか判断する。
【００６３】
以上は３車線の中央を走行している場合であるが、２車線あるいは対面道路であっても同様のことはできる。この場合は片側のみの前方車もしくは対面車との横距離をレファレンスに用いるが、サンプル数を増やすことにより信頼性を向上できる。なお、この方法では、ミリ波レーダの取付上の問題から車両の左右いずれかにオフセットさせて装着しなければならない場合においても自動推定して補正することが可能である。
【００６４】
次に、先行車が横に移動し、その先に静止物が現われた場合について説明する。図１６（ａ)(ｂ）は、先行車が横に移動して、その先に静止物が現われた場合を示す。基本的には、図１６（ａ）は警報を出すべきであり、図１６（ｂ）のケースでは出すべきでない。しかしながら、前方のコースが予測できないために、両者の区別がつかない。そこで、図１７では、先行車の横移動の速度及びそのパターンに着目し、両者の区別を図る方法を示したものである。図のように、先行車の横方向移動速度を時間との関係で示すと、カーブの場合は、なだらかな変化となって検知されるが、車線変更の場合はステアリングの舵角が大きいために最初大きく、車線変更終了後はステアリングを戻すため横方向速度はなくなるような山形状の変化として検知される。自車は先行車の動きを検知しつつ静止物に接近していくが、自車の車速及び車間距離に応じて時間Ｔ１，Ｔ２，Ｔ３の位置と警報判断を行うタイミングが異なる。Ｔ２，Ｔ３の場合、判定はたやすく、先行車移動速度の変極点Ｐを検知することにより容易に両者を判別できる。一方、
Ｔ１の時点ではあるしきい値をもとに両者を判別する必要がある。このしきい値は自車速度，先行車速度，先行車方位角度，自車角速度、及び車間距離に応じて随時変更されるものである。
【００６５】
図１８は、対向車より遠距離にある静止物または静止物を対向車が横切る場合を示す。このような場合を検知したときは、自車線上にある静止物とはみなさず、警報は鳴らさない。方法としては、最初に捉えた静止物の方位角度付近の方位角度において対向車を捉え、その車間距離が静止物よりも近くであれば、その静止物は車線外の路側物であるとみなし警報対象にはしない。この場合、その判断は静止物と対向車を捉えた時間差をもとに自車の移動分を補正して判定されている。
【００６６】
以上のように、本発明は、
・先行車位置の正しい推定式を提供し、それを用いた装置を提案した。
【００６７】
・カーブ入口：角度速発生初期（増加方向）とカーブ出口：角速度発生後期（減少方向）で補正量を変更することとした。
【００６８】
・複数先行車の検知位置をもとに、白線位置を推定することとした。また、前方車の横方向の移動量を検知して前方のカーブ，分岐を判断することにした。
【００６９】
・ジャイロセンサおよびステアリングセンサの両方を用いて自車線の判断，先行車の位置補正を行うこととした。
【００７０】
・先行車の動きから前方静止物の車線位置判定と静止物警報の有無を判定することとした。
【００７１】
・対向車との位置関係から前方静止物の車線位置を判定することとした。
【００７２】
・前方に検知した静止物が高架橋などの路上物であるかの認識を行い、その場合は警報しないこととした。
【００７３】
・走行車線上に停止車両を捉えたとき、自車の走行経路であるかを判定し、経路であるときは警報することとした。
【００７４】
・通信ネットワーク機能及び判断・制御機能を内蔵した一体型のミリ波レーダ装置を使用することを提案した。
【００７５】
【発明の効果】
以上のように本発明によれば、
・ミリ波レーダを用いて自車線前方の先行車（停止車両を含む）を検知して、先行車との距離が目標値になるように制御し、あるいは、先行車と接近し過ぎた場合に警報音を発生する衝突警報を発することができる。
【００７６】
・また、停止している先行車と路側にある標識や高架橋などの静止物を区別し、自車線前方にある停止車両に対してのみ警報あるいは制御（減速）を行うことができる。
【００７７】
・レーダが捉えた先行車の動きやその他のセンサ情報をもとに、カーブ路などでも正確な自車線推定、及び位置補正が必要な場合には正確な補正ができる。
【００７８】
・車両側からの各種データを受信し、ミリ波レーダにより得た検知情報と合わせて先行車の車線位置推定を行い、警報または制御指令情報を車両側に送信できる。
【図面の簡単な説明】
【図１】車間距離警報システムの概略構成図。
【図２】ＡＣＣシステムの概略構成図。
【図３】制御ブロック図。
【図４】計算方式図。
【図５】曲率半径説明図。
【図６】（ａ)(ｂ）は曲率変化と補正の関係図。
【図７】補正手順のフローチャート図
【図８】車間距離警報システムの概略構成図。
【図９】ＡＣＣシステムの概略構成図。
【図１０】高架橋と停止車両の識別図。
【図１１】車間距離警報システムの概略構成図。
【図１２】ＡＣＣシステムの概略構成図。
【図１３】（ａ)(ｂ）は先行車のカーブと車線変更の識別図。
【図１４】識別方法のフローチャート。
【図１５】自車線位置推定のフローチャート
【図１６】（ａ)(ｂ）は先行車および静止物認識図。移動速度図。
【図１７】カーブと車線変更の横方向移動図。
【図１８】対向車および静止物認識図。
【符号の説明】
１…車間距離警報システム、２…自車、３…先行車、４…アンテナユニット、５…車間距離・対向速度・角度計測、６…ジャイロセンサ、７…ステアリングセンサ、８…角速度、９…舵角、１０…車線判断、１１…先行車判定、１２…静止物判定、１３…警報判定アルゴリズム、１４…警報判断、１５…警報指示、２１…ＡＣＣシステム、２２…先行車検知、２３…静止物検知、２４…車間距離制御アルゴリズム、２５…加減速判断、２６…車速信号・ブレーキ信号、２８…車間距離制御、７０…車間距離警報システム、７１…ＣＣＤカメラ、７２…白線認識、７７…ナビゲーションシステム、７８…経路判断。
【図１】
0003658519.tif 000008
【図２】
0003658519.tif 000009
【図３】
0003658519.tif 000010
【図４】
0003658519.tif 000011
【図５】
0003658519.tif 000012
【図６】
0003658519.tif 000013
【図７】
0003658519.tif 000014
【図８】
0003658519.tif 000015
【図９】
0003658519.tif 000016
【図１０】
0003658519.tif 000017
【図１１】
0003658519.tif 000018
【図１２】
0003658519.tif 000019
【図１３】
0003658519.tif 000020
【図１４】
0003658519.tif 000021
【図１５】
0003658519.tif 000022
【図１６】
0003658519.tif 000023
【図１７】
0003658519.tif 000024
【図１８】
0003658519.tif 000025