JPH09288179A - 車両用カーブ径推定装置および目標先行車検出装置 - Google Patents

Abstract

(57)【要約】 【課題】前方カーブ径を精度良く推定する。 【解決手段】レーダ装置１にて自車両と先行車両との車
間距離および方向を検出し、これに基づいて対象車両判
別手段２にて自車線上を走行する複数の先行車両を抽出
する。カーブ径推定手段３では、これらの先行車両の走
行位置座標を円の方程式に代入することによりカーブ径
を求める。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、自車両がカーブへ
進入する前にそのカーブ径を推定する車両用カーブ径推
定装置、および自車線上を走行する目標先行車を検出す
る目標先行車検出装置に関する。

【０００２】

【従来の技術】従来より、車両用カーブ径推定装置また
は目標先行車検出装置として、例えば特開平５−８７，
９２２号公報に記載された障害物検出装置が知られてい
る。この障害物検出装置は、目標対象物が移動した場合
でも、複数のレーザビームのうちの幾つかのレーザビー
ムが常に目標対象物を検知し続けることができるよう
に、レーダの主軸方向を目標対象物に追従可能にしたも
のである。

【０００３】また、特開平４−３６９，８００号公報に
記載された車両用カーブ径推定装置は、カーブ路に設置
されているリフレクタ（反射器）間の距離を検出するこ
とによりカーブ径を推定するものであり、自車両の車速
と、自車両からリフレクタまでの距離とによって、リフ
レクタ間の距離が演算される。そして、高速道路等にお
いては、カーブ径に応じてリフレクタの間隔を変えてい
るので、これを利用してカーブへ進入する前に、そのカ
ーブ径を推定することができる。

【０００４】

【発明が解決しようとする課題】しかしながら、このよ
うな従来の車両用カーブ径推定装置または目標先行車検
出装置にあっては、以下の問題があった。すなわち、レ
ーダの主軸方向を先行車に追従させる技術では、図１８
（Ａ）に示すようなカーブの入口などでは、先行車の移
動が比較的緩やかに行われるので先行車を追従すること
はできるものの、同図（Ｂ）に示すように先行車が突然
に車線変更を行ったときなどレーダの主軸制御が間に合
わない場合には目標先行車の検出ができないという問題
があった。このため、自車両のステアリング角度や左右
の車輪速差から自車線のカーブ径を推定し、これにより
レーダの主軸方向を変えることも考えられるが、このよ
うにすると先行車の車線変更は検出できるものの、カー
ブ入口において、先行車が自車線上を走行している場合
も車線変更したと誤認識するおそれがある。

【０００５】一方、リフレクタを利用して道路形状を認
識する技術には、先行車や他車線走行車が邪魔になって
リフレクタを検出できなかったり、一般道などリフレク
タの少ない道路では使用できないという問題があった。
また、この技術には、看板や停止車両など路側にリフレ
クタに類似したものがある場合には、道路形状を誤認識
してしまうおそれもあった。

【０００６】また、カメラを用いて前方のカーブ径を検
出することも有効な技術ではあるが、逆光や夜間におい
て認識できない場合があり、レーダで道路形状を認識す
ることが必要となる。

【０００７】本発明は、このような従来技術の問題点に
鑑みてなされたものであり、先行車とその前方を走行す
る先々行車までの車間距離と方向から、前方カーブ径を
推定し、カーブの入口や出口で目標先行車の検出を精度
良く実行できる車両用カーブ径推定装置および目標先行
車検出装置を提供することを目的とする。

【０００８】

【課題を解決するための手段】上記目的を達成するため
に、請求項１記載の本発明の車両用カーブ径推定装置
は、自車両から先行車両までの距離と方向とを検出する
距離方向検出手段と、自車両の走行経路と前記距離方向
検出手段で検出された距離および方向とに基づいて、前
記先行車両が自車線上を走行する先行車両か他車線上を
走行する先行車両かを判別する対象車両判別手段と、前
記対象車両判別手段で自車線上を走行する先行車両と判
別された先行車両と自車両との距離および方向に基づい
て、カーブ径を推定するカーブ径推定手段とを備えたこ
とを特徴とする。

【０００９】この請求項１記載の車両用カーブ径推定装
置では、まず捕捉された先行車が自車線上を走行する車
両であるかどうかを判別し、自車線上を走行する車両の
みを２台以上用いて、これらの先行車両までの距離と方
向とに基づいて、前方のカーブ径を推定するので、リフ
レクタのないカーブ路においても、前方のカーブ路を認
識することができる。

【００１０】また、本発明の車両用カーブ径推定装置
は、車間距離警報装置や車間距離制御装置に利用するこ
とができ、この場合、先行車の認識精度が著しく高くな
る。さらに、カーブの存在を精度良く認識できるので、
車間距離警報装置の誤警報を防止することができる。本
発明のカーブ径推定装置は、車速の制御装置にも利用す
ることができ、この場合、カーブの入口での減速制御が
可能となる。さらに、本発明のカーブ径推定装置は、車
速の警報装置にも利用することができ、カーブ入口での
速度過剰状態を検知して、警報を発することができる。

【００１１】上記請求項１記載の車両用カーブ径推定装
置において、前記カーブ径推定手段におけるカーブ径の
推定方法は特に限定されないが、請求項２記載の車両用
カーブ径推定装置は、前記カーブ径推定手段が、自車線
上を走行する２台以上の先行車両と自車両との距離およ
び方向に基づいて、カーブ径を推定することを特徴とす
る。

【００１２】カーブ径は、少なくとも自車両を含めた３
台の車両の走行位置座標を円の方程式に代入することに
より推定することができる。この請求項２記載の車両用
カーブ径推定装置では、自車両および２台の先行車両、
または３台の先行車両の走行位置座標を円の方程式に代
入することによりカーブ径を推定する。したがって、全
ての車両の走行位置座標がある特定の時間における座標
であるため、その前後の走行経路に影響されることがな
く、これによりカーブ径の推定値精度が高くなる。

【００１３】また、請求項３記載の車両用カーブ径推定
装置は、前記カーブ径推定手段が、自車線上を走行する
先行車両の走行経路に基づいて、カーブ径を推定するこ
とを特徴とする。

【００１４】この請求項３記載の車両用カーブ径推定装
置では、自車線上を走行する先行車両が１台のみであっ
ても、その先行車両の走行経路からカーブ径を推定する
ので、混雑していない道路においても有効に利用するこ
とができる。

【００１５】上述した請求項１乃至３記載の車両用カー
ブ径推定装置において、対象車両判別手段の構成は特に
限定されないが、請求項４記載の車両用カーブ径推定装
置は、前記対象車両判別手段が、前記自車両のステアリ
ング角度を検出するステアリング角度検出手段と、走行
時間を計測する時間計測手段と、前記自車両の車速を検
出する車速検出手段と、前記ステアリング角度検出手
段、前記時間計測手段および前記車速検出手段でそれぞ
れ検出されたステアリング角度、走行時間および車速に
基づいて、前記自車両の走行経路を検出する自車両走行
経路検出手段と、前記ステアリング角度検出手段、前記
時間計測手段、前記車速検出手段および前記距離方向検
出手段でそれぞれ検出されたステアリング角度、走行時
間、車速および前記先行車両までの距離と方向に基づい
て、前記先行車両の走行経路を検出する先行車両走行経
路検出手段と、前記自車両走行経路検出手段および前記
先行車両走行経路検出手段でそれぞれ検出された前記自
車両の走行経路および前記先行車両の走行経路に基づい
て、自車線上を走行する先行車両を特定する先行車両判
別手段とを有することを特徴とする。

【００１６】この請求項４記載の車両用カーブ径推定装
置では、ステアリング角度、走行時間、車速および車間
距離、方向に基づいて、自車両の走行位置座標と先行車
両の走行位置座標とを求め、これにより先行車両が自車
線上にあるかどうかを判別する。ここで、自車両の走行
経路に最も関連があるステアリング角度を利用するの
で、カーブ径の推定値精度が高くなる。

【００１７】また、請求項５記載の車両用カーブ径推定
装置は、前記対象車両判別手段が、前記自車両の左右の
車輪速を検出する左右車輪速検出手段と、走行時間を計
測する時間計測手段と、前記左右車輪速検出手段および
前記時間計測手段でそれぞれ検出された自車両の左右の
車輪速の差および走行時間に基づいて、前記自車両の走
行経路を検出する自車両走行経路検出手段と、前記左右
車輪速検出手段、前記時間計測手段および前記距離方向
検出手段でそれぞれ検出された前記自車両の左右の車輪
速の差、走行時間および前記先行車両までの距離と方向
とに基づいて、前記先行車両の走行経路を検出する先行
車両検出手段と、前記自車両走行経路検出手段および前
記先行車両走行経路検出手段でそれぞれ検出された前記
自車両の走行経路および前記先行車両の走行経路に基づ
いて、自車線上を走行する先行車両を特定する先行車両
判別手段とを有することを特徴とする。

【００１８】この請求項５記載の車両用カーブ径推定装
置では、ステアリング角度に代えて左右の車輪速を利用
するので、道路の傾きやステアリングの遊びの影響がな
くなる。

【００１９】さらに請求項６記載の車両用カーブ径推定
装置は、前記対象車両判別手段が、前記自車両のヨーレ
イトを検出するヨーレイト検出手段と、走行時間を計測
する時間計測手段と、前記自車両の車速を検出する車速
検出手段と、前記ヨーレイト検出手段、前記時間計測手
段および前記車速検出手段でそれぞれ検出された自車両
のヨーレイト、走行時間および自車両の車速に基づい
て、前記自車両の走行経路を検出する自車両走行経路検
出手段と、前記ヨーレイト検出手段、前記時間計測手
段、前記車速検出手段および前記距離方向検出手段でそ
れぞれ検出された自車両のヨーレイト、走行時間、自車
両の車速および前記先行車両までの距離と方向に基づい
て、前記先行車両の走行経路を検出する先行車両走行経
路検出手段と、前記自車両走行経路検出手段および前記
先行車両走行経路検出手段でそれぞれ検出された前記自
車両の走行経路および前記先行車両の走行経路に基づい
て、自車線上を走行する先行車両を特定する先行車両判
別手段とを有することを特徴とする。

【００２０】この請求項６記載の車両用カーブ径推定装
置では、ヨーレイトを利用するので、タイヤの摩耗の影
響がなくなる。

【００２１】上記請求項１乃至６記載の車両用カーブ径
推定装置において、距離方向検出手段の具体的構成は特
に限定されないが、請求項７記載の車両用カーブ径推定
装置は、前記距離方向検出手段が、光ビームまたは電波
を走査させるスキャニングレーダ装置であることを特徴
とする。

【００２２】また請求項７記載の車両用カーブ径推定装
置は、前記距離方向検出手段が、複数の光ビームまたは
電波を発するマルチレーダ装置であることを特徴とす
る。

【００２３】請求項１乃至８記載の車両用カーブ径推定
装置は、車間距離警報装置、車間距離制御装置、車速警
報装置、車速制御装置など広く利用することができる
が、請求項９記載の発明は、目標先行車検出装置であっ
て、請求項１乃至８の何れかに記載の車両用カーブ径推
定装置と、前記車両用カーブ径推定装置の前記カーブ径
推定手段で求められたカーブ径推定値に基づいて、自車
線上を走行する先行車を選定する先行車選定手段とを備
えたことを特徴とする。

【００２４】この請求項９記載の目標先行車検出装置で
は、請求項１乃至８記載の車両用カーブ径推定装置を利
用しているので、先行車の認識精度が著しく高くなる。

【００２５】

【発明の効果】請求項１記載の車両用カーブ径推定装置
によれば、リフレクタのないカーブ路においても、前方
のカーブ路を認識することができる。また、車間距離警
報装置や車間距離制御装置に利用することができ、この
場合、先行車の認識精度が著しく高くなる。さらに、カ
ーブの存在を精度良く認識できるので、車間距離警報装
置の誤警報を防止することができる。また、車速の制御
装置にも利用することができ、この場合、カーブの入口
での減速制御が可能となる。さらに、車速の警報装置に
も利用することができ、カーブ入口での速度過剰状態を
検知して、警報を発することができる。

【００２６】請求項２記載の車両用カーブ径推定装置に
よれば、全ての車両の走行位置座標がある特定の時間に
おける座標であるため、その前後の走行経路に影響され
ることがなく、これによりカーブ径の推定値精度が高く
なる。

【００２７】請求項３記載の車両用カーブ径推定装置に
よれば、自車線上を走行する先行車両が１台のみであっ
ても、その先行車両の走行経路からカーブ径を推定でき
るので、混雑していない道路においても有効に利用する
ことができる。

【００２８】請求項４記載の車両用カーブ径推定装置に
よれば、自車両の走行経路に最も関連があるステアリン
グ角度を利用するので、カーブ径の推定値精度が高くな
る。

【００２９】請求項５記載の車両用カーブ径推定装置に
よれば、ステアリング角度に代えて左右の車輪速を利用
するので、道路の傾きやステアリングの遊びの影響がな
くなる。

【００３０】請求項６記載の車両用カーブ径推定装置に
よれば、車両のヨーレイトを利用するので、タイヤの摩
耗の影響がなくなる。

【００３１】請求項７および８記載の車両用カーブ径推
定装置によれば、先行車両との距離および方向の検出精
度が高く、多方向に対応できるので大きなカーブであっ
ても利用することができる。

【００３２】請求項９記載の目標先行車検出装置によれ
ば、上述した効果を有する車両用カーブ径推定装置を利
用しているので、先行車の認識精度が著しく高くなる。

【００３３】

【発明の実施の形態】以下、本発明の実施形態を図面に
基づいて説明する。第１実施形態 図１は本発明の車両用カーブ径推定装置の実施形態を示
すブロック図であり、本実施形態の車両用カーブ径推定
装置は、距離方向検出手段１と対象車両判別手段２とカ
ーブ径推定手段３とを備えている。

【００３４】本実施形態に係る距離方向検出手段１は、
自車両の例えば前面に取り付けられ、当該自車両から先
行車両までの距離Ｌと方向θとを検出するセンサであ
る。この距離方向検出手段１は、具体的には図５もしく
は図６に示すスキャニングレーダ装置または図７もしく
は図８に示すマルチレーダ装置により構成することがで
きる。

【００３５】図５は本発明に係る距離方向検出手段１の
実施形態を示す断面図であり、このスキャニングレーダ
装置１は、回転可能に設けられた送信素子１１を有し、
ここからスキャニング式の１本の光ビームまたは電波が
送信される。この光ビームまたは電波は、送信レンズ１
２（電波の場合はアンテナ）を介して出力され、目標物
体で反射したのち、その反射光ビームまたは反射電波
が、受信レンズ１３（電波の場合はアンテナ）を介し
て、受信素子１４に入力される。受信素子１４は位置固
定に設けられているが、送信素子１１が回転可能に設け
られて光ビームまたは電波を走査しながら出力するの
で、多方向の距離計測が可能となる。

【００３６】図６は同じく距離方向検出手段１の他の実
施形態を示す断面図であり、この距離方向検出手段１も
スキャニング方式のレーダ装置である。このスキャニン
グレーダ装置１は、位置固定に設けられた送信素子１１
を有し、ここから１本の光ビームまたは電波が送信され
る。この光ビームまたは電波は、送信レンズ１２（電波
の場合はアンテナ）を介して出力され、目標物体で反射
したのち、その反射ビームまたは反射電波が、受信レン
ズ１３（電波の場合はアンテナ）を介して、移動可能に
設けられた受信素子１４に入力される。送信素子１１は
位置固定に設けられているものの、受信素子１４が移動
可能に設けられているので、光ビームまたは電波を多方
向から受信することができ、このスキャニングレーダ装
置１にあっても多方向の距離計測が可能となる。

【００３７】本発明の距離方向検出手段１は、上述した
スキャニング方式のレーダ装置以外にも、例えばマルチ
方式のレーダ装置を用いることができる。図７は距離方
向検出手段１のさらに他の実施形態を示す断面図であ
り、複数の発光素子１１を有している。この発光素子１
１からは、ｎ本の光ビームまたは電波が発生し、このｎ
本の光ビームまたは電波は、発光レンズ１２（電波の場
合はアンテナ）を介して出力され、目標物体で反射した
のち、その反射ビームまたは反射電波が、受光レンズ１
３（電波の場合はアンテナ）を介して、一つの受光素子
１４に入力される。受光素子１４は一つであるが、発光
素子１１がｎ本の光ビームを発するので、ｎ方向の距離
計測が可能となる。

【００３８】図８は同じくマルチレーダ装置１の他の実
施形態を示す断面図であり、発光素子１１から１本の光
ビームまたは電波が発っせられる。この光ビームまたは
電波は、目標物体で反射したのち、その反射ビームまた
は反射電波が、発光レンズ１２（電波の場合はアンテ
ナ）を介して受光レンズ１４（電波の場合はアンテナ）
に入力される。この受光素子１４は、光ビームまたは電
波をｎ方向から受信することができるので、ｎ方向の距
離計測が可能となる。

【００３９】本実施形態に係る対象車両判別手段２は、
上述した距離方向検出手段１により検出された距離Ｌお
よび方向θに基づいて、その先行車両が自車線上を走行
する先行車両か、あるいはその先行車両が他車線上を走
行する先行車両かを判別するものであり、具体的にはセ
ンサとマイクロコンピュータなどで構成することができ
る。

【００４０】図１に示すように、この対象車両判別手段
２は、機能的には、ステアリング角度検出手段２１、時
間計測手段２２、車速検出手段２３、自車両走行経路検
出手段２４、先行車両走行経路検出手段２５および先行
車両判別手段２６から構成されている。

【００４１】ステアリング角度検出手段２１は、例えば
エンコーダであり、自車両のハンドル切り角φを検出す
る。このステアリング角度検出手段２１からの出力信号
φは、後述する自車両走行経路検出手段２４と、先行車
両走行経路検出手段２５とのそれぞれに送出される。

【００４２】時間計測手段２２は、自車両の走行時間ｔ
を計測する例えばクロック発信器などのタイマであり、
ここからの出力信号ｔは、自車両走行経路検出手段２４
と、先行車両走行経路検出手段２５とのそれぞれに送出
される。

【００４３】車速検出手段２３は、自車両の車速Ｖを検
出するためのセンサであり、例えば車輪速センサなどが
用いられ、この出力信号Ｖは、自車両走行経路検出手段
２４と、先行車両走行経路検出手段２５とのそれぞれに
送出される。

【００４４】自車両走行経路検出手段２４は、ステアリ
ング角度検出手段２１、時間計測手段２２および車速検
出手段２３でそれぞれ検出されたステアリング角度φ、
走行時間ｔおよび車速Ｖに基づいて、自車両の走行経路
を時間の関数（Ｘ（ｔ），Ｙ（ｔ））として検出する。

【００４５】この自車両走行経路検出手段２４における
自車両の走行経路の求め方を、図９を参照しながら説明
する。同図（Ａ）に示すように、ある時間ｔ＝０におけ
る自車両の位置を原点（０，０）として、それからｔ時
間後の自車両の走行経路をＸ−Ｙ座標系で時間の関数と
して（Ｘｍ（ｔ），Ｙｍ（ｔ））と表す。この自車両の
走行経路は、ステアリング角度φ、走行時間ｔ、車速Ｖ
から演算して求めることができる。

【００４６】すなわち、まず同図（Ｂ）のように、自車
両の進む方向ψと速度Ｖをベクトルで表わすと、自車両
の進む方向ψは、ステアリング角度φと車速Ｖから下記
（１）式で求められ、当該（１）式の曲率半径Ｒは下記
（２）式で求められる。

【００４７】

【数１】 ψ＝（１／Ｒ）・∫Ｖｄｔ …（１） Ｒ＝（１＋ＡＶ² ）・（Ｎ・Ｌ／φ） …（２） （１）式および（２）式において、Ｒは曲率半径、Ａは
スタビリティファクタ、Ｎはオーバオールステアリング
レシオ、Ｌはホイールベースである。（２）式におい
て、Ａ，Ｎ，Ｌの各値は既知であり、またＶは車速検出
手段２３からの出力信号、φはステアリング角度検出手
段２１からの出力信号、時間ｔは時間計測手段２２から
の出力信号によりそれぞれ求められるので、曲率半径Ｒ
が求められ、これを（１）式に代入することにより、自
車両の進む方向ψが求められる。

【００４８】よって、自車両の走行経路（Ｘｍ（ｔ），
Ｙｍ（ｔ））は、上記（１）式で求められたψを下記
（３）式および（４）式に代入することにより求められ
る。

【数２】 Ｘｍ（ｔ）＝∫Ｖ・ｃｏｓψｄｔ …（３） Ｙｍ（ｔ）＝∫Ｖ・ｓｉｎψｄｔ …（４）

【００４９】先行車両走行経路検出手段２５は、ステア
リング角度検出手段２１、時間計測手段２２、車速検出
手段２３および距離方向検出手段１でそれぞれ検出され
たステアリング角度φ、時間ｔ、車速Ｖおよび距離Ｌと
方向θに基づいて、先行車両の走行経路を時間の関数
（Ｘｆ（ｔ），Ｙｆ（ｔ））として検出する。

【００５０】この先行車両走行経路検出手段２５におけ
る先行車両の走行経路の求め方を図１０を参照しながら
説明する。同図に示すように、先行車両の走行経路は、
自車両との相対位置関係で求めることとし、先行車両の
走行経路をＸ−Ｙ座標系で時間ｔの関数として（Ｘｆ
（ｔ），Ｙｆ（ｔ））と表す。自車両の走行経路は上述
した（３）および（４）式で求められるので、自車両を
基準とした先行車両の走行経路は、自車両と先行車両と
の距離Ｌおよび方向θ、ステアリング角度φ、走行時間
ｔ、車速Ｖから演算して求めることができる。

【００５１】つまり、下記（５）式および（６）式で求
めることができる。

【数３】 Ｘｆ（ｔ）＝∫Ｖ・ｃｏｓψｄｔ＋Ｌｓｉｎθ …（５） Ｙｆ（ｔ）＝∫Ｖ・ｓｉｎψｄｔ＋Ｌｃｏｓθ …（６） この（５）および（６）式において、それぞれの第１項
は自車両の走行経路座標であるから、上述した（３）お
よび（４）式と同様に、既知の定数と、ステアリング角
度検出手段２１、時間計測手段２２、車速検出手段２３
からの入力信号により演算することができる。また、
（５）および（６）式の第２項は距離方向検出手段１で
検出される距離Ｌおよび方向θを用いて演算することが
できる。

【００５２】先行車両判別手段２６は、自車両走行経路
検出手段２４および先行車両走行経路検出手段２５でそ
れぞれ検出された自車両の走行経路および先行車両の走
行経路に基づいて、その先行車両が自車線上を走行する
先行車両であるかどうかを判別する。

【００５３】この判別は、具体的には、現在の自車両の
位置と、先行車両との車間時間Ｔｆ前の当該先行車両の
位置との差Ｌｗを求め、これが道路幅Ｗより小さいかど
うかで判断する。つまり、先行車両のＴｆ時間前の走行
位置が現在の自車両の走行位置に対して道路幅方向にど
れだけずれているかで、当該先行車両が自車線上を走行
する車両であるかどうかを判別する。

【００５４】ここで、先行車両までの車間時間Ｔｆは、
現在の自車両と先行車両との距離Ｌと、自車両の車速Ｖ
を用いて、下記（７）式で求められる。

【数４】 Ｔｆ＝Ｌ／Ｖ …（７）

【００５５】また、現在の自車両の位置（Ｘｍ（ｔ），
Ｙｍ（ｔ））と、記憶させておいた先行車両までの車間
時間Ｔｆ前の当該先行車両の位置（Ｘｆ（ｔ−Ｔｆ），
Ｙｆ（ｔ−Ｔｆ））との差Ｌｗは、下記（８）式で求
め、（９）式により道路幅Ｗより小さいかどうかを判別
する。ＬｗがＷより小さい場合には、その先行車両が自
車線上に存在すると判断し、カーブ径を演算する際の先
行車両の候補となる。

【数５】 Ｌｗ（ｔ）＝√｛（Ｘｍ（ｔ）−Ｘｆ（ｔ−Ｔｆ））² ＋（Ｙｍ（ｔ）−Ｙｆ（ｔ−Ｔｆ））²｝ …（８） Ｌｗ＜Ｗ …（９）

【００５６】カーブ径推定手段３は、先行車両判別手段
２６で自車線上を走行する先行車両と判別された先行車
両と、自車両との距離および方向に基づいて、カーブ径
を推定するものである。

【００５７】このカーブ径の推定方法を図１１および図
１２を参照しながら説明する。図１１は、先行車、先々
行車１、先々行車２、すなわち３台の先行車両を距離方
向検出手段１で捕捉した場面を示している。また、図１
２（Ａ）では、この３台の先行車を検出した場合の道路
曲率Ｒの求め方を模式的に示す。

【００５８】先行車が角度θ１、距離Ｌ１、先々行車１
が角度θ２、距離Ｌ２、先々行車２が角度θ３、距離Ｌ
３で捕らえられたとする。このとき、自車両の位置を原
点として、Ｘ−Ｙ座標系で先行車（Ｘ１，Ｙ１）、先々
行車１（Ｘ２，Ｙ２）、先々行車２（Ｘ３，Ｙ３）の座
標位置を表わすと、

【数６】 Ｘ１＝Ｌ１ｓｉｎθ１ …（１０） Ｙ１＝Ｌ１ｃｏｓθ１ …（１１） Ｘ２＝Ｌ２ｓｉｎθ２ …（１２） Ｙ２＝Ｌ２ｃｏｓθ２ …（１３） Ｘ３＝Ｌ３ｓｉｎθ３ …（１４） Ｙ３＝Ｌ３ｃｏｓθ３ …（１５） となる。

【００５９】円の方程式は、図１２（Ｂ）に示すよう
に、カーブ曲率をＲ、円の中心座標を（ａ，ｂ）とする
と、

【数７】 （Ｘ−ａ）² ＋（Ｙ−ｂ）² ＝Ｒ² …（１６） となる。したがって、この方程式（１６）に、上記（１
０）〜（１５）の３台の先行車両の座標を代入して、そ
の連立方程式を解けば道路曲率Ｒが求まる。

【００６０】図１１および図１２に示すカーブ径の推定
方法では、３点が決まるとその曲率Ｒが定まるという円
の性質を利用して、３台の先行車両の走行位置からカー
ブ径Ｒを求めたが、本発明では２台の先行車両と自車両
との走行位置を用いて、カーブ径を推定することもでき
る。

【００６１】図１３は、先行車、先々行車１、すなわち
２台の先行車両を距離方向検出手段で捕捉した場面を示
している。また、図１４は、２台の先行車と自車両とを
用いて道路曲率Ｒを求める方法を模式的に示している。

【００６２】図１３および図１４に示すように、先行車
が角度θ１、距離Ｌ１、先々行車１が角度θ２、距離Ｌ
２で捕らえられたとする。自車の位置を原点（０，０）
として、Ｘ−Ｙ座標系で先行車（Ｘ１，Ｙ１）、先々行
車１（Ｘ２，Ｙ２）の位置を表わすと、上述した（１
０）式から（１３）式となる。そして、上記（１６）式
に自車両の座標（０，０）と、先行車の座標（Ｘ１，Ｙ
１）および先行車１の座標（Ｘ２，Ｙ２）を代入して、
その連立方程式を解けば道路曲率Ｒが求まる。

【００６３】このように、先行車両が２台であった場合
でも、前方のカーブ径を推定することができる。ただ
し、この方法では自車両も曲率半径Ｒの円上にあるの
で、前方のカーブ径を精度良く推定するには、上記図１
１および図１２に示されるように、３台の先行車両を用
いることがより好ましい。

【００６４】これら自車両走行経路検出手段２４、先行
車両走行経路検出手段２５、先行車両判別手段２６およ
びカーブ径推定手段３は、マイクロコンピュータのソフ
トウェアにより構成されている。

【００６５】次に作用を説明する。図１５は、本実施形
態における主動作を示すフローチャートであり、まずス
テップ１において、距離方向検出手段１により、自車両
から先行車両までの距離Ｌと方向θを測定し、先行車両
走行経路検出手段２５に送出する。これと同時に、対象
車両判別手段２において、ステアリング角度検出手段２
１によりステアリング角度φを、時間計測手段２２によ
り走行時間ｔを、車速検出手段２３により自車両の車速
Ｖをそれぞれ検出し、自車両走行経路検出手段２４およ
び先行車両走行経路検出手段２５に送出する。

【００６６】自車両走行経路検出手段２４では、ステア
リング角度φ、走行時間ｔ、車速Ｖから自車両走行経路
（Ｘ（ｔ），Ｙ（ｔ））を上述した（１）〜（４）式を
用いて演算して求める。先行車両走行経路検出手段２５
では、距離Ｌ、方向θ、ステアリング角度φ、走行時間
ｔ、車速Ｖから、捕捉された先行車両の走行経路（Ｘｆ
（ｔ），Ｙｆ（ｔ））を上述した（１）〜（６）式を用
いて演算して求める。

【００６７】自車線上の先行車両判別手段２６では、上
述した（７）〜（９）式を用いて、自車両の走行経路と
先行車両の走行経路とを比較し、その先行車両が自車線
上に存在するか否かを判別する。以上の判別は、ステッ
プ２〜４に示すように、捕捉された先行車両全てに対し
て行われ、自車線上に存在する先行車両のみを選択し、
カーブ径の推定に用いる。ステップ２〜４において、自
車両または先行車両が車線変更するなど、その先行車両
が自車線上に存在しない場合には、その先行車両のデー
タはカーブ径の推定には用いない。

【００６８】カーブ径推定手段３では、自車線上の３台
以上あるいは２台以上の先行車両のデータを用いて、ス
テップ５にて、上述した（１０）〜（１６）式により、
前方のカーブ径を推定する。

【００６９】このように、本実施形態のカーブ径推定装
置は、自車両から自車線上を走行する２台以上の先行車
両までの距離と方向とを用いて、前方のカーブ径を推定
するように構成されているので、リフレクタのないカー
ブ路においても、前方のカーブ路を認識することができ
る。

【００７０】本実施形態のカーブ径推定装置は車間距離
警報装置や車間距離制御装置に利用することができ、こ
の場合、先行車の認識精度が著しく高くなる。また、カ
ーブの存在を精度良く認識できるので、車間距離警報装
置の誤警報を防止することができる。本実施形態のカー
ブ径推定装置は、車速の制御装置にも利用することがで
き、この場合、カーブの入口での減速制御が可能とな
る。さらに、本実施形態のカーブ径推定装置は、車速の
警報装置にも利用することができ、カーブ入口での速度
過剰状態を検知して、警報を発することができる。

【００７１】第２実施形態 上述した第１実施形態では、カーブ径推定手段３におけ
るカーブ径の推定方法が、３台の先行車両または２台の
先行車両と自車両を用いたものであるが、本実施形態で
は１台の先行車両を選定し、その先行車両の走行経路か
らカーブ径を推定する方法である。したがって、カーブ
径推定手段３のソフトウェア構成のみが第１実施形態と
相違している。

【００７２】カーブ径推定装置の基本構成は、図１に示
す第１実施形態と同じであり、その詳細な説明は省略す
るが、距離方向検出手段１として、図５および図６に示
すスキャニングレーダ装置や図７および図８に示すマル
チレーダ装置を用いることができる。

【００７３】本実施形態のカーブ径推定手段３は、自車
線上を走行する先行車両の走行経路（Ｘｆ（ｔ），Ｙｆ
（ｔ））から前方のカーブ径を推定するものである。具
体的には、自車線上を走行する先行車両の走行経路の時
間関数（Ｘｆ（ｔ），Ｙｆ（ｔ））から、所定の時間間
隔でその座標位置を３点抽出する。これは、図１０と上
記（５）および（６）式を用いて求める。これにより求
められた座標位置３点を上記（１６）式に代入して連立
方程式を解くことにより、道路曲率Ｒを求める。

【００７４】なお、本実施形態では、先行車より先々行
車１、また先々行車１より先々行車２の走行経路を用い
る方が、より前方のカーブ径の推定が精度良く行われる
ので、複数先行車両を捕捉した場合には、最も先行する
車両の走行経路をカーブ径の推定に用いるようにしてい
る。

【００７５】次に作用を説明する。図１６は本実施形態
の動作を示すフローチャートであり、まずステップ１１
において、距離方向検出手段１により、自車両から先行
車両までの距離Ｌと方向θを測定し、先行車両走行経路
検出手段２５に送出する。これと同時に、対象車両判別
手段２において、ステアリング角度検出手段２１により
ステアリング角度φを、時間計測手段２２により走行時
間ｔを、車速検出手段２３により自車両の車速Ｖをそれ
ぞれ検出し、自車両走行経路検出手段２４および先行車
両走行経路検出手段２５に送出する。

【００７６】自車両走行経路検出手段２４では、ステア
リング角度φ、走行時間ｔ、車速Ｖから自車両走行経路
（Ｘ（ｔ），Ｙ（ｔ））を上述した（１）〜（４）式を
用いて演算して求める。先行車両走行経路検出手段２５
では、距離Ｌ、方向θ、ステアリング角度φ、走行時間
ｔ、車速Ｖから、捕捉された先行車両の走行経路（Ｘｆ
（ｔ），Ｙｆ（ｔ））を上述した（１）〜（６）式を用
いて演算して求める。

【００７７】自車線上の先行車両判別手段２６では、上
述した（７）〜（９）式を用いて、自車両の走行経路と
先行車両の走行経路とを比較し、その先行車両が自車線
上に存在するか否かを判別する。以上の判別は、ステッ
プ１２，１３，１５に示すように、捕捉された先行車両
全てに対して行われ、自車線上に存在する先行車両のみ
を選択し、カーブ径の推定に用いる。ステップ１２，１
３，１５において、自車両または先行車両が車線変更す
るなど、その先行車両が自車線上に存在しない場合に
は、その先行車両のデータはカーブ径の推定には用いな
い。

【００７８】カーブ径推定手段３では、自車線上の先行
車両の走行経路のデータを用いて、ステップ１７にて、
前方のカーブ径を推定するが、ステップ１２，１３，１
５に示されるように、３台の先行車両が全て自車線上に
ある場合には、最も先行する先々行車２の走行経路が用
いられる。また、この先々行車２が車線変更等により自
車線上に存在しない場合には、次に最も先行する先々行
車１の走行経路を用いてカーブ径を推定する（ステップ
１６）。同様に、この先々行車１も車線変更等により自
車線上に存在しない場合には、先行車の走行経路を用い
てカーブ径を推定する（ステップ１４）。

【００７９】このように、本実施形態のカーブ径推定装
置は、自車両から自車線上を走行する先行車両の走行経
路（Ｘｆ（ｔ），Ｙｆ（ｔ））を用いて、前方のカーブ
径Ｒを推定するように構成されているので、第１実施形
態と同様、リフレクタのないカーブ路においても、前方
のカーブ路を認識することができる。特に、本実施形態
によれば、先行車が２台以上存在しなくても、前方のカ
ーブ路を認識することができる。

【００８０】第３実施形態 本実施形態は、上述した第１実施形態または第２実施形
態のカーブ径推定装置を用いて、そのカーブ径の推定値
と先行車両の走行経路から自車線上の先行車両を選定す
る目標先行車検出装置である。

【００８１】本実施形態の目標先行車検出装置は、図２
に示すように、第１実施形態のカーブ径推定装置に先行
車選定手段４を付加したものであり、マイクロコンピュ
ータのソフトウェアで構成されている。距離方向検出手
段１、対象車両判別手段２およびカーブ径推定手段３
は、第１実施形態または第２実施形態と同じであるた
め、その説明は省略する。

【００８２】本実施形態の先行車選定手段４は、カーブ
径推定手段３により求められたカーブ径Ｒの推定値を取
り込み、このカーブ径に基づいて先行車を選定する信号
を外部に出力する。カーブ径の推定方法は、第１実施形
態に示す自車線上の２台以上の先行車両の座標を用いる
方法、あるいは第２実施形態に示す自車線上の走行車両
の走行経路を用いる方法の何れでも良い。

【００８３】このカーブ径Ｒを用いて、先行車選定手段
４は、例えば（１７）式によりカーブ径Ｒに応じたビー
ム角度θを演算し、光ビームの照射角度を変更するなど
して、先行車を検出する（ステップ６）。

【数８】θ＝Ｃ／Ｒ （Ｃ：定数） …（１７）

【００８４】本実施形態の目標先行車検出装置は、カー
ブ径の推定値を用いて目標とする先行車を検出するの
で、先行車の認識精度が向上することになる。

【００８５】第４実施形態 上述した第１実施形態および第２実施形態のカーブ径推
定装置、および第３実施形態の目標先行車検出装置は、
ステアリング角度φと走行時間ｔと車速Ｖとにより自車
両および先行車両の走行経路を求めたが、本実施形態で
は、自車両の左右の車輪速を用いて、自車両および先行
車両の走行経路を求める。

【００８６】すなわち、図３に示すように、対象車両判
別手段２には、上述した実施形態におけるステアリング
角度検出手段２１、時間計測手段２２および車速検出手
段２３の代わりに、左右車輪速検出手段２７が設けられ
ており、具体的には左右の車輪にそれぞれ設けられた車
輪速センサで構成されている。この左右車輪速検出手段
２７により、左輪速度Ｖｌと右輪速度Ｖｒとが検出さ
れ、自車両走行経路検出手段２４および先行車両走行経
路検出手段２５のそれぞれに送出される。

【００８７】そして、自車両走行経路検出手段２４で
は、左輪速度Ｖｌと右輪速度Ｖｒとを用いて、下記（１
８）式により平均車速Ｖを求める。

【数９】Ｖ＝（Ｖｌ＋Ｖｒ）／２ …（１８）

【００８８】また、（２）式に代えて下記（１９）式に
より道路曲率Ｒを求める。

【数１０】 Ｒ＝Ｖ・Ｔｔ／（Ｖｌ−Ｖｒ） …（１９） ただし、Ｔｔはトレッドである。

【００８９】（１８）式により車速Ｖ、（１９）式によ
り道路曲率Ｒが求められるので、これらを上記（１）式
に代入して自車両の進行方向ψを求め、このψを上記
（３）および（４）式に代入することにより、自車両の
走行経路（Ｘ（ｔ），Ｙ（ｔ））を求める。

【００９０】一方、先行車両走行経路検出手段２５にお
いては、左右車輪速検出手段２７からの左輪速度Ｖｌと
右輪速度Ｖｒとを用いて、上述した手順で車速Ｖと自車
両の進行方向ψを求め、距離方向検出手段１からの距離
Ｌおよび方向θとともに上記（５）および（６）式に代
入することにより、先行車両の走行経路（Ｘｆ（ｔ），
Ｙｆ（ｔ））を求める。

【００９１】以下の手順は第１実施形態と同様であるの
でその説明は省略するが、本実施形態によれば、左右の
車輪速センサから自車両および先行車両の走行経路を検
出する構成としたため、道路の傾きや、ステアリングの
遊びの影響が少なくなり、道路曲率Ｒの検出精度が向上
することになる。

【００９２】第５実施形態 本発明のカーブ径推定装置および目標先行車検出装置
は、さらに改変することができる。本実施形態では、第
１〜３実施形態のステアリング角度検出手段２１、時間
計測手段２２および車速検出手段２３、第４実施形態の
左右車輪速検出手段２７の代わりに、ヨーレイト検出手
段２８および車速検出手段２３が設けられており、ヨー
レイト検出手段２８は具体的にはヨーレイトセンサで構
成されている。なお、ヨーレイト（ｙａｗ ｒａｔｅ）
とは車両のｚ軸廻りの揺動レイトをいう。

【００９３】このヨーレイト検出手段２８で検出された
自車両のヨーレイトは、車速検出手段２３で検出された
自車両の車速Ｖとともに、自車両走行経路検出手段２４
および先行車両検出手段２５のそれぞれに送出される。

【００９４】そして、自車両走行経路検出手段２４で
は、上記（２）式に代えて、ヨーレイトηおよび車速Ｖ
を用いて、道路曲率Ｒを下記（２０）式より求める。

【数１１】Ｒ＝Ｖ／η （２０）

【００９５】この（２０）式により道路曲率Ｒが求めら
れるので、これらを上記（１）式に代入して自車両の進
行方向ψを求め、このψを上記（３）および（４）式に
代入することにより、自車両の走行経路（Ｘ（ｔ），Ｙ
（ｔ））を求める。

【００９６】一方、先行車両走行経路検出手段２５にお
いては、ヨーレイト検出手段２８からのヨーレイトηと
車速Ｖとを用いて、上述した手順で自車両の進行方向ψ
を求め、距離方向検出手段１からの距離Ｌおよび方向θ
とともに上記（５）および（６）式に代入することによ
り、先行車両の走行経路（Ｘｆ（ｔ），Ｙｆ（ｔ））を
求める。

【００９７】以下の手順は第１実施形態と同様であるの
でその説明は省略するが、本実施形態によれば、ヨーレ
イトセンサから走行経路を検出する構成としたため、タ
イヤの摩耗の影響がなくなり、道路曲率Ｒの検出精度が
向上することになる。

【００９８】なお、以上説明した各実施形態は、本発明
の理解を容易にするために記載されたものであって、本
発明を限定するために記載されたものではない。したが
って、上記の実施形態に開示された各要素は、本発明の
技術的範囲に属する全ての設計変更や均等物をも含む趣
旨である。

【図面の簡単な説明】

【図１】本発明の第１および第２実施形態（車両用カー
ブ径推定装置）を示すブロック図である。

【図２】本発明の第３実施形態（目標先行車検出装置）
を示すブロック図である。

【図３】本発明の第４実施形態（目標先行車検出装置）
を示すブロック図である。

【図４】本発明の第５実施形態（目標先行車検出装置）
を示すブロック図である。

【図５】本発明に係る距離方向検出手段の実施形態（ス
キャニングレーダ装置）を示す断面図である。

【図６】本発明に係る距離方向検出手段の他の実施形態
（スキャニングレーダ装置）を示す断面図である。

【図７】本発明に係る距離方向検出手段の他の実施形態
（マルチレーダ装置）を示す断面図である。

【図８】本発明に係る距離方向検出手段の他の実施形態
（マルチレーダ装置）を示す断面図である。

【図９】本発明に係る自車両走行経路検出手段における
自車両の走行経路の求め方を説明するための模式図であ
る。

【図１０】本発明に係る先行車両走行経路検出手段にお
ける先行車両の走行経路の求め方を説明するための模式
図である。

【図１１】本発明に係るカーブ径推定手段におけるカー
ブ径の求め方を説明するための模式図である。

【図１２】本発明に係るカーブ径推定手段におけるカー
ブ径の求め方を説明するための模式図である。

【図１３】本発明に係るカーブ径推定手段におけるカー
ブ径の他の求め方を説明するための模式図である。

【図１４】本発明に係るカーブ径推定手段におけるカー
ブ径の他の求め方を説明するための模式図である。

【図１５】本発明に係るカーブ径推定手段におけるカー
ブ径の求め方（第１実施形態）を説明するためのフロー
チャートである。

【図１６】本発明に係るカーブ径推定手段におけるカー
ブ径の他の求め方（第２実施形態）を説明するためのフ
ローチャートである。

【図１７】図２に示す目標先行車検出装置における先行
車の検出手順を示すフローチャートである。

【図１８】従来の車両用カーブ径推定装置の問題点を説
明するための模式図である。

【符号の説明】

１…距離方向検出手段 １１…送信素子 １２…送信レンズ １３…受信レンズ １４…受信素子 ２…対象車両判別手段 ２１…ステアリング角度検出手段 ２２…時間計測手段 ２３…車速検出手段 ２４…自車両走行経路検出手段 ２５…先行車両走行経路検出手段 ２６…先行車両判別手段 ２７…左右車輪速検出手段 ２８…ヨーレイト検出手段 ３…カーブ径推定手段 ４…先行車選定手段

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.⁶ 識別記号 庁内整理番号 ＦＩ 技術表示箇所 Ｇ０８Ｇ 1/16 Ｇ０１Ｓ 17/88

Claims (9)

【特許請求の範囲】
1. 【請求項１】自車両から先行車両までの距離と方向とを
   検出する距離方向検出手段と、 自車両の走行経路と前記距離方向検出手段で検出された
   距離および方向とに基づいて、前記先行車両が自車線上
   を走行する先行車両か他車線上を走行する先行車両かを
   判別する対象車両判別手段と、 前記対象車両判別手段で自車線上を走行する先行車両と
   判別された先行車両と自車両との距離および方向に基づ
   いて、カーブ径を推定するカーブ径推定手段とを備えた
   ことを特徴とする車両用カーブ径推定装置。
2. 【請求項２】前記カーブ径推定手段は、自車線上を走行
   する２台以上の先行車両と自車両との距離および方向に
   基づいて、カーブ径を推定することを特徴とする請求項
   １記載の車両用カーブ径推定装置。
3. 【請求項３】前記カーブ径推定手段は、自車線上を走行
   する先行車両の走行経路に基づいて、カーブ径を推定す
   ることを特徴とする請求項１記載の車両用カーブ径推定
   装置。
4. 【請求項４】前記対象車両判別手段は、 前記自車両のステアリング角度を検出するステアリング
   角度検出手段と、 走行時間を計測する時間計測手段と、 前記自車両の車速を検出する車速検出手段と、 前記ステアリング角度検出手段、前記時間計測手段およ
   び前記車速検出手段でそれぞれ検出されたステアリング
   角度、走行時間および車速に基づいて、前記自車両の走
   行経路を検出する自車両走行経路検出手段と、 前記ステアリング角度検出手段、前記時間計測手段、前
   記車速検出手段および前記距離方向検出手段でそれぞれ
   検出されたステアリング角度、走行時間、車速および前
   記先行車両までの距離と方向に基づいて、前記先行車両
   の走行経路を検出する先行車両走行経路検出手段と、 前記自車両走行経路検出手段および前記先行車両走行経
   路検出手段でそれぞれ検出された前記自車両の走行経路
   および前記先行車両の走行経路に基づいて、自車線上を
   走行する先行車両を特定する先行車両判別手段とを有す
   ることを特徴とする請求項１乃至３何れかに記載の車両
   用カーブ径推定装置。
5. 【請求項５】前記対象車両判別手段は、 前記自車両の左右の車輪速を検出する左右車輪速検出手
   段と、 走行時間を計測する時間計測手段と、 前記左右車輪速検出手段および前記時間計測手段でそれ
   ぞれ検出された自車両の左右の車輪速の差および走行時
   間に基づいて、前記自車両の走行経路を検出する自車両
   走行経路検出手段と、 前記左右車輪速検出手段、前記時間計測手段および前記
   距離方向検出手段でそれぞれ検出された前記自車両の左
   右の車輪速の差、走行時間および前記先行車両までの距
   離と方向とに基づいて、前記先行車両の走行経路を検出
   する先行車両検出手段と、 前記自車両走行経路検出手段および前記先行車両走行経
   路検出手段でそれぞれ検出された前記自車両の走行経路
   および前記先行車両の走行経路に基づいて、自車線上を
   走行する先行車両を特定する先行車両判別手段とを有す
   ることを特徴とする請求項１乃至３何れかに記載の車両
   用カーブ径推定装置。
6. 【請求項６】前記対象車両判別手段は、 前記自車両のヨーレイトを検出するヨーレイト検出手段
   と、 走行時間を計測する時間計測手段と、 前記自車両の車速を検出する車速検出手段と、 前記ヨーレイト検出手段、前記時間計測手段および前記
   車速検出手段でそれぞれ検出された自車両のヨーレイ
   ト、走行時間および自車両の車速に基づいて、前記自車
   両の走行経路を検出する自車両走行経路検出手段と、 前記ヨーレイト検出手段、前記時間計測手段、前記車速
   検出手段および前記距離方向検出手段でそれぞれ検出さ
   れた自車両のヨーレイト、走行時間、自車両の車速およ
   び前記先行車両までの距離と方向に基づいて、前記先行
   車両の走行経路を検出する先行車両走行経路検出手段
   と、 前記自車両走行経路検出手段および前記先行車両走行経
   路検出手段でそれぞれ検出された前記自車両の走行経路
   および前記先行車両の走行経路に基づいて、自車線上を
   走行する先行車両を特定する先行車両判別手段とを有す
   ることを特徴とする請求項１乃至３何れかに記載の車両
   用カーブ径推定装置。
7. 【請求項７】前記距離方向検出手段が、光ビームまたは
   電波を走査させるスキャニングレーダ装置であることを
   特徴とする請求項１乃至６の何れかに記載の車両用カー
   ブ径推定装置。
8. 【請求項８】前記距離方向検出手段が、複数の光ビーム
   または電波を発するマルチレーダ装置であることを特徴
   とする請求項１乃至６の何れかに記載の車両用カーブ径
   推定装置。
9. 【請求項９】請求項１乃至８の何れかに記載の車両用カ
   ーブ径推定装置と、 前記車両用カーブ径推定装置の前記カーブ径推定手段で
   求められたカーブ径推定値に基づいて、自車線上を走行
   する先行車を選定する先行車選定手段とを備えたことを
   特徴とする目標先行車検出装置。