JP3653862B2 - Vehicle curve diameter estimation device and target preceding vehicle detection device - Google Patents
Vehicle curve diameter estimation device and target preceding vehicle detection device Download PDFInfo
- Publication number
- JP3653862B2 JP3653862B2 JP12409496A JP12409496A JP3653862B2 JP 3653862 B2 JP3653862 B2 JP 3653862B2 JP 12409496 A JP12409496 A JP 12409496A JP 12409496 A JP12409496 A JP 12409496A JP 3653862 B2 JP3653862 B2 JP 3653862B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- preceding vehicle
- detecting
- curve diameter
- traveling
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Controls For Constant Speed Travelling (AREA)
- Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
- Traffic Control Systems (AREA)
- Radar Systems Or Details Thereof (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は、自車両がカーブへ進入する前にそのカーブ径を推定する車両用カーブ径推定装置、および自車線上を走行する目標先行車を検出する目標先行車検出装置に関する。
【０００２】
【従来の技術】
従来より、車両用カーブ径推定装置または目標先行車検出装置として、例えば特開平５−８７，９２２号公報に記載された障害物検出装置が知られている。この障害物検出装置は、目標対象物が移動した場合でも、複数のレーザビームのうちの幾つかのレーザビームが常に目標対象物を検知し続けることができるように、レーダの主軸方向を目標対象物に追従可能にしたものである。
【０００３】
また、特開平４−３６９，８００号公報に記載された車両用カーブ径推定装置は、カーブ路に設置されているリフレクタ（反射器）間の距離を検出することによりカーブ径を推定するものであり、自車両の車速と、自車両からリフレクタまでの距離とによって、リフレクタ間の距離が演算される。そして、高速道路等においては、カーブ径に応じてリフレクタの間隔を変えているので、これを利用してカーブへ進入する前に、そのカーブ径を推定することができる。
【０００４】
【発明が解決しようとする課題】
しかしながら、このような従来の車両用カーブ径推定装置または目標先行車検出装置にあっては、以下の問題があった。
すなわち、レーダの主軸方向を先行車に追従させる技術では、図１８（Ａ）に示すようなカーブの入口などでは、先行車の移動が比較的緩やかに行われるので先行車を追従することはできるものの、同図（Ｂ）に示すように先行車が突然に車線変更を行ったときなどレーダの主軸制御が間に合わない場合には目標先行車の検出ができないという問題があった。このため、自車両のステアリング角度や左右の車輪速差から自車線のカーブ径を推定し、これによりレーダの主軸方向を変えることも考えられるが、このようにすると先行車の車線変更は検出できるものの、カーブ入口において、先行車が自車線上を走行している場合も車線変更したと誤認識するおそれがある。
【０００５】
一方、リフレクタを利用して道路形状を認識する技術には、先行車や他車線走行車が邪魔になってリフレクタを検出できなかったり、一般道などリフレクタの少ない道路では使用できないという問題があった。また、この技術には、看板や停止車両など路側にリフレクタに類似したものがある場合には、道路形状を誤認識してしまうおそれもあった。
【０００６】
また、カメラを用いて前方のカーブ径を検出することも有効な技術ではあるが、逆光や夜間において認識できない場合があり、レーダで道路形状を認識することが必要となる。
【０００７】
本発明は、このような従来技術の問題点に鑑みてなされたものであり、先行車とその前方を走行する先々行車までの車間距離と方向から、前方カーブ径を推定し、カーブの入口や出口で目標先行車の検出を精度良く実行できる車両用カーブ径推定装置および目標先行車検出装置を提供することを目的とする。
【０００８】
【課題を解決するための手段】
上記目的を達成するために、請求項１記載の本発明の車両用カーブ径推定装置は、自車両から先行車両までの距離と方向とを検出する距離方向検出手段と、自車両の走行経路と前記距離方向検出手段で検出された距離および方向とに基づいて、前記先行車両が自車線上を走行する先行車両か他車線上を走行する先行車両かを判別する対象車両判別手段と、前記対象車両判別手段で自車線上を走行する先行車両と判別された先行車両と自車両との距離および方向に基づいて、カーブ径を推定するカーブ径推定手段とを備え、前記カーブ径推定手段が、自車線上を走行する２台以上の先行車両と自車両との距離および方向に基づいて、カーブ径を推定することを特徴とする。
【０００９】
この請求項１記載の車両用カーブ径推定装置では、まず捕捉された先行車が自車線上を走行する車両であるかどうかを判別し、自車線上を走行する車両のみを２台以上用いて、これらの先行車両までの距離と方向とに基づいて、前方のカーブ径を推定するので、リフレクタのないカーブ路においても、前方のカーブ路を認識することができる。
【００１０】
また、本発明の車両用カーブ径推定装置は、車間距離警報装置や車間距離制御装置に利用することができ、この場合、先行車の認識精度が著しく高くなる。さらに、カーブの存在を精度良く認識できるので、車間距離警報装置の誤警報を防止することができる。本発明のカーブ径推定装置は、車速の制御装置にも利用することができ、この場合、カーブの入口での減速制御が可能となる。さらに、本発明のカーブ径推定装置は、車速の警報装置にも利用することができ、カーブ入口での速度過剰状態を検知して、警報を発することができる。
【００１２】
ここで、カーブ径は、少なくとも自車両を含めた３台の車両の走行位置座標を円の方程式に代入することにより推定することができる。この請求項１記載の車両用カーブ径推定装置では、自車両および２台の先行車両、または３台の先行車両の走行位置座標を円の方程式に代入することによりカーブ径を推定する。したがって、全ての車両の走行位置座標がある特定の時間における座標であるため、その前後の走行経路に影響されることがなく、これによりカーブ径の推定値精度が高くなる。
【００１５】
上述した請求項１記載の車両用カーブ径推定装置において、対象車両判別手段の構成は特に限定されないが、請求項２記載の車両用カーブ径推定装置は、前記対象車両判別手段が、前記自車両のステアリング角度を検出するステアリング角度検出手段と、走行時間を計測する時間計測手段と、前記自車両の車速を検出する車速検出手段と、前記ステアリング角度検出手段、前記時間計測手段および前記車速検出手段でそれぞれ検出されたステアリング角度、走行時間および車速に基づいて、前記自車両の走行経路を検出する自車両走行経路検出手段と、前記ステアリング角度検出手段、前記時間計測手段、前記車速検出手段および前記距離方向検出手段でそれぞれ検出されたステアリング角度、走行時間、車速および前記先行車両までの距離と方向に基づいて、前記先行車両の走行経路を検出する先行車両走行経路検出手段と、前記自車両走行経路検出手段および前記先行車両走行経路検出手段でそれぞれ検出された前記自車両の走行経路および前記先行車両の走行経路に基づいて、自車線上を走行する先行車両を特定する先行車両判別手段とを有することを特徴とする。
【００１６】
この請求項２記載の車両用カーブ径推定装置では、ステアリング角度、走行時間、車速および車間距離、方向に基づいて、自車両の走行位置座標と先行車両の走行位置座標とを求め、これにより先行車両が自車線上にあるかどうかを判別する。ここで、自車両の走行経路に最も関連があるステアリング角度を利用するので、カーブ径の推定値精度が高くなる。
【００１７】
また、請求項３記載の車両用カーブ径推定装置は、前記対象車両判別手段が、前記自車両の左右の車輪速を検出する左右車輪速検出手段と、走行時間を計測する時間計測手段と、前記左右車輪速検出手段および前記時間計測手段でそれぞれ検出された自車両の左右の車輪速の差および走行時間に基づいて、前記自車両の走行経路を検出する自車両走行経路検出手段と、前記左右車輪速検出手段、前記時間計測手段および前記距離方向検出手段でそれぞれ検出された前記自車両の左右の車輪速の差、走行時間および前記先行車両までの距離と方向とに基づいて、前記先行車両の走行経路を検出する先行車両検出手段と、前記自車両走行経路検出手段および前記先行車両走行経路検出手段でそれぞれ検出された前記自車両の走行経路および前記先行車両の走行経路に基づいて、自車線上を走行する先行車両を特定する先行車両判別手段とを有することを特徴とする。
【００１８】
この請求項３記載の車両用カーブ径推定装置では、ステアリング角度に代えて左右の車輪速を利用するので、道路の傾きやステアリングの遊びの影響がなくなる。
【００１９】
さらに請求項４記載の車両用カーブ径推定装置は、前記対象車両判別手段が、前記自車両のヨーレイトを検出するヨーレイト検出手段と、走行時間を計測する時間計測手段と、前記自車両の車速を検出する車速検出手段と、前記ヨーレイト検出手段、前記時間計測手段および前記車速検出手段でそれぞれ検出された自車両のヨーレイト、走行時間および自車両の車速に基づいて、前記自車両の走行経路を検出する自車両走行経路検出手段と、前記ヨーレイト検出手段、前記時間計測手段、前記車速検出手段および前記距離方向検出手段でそれぞれ検出された自車両のヨーレイト、走行時間、自車両の車速および前記先行車両までの距離と方向に基づいて、前記先行車両の走行経路を検出する先行車両走行経路検出手段と、前記自車両走行経路検出手段および前記先行車両走行経路検出手段でそれぞれ検出された前記自車両の走行経路および前記先行車両の走行経路に基づいて、自車線上を走行する先行車両を特定する先行車両判別手段とを有することを特徴とする。
【００２０】
この請求項４記載の車両用カーブ径推定装置では、ヨーレイトを利用するので、タイヤの摩耗の影響がなくなる。
【００２１】
上記請求項１乃至４記載の車両用カーブ径推定装置において、距離方向検出手段の具体的構成は特に限定されないが、請求項５記載の車両用カーブ径推定装置は、前記距離方向検出手段が、光ビームまたは電波を走査させるスキャニングレーダ装置であることを特徴とする。
【００２２】
また請求項６記載の車両用カーブ径推定装置は、前記距離方向検出手段が、複数の光ビームまたは電波を発するマルチレーダ装置であることを特徴とする。
【００２３】
請求項１乃至６記載の車両用カーブ径推定装置は、車間距離警報装置、車間距離制御装置、車速警報装置、車速制御装置など広く利用することができるが、請求項７記載の発明は、目標先行車検出装置であって、請求項１乃至６の何れかに記載の車両用カーブ径推定装置と、前記車両用カーブ径推定装置の前記カーブ径推定手段で求められたカーブ径推定値に基づいて、自車線上を走行する先行車を選定する先行車選定手段とを備えたことを特徴とする。
【００２４】
この請求項７記載の目標先行車検出装置では、請求項１乃至６記載の車両用カーブ径推定装置を利用しているので、先行車の認識精度が著しく高くなる。
【００２５】
【発明の効果】
請求項１記載の車両用カーブ径推定装置によれば、リフレクタのないカーブ路においても、前方のカーブ路を認識することができる。また、車間距離警報装置や車間距離制御装置に利用することができ、この場合、先行車の認識精度が著しく高くなる。さらに、カーブの存在を精度良く認識できるので、車間距離警報装置の誤警報を防止することができる。また、車速の制御装置にも利用することができ、この場合、カーブの入口での減速制御が可能となる。さらに、車速の警報装置にも利用することができ、カーブ入口での速度過剰状態を検知して、警報を発することができる。
【００２６】
また請求項１記載の車両用カーブ径推定装置によれば、全ての車両の走行位置座標がある特定の時間における座標であるため、その前後の走行経路に影響されることがなく、これによりカーブ径の推定値精度が高くなる。
【００２８】
請求項２記載の車両用カーブ径推定装置によれば、自車両の走行経路に最も関連があるステアリング角度を利用するので、カーブ径の推定値精度が高くなる。
【００２９】
請求項３記載の車両用カーブ径推定装置によれば、ステアリング角度に代えて左右の車輪速を利用するので、道路の傾きやステアリングの遊びの影響がなくなる。
【００３０】
請求項４記載の車両用カーブ径推定装置によれば、車両のヨーレイトを利用するので、タイヤの摩耗の影響がなくなる。
【００３１】
請求項５および６記載の車両用カーブ径推定装置によれば、先行車両との距離および方向の検出精度が高く、多方向に対応できるので大きなカーブであっても利用することができる。
【００３２】
請求項７記載の目標先行車検出装置によれば、上述した効果を有する車両用カーブ径推定装置を利用しているので、先行車の認識精度が著しく高くなる。
【００３３】
【発明の実施の形態】
以下、本発明の実施形態を図面に基づいて説明する。
第１実施形態
図１は本発明の車両用カーブ径推定装置の実施形態を示すブロック図であり、本実施形態の車両用カーブ径推定装置は、距離方向検出手段１と対象車両判別手段２とカーブ径推定手段３とを備えている。
【００３４】
本実施形態に係る距離方向検出手段１は、自車両の例えば前面に取り付けられ、当該自車両から先行車両までの距離Ｌと方向θとを検出するセンサである。この距離方向検出手段１は、具体的には図５もしくは図６に示すスキャニングレーダ装置または図７もしくは図８に示すマルチレーダ装置により構成することができる。
【００３５】
図５は本発明に係る距離方向検出手段１の実施形態を示す断面図であり、このスキャニングレーダ装置１は、回転可能に設けられた送信素子１１を有し、ここからスキャニング式の１本の光ビームまたは電波が送信される。この光ビームまたは電波は、送信レンズ１２（電波の場合はアンテナ）を介して出力され、目標物体で反射したのち、その反射光ビームまたは反射電波が、受信レンズ１３（電波の場合はアンテナ）を介して、受信素子１４に入力される。受信素子１４は位置固定に設けられているが、送信素子１１が回転可能に設けられて光ビームまたは電波を走査しながら出力するので、多方向の距離計測が可能となる。
【００３６】
図６は同じく距離方向検出手段１の他の実施形態を示す断面図であり、この距離方向検出手段１もスキャニング方式のレーダ装置である。このスキャニングレーダ装置１は、位置固定に設けられた送信素子１１を有し、ここから１本の光ビームまたは電波が送信される。この光ビームまたは電波は、送信レンズ１２（電波の場合はアンテナ）を介して出力され、目標物体で反射したのち、その反射ビームまたは反射電波が、受信レンズ１３（電波の場合はアンテナ）を介して、移動可能に設けられた受信素子１４に入力される。送信素子１１は位置固定に設けられているものの、受信素子１４が移動可能に設けられているので、光ビームまたは電波を多方向から受信することができ、このスキャニングレーダ装置１にあっても多方向の距離計測が可能となる。
【００３７】
本発明の距離方向検出手段１は、上述したスキャニング方式のレーダ装置以外にも、例えばマルチ方式のレーダ装置を用いることができる。図７は距離方向検出手段１のさらに他の実施形態を示す断面図であり、複数の発光素子１１を有している。この発光素子１１からは、ｎ本の光ビームまたは電波が発生し、このｎ本の光ビームまたは電波は、発光レンズ１２（電波の場合はアンテナ）を介して出力され、目標物体で反射したのち、その反射ビームまたは反射電波が、受光レンズ１３（電波の場合はアンテナ）を介して、一つの受光素子１４に入力される。受光素子１４は一つであるが、発光素子１１がｎ本の光ビームを発するので、ｎ方向の距離計測が可能となる。
【００３８】
図８は同じくマルチレーダ装置１の他の実施形態を示す断面図であり、発光素子１１から１本の光ビームまたは電波が発っせられる。この光ビームまたは電波は、目標物体で反射したのち、その反射ビームまたは反射電波が、発光レンズ１２（電波の場合はアンテナ）を介して受光レンズ１４（電波の場合はアンテナ）に入力される。この受光素子１４は、光ビームまたは電波をｎ方向から受信することができるので、ｎ方向の距離計測が可能となる。
【００３９】
本実施形態に係る対象車両判別手段２は、上述した距離方向検出手段１により検出された距離Ｌおよび方向θに基づいて、その先行車両が自車線上を走行する先行車両か、あるいはその先行車両が他車線上を走行する先行車両かを判別するものであり、具体的にはセンサとマイクロコンピュータなどで構成することができる。
【００４０】
図１に示すように、この対象車両判別手段２は、機能的には、ステアリング角度検出手段２１、時間計測手段２２、車速検出手段２３、自車両走行経路検出手段２４、先行車両走行経路検出手段２５および先行車両判別手段２６から構成されている。
【００４１】
ステアリング角度検出手段２１は、例えばエンコーダであり、自車両のハンドル切り角φを検出する。このステアリング角度検出手段２１からの出力信号φは、後述する自車両走行経路検出手段２４と、先行車両走行経路検出手段２５とのそれぞれに送出される。
【００４２】
時間計測手段２２は、自車両の走行時間ｔを計測する例えばクロック発信器などのタイマであり、ここからの出力信号ｔは、自車両走行経路検出手段２４と、先行車両走行経路検出手段２５とのそれぞれに送出される。
【００４３】
車速検出手段２３は、自車両の車速Ｖを検出するためのセンサであり、例えば車輪速センサなどが用いられ、この出力信号Ｖは、自車両走行経路検出手段２４と、先行車両走行経路検出手段２５とのそれぞれに送出される。
【００４４】
自車両走行経路検出手段２４は、ステアリング角度検出手段２１、時間計測手段２２および車速検出手段２３でそれぞれ検出されたステアリング角度φ、走行時間ｔおよび車速Ｖに基づいて、自車両の走行経路を時間の関数（Ｘ（ｔ），Ｙ（ｔ））として検出する。
【００４５】
この自車両走行経路検出手段２４における自車両の走行経路の求め方を、図９を参照しながら説明する。
同図（Ａ）に示すように、ある時間ｔ＝０における自車両の位置を原点（０，０）として、それからｔ時間後の自車両の走行経路をＸ−Ｙ座標系で時間の関数として（Ｘｍ（ｔ），Ｙｍ（ｔ））と表す。この自車両の走行経路は、ステアリング角度φ、走行時間ｔ、車速Ｖから演算して求めることができる。
【００４６】
すなわち、まず同図（Ｂ）のように、自車両の進む方向ψと速度Ｖをベクトルで表わすと、自車両の進む方向ψは、ステアリング角度φと車速Ｖから下記（１）式で求められ、当該（１）式の曲率半径Ｒは下記（２）式で求められる。
【００４７】
【数１】
ψ＝（１／Ｒ）・∫Ｖｄｔ …（１）
Ｒ＝（１＋ＡＶ2 ）・（Ｎ・Ｌ／φ） …（２）
（１）式および（２）式において、Ｒは曲率半径、Ａはスタビリティファクタ、Ｎはオーバオールステアリングレシオ、Ｌはホイールベースである。（２）式において、Ａ，Ｎ，Ｌの各値は既知であり、またＶは車速検出手段２３からの出力信号、φはステアリング角度検出手段２１からの出力信号、時間ｔは時間計測手段２２からの出力信号によりそれぞれ求められるので、曲率半径Ｒが求められ、これを（１）式に代入することにより、自車両の進む方向ψが求められる。
【００４８】
よって、自車両の走行経路（Ｘｍ（ｔ），Ｙｍ（ｔ））は、上記（１）式で求められたψを下記（３）式および（４）式に代入することにより求められる。
【数２】
Ｘｍ（ｔ）＝∫Ｖ・ｃｏｓψｄｔ …（３）
Ｙｍ（ｔ）＝∫Ｖ・ｓｉｎψｄｔ …（４）
【００４９】
先行車両走行経路検出手段２５は、ステアリング角度検出手段２１、時間計測手段２２、車速検出手段２３および距離方向検出手段１でそれぞれ検出されたステアリング角度φ、時間ｔ、車速Ｖおよび距離Ｌと方向θに基づいて、先行車両の走行経路を時間の関数（Ｘｆ（ｔ），Ｙｆ（ｔ））として検出する。
【００５０】
この先行車両走行経路検出手段２５における先行車両の走行経路の求め方を図１０を参照しながら説明する。
同図に示すように、先行車両の走行経路は、自車両との相対位置関係で求めることとし、先行車両の走行経路をＸ−Ｙ座標系で時間ｔの関数として（Ｘｆ（ｔ），Ｙｆ（ｔ））と表す。自車両の走行経路は上述した（３）および（４）式で求められるので、自車両を基準とした先行車両の走行経路は、自車両と先行車両との距離Ｌおよび方向θ、ステアリング角度φ、走行時間ｔ、車速Ｖから演算して求めることができる。
【００５１】
つまり、下記（５）式および（６）式で求めることができる。
【数３】
Ｘｆ（ｔ）＝∫Ｖ・ｃｏｓψｄｔ＋Ｌｓｉｎθ …（５）
Ｙｆ（ｔ）＝∫Ｖ・ｓｉｎψｄｔ＋Ｌｃｏｓθ …（６）
この（５）および（６）式において、それぞれの第１項は自車両の走行経路座標であるから、上述した（３）および（４）式と同様に、既知の定数と、ステアリング角度検出手段２１、時間計測手段２２、車速検出手段２３からの入力信号により演算することができる。また、（５）および（６）式の第２項は距離方向検出手段１で検出される距離Ｌおよび方向θを用いて演算することができる。
【００５２】
先行車両判別手段２６は、自車両走行経路検出手段２４および先行車両走行経路検出手段２５でそれぞれ検出された自車両の走行経路および先行車両の走行経路に基づいて、その先行車両が自車線上を走行する先行車両であるかどうかを判別する。
【００５３】
この判別は、具体的には、現在の自車両の位置と、先行車両との車間時間Ｔｆ前の当該先行車両の位置との差Ｌｗを求め、これが道路幅Ｗより小さいかどうかで判断する。つまり、先行車両のＴｆ時間前の走行位置が現在の自車両の走行位置に対して道路幅方向にどれだけずれているかで、当該先行車両が自車線上を走行する車両であるかどうかを判別する。
【００５４】
ここで、先行車両までの車間時間Ｔｆは、現在の自車両と先行車両との距離Ｌと、自車両の車速Ｖを用いて、下記（７）式で求められる。
【数４】
Ｔｆ＝Ｌ／Ｖ …（７）
【００５５】
また、現在の自車両の位置（Ｘｍ（ｔ），Ｙｍ（ｔ））と、記憶させておいた先行車両までの車間時間Ｔｆ前の当該先行車両の位置（Ｘｆ（ｔ−Ｔｆ），Ｙｆ（ｔ−Ｔｆ））との差Ｌｗは、下記（８）式で求め、（９）式により道路幅Ｗより小さいかどうかを判別する。ＬｗがＷより小さい場合には、その先行車両が自車線上に存在すると判断し、カーブ径を演算する際の先行車両の候補となる。
【数５】
カーブ径推定手段３は、先行車両判別手段２６で自車線上を走行する先行車両と判別された先行車両と、自車両との距離および方向に基づいて、カーブ径を推定するものである。
【００５７】
このカーブ径の推定方法を図１１および図１２を参照しながら説明する。
図１１は、先行車、先々行車１、先々行車２、すなわち３台の先行車両を距離方向検出手段１で捕捉した場面を示している。また、図１２（Ａ）では、この３台の先行車を検出した場合の道路曲率Ｒの求め方を模式的に示す。
【００５８】
先行車が角度θ１、距離Ｌ１、先々行車１が角度θ２、距離Ｌ２、先々行車２が角度θ３、距離Ｌ３で捕らえられたとする。このとき、自車両の位置を原点として、Ｘ−Ｙ座標系で先行車（Ｘ１，Ｙ１）、先々行車１（Ｘ２，Ｙ２）、先々行車２（Ｘ３，Ｙ３）の座標位置を表わすと、
【数６】
Ｘ１＝Ｌ１ｓｉｎθ１ …（１０）
Ｙ１＝Ｌ１ｃｏｓθ１ …（１１）
Ｘ２＝Ｌ２ｓｉｎθ２ …（１２）
Ｙ２＝Ｌ２ｃｏｓθ２ …（１３）
Ｘ３＝Ｌ３ｓｉｎθ３ …（１４）
Ｙ３＝Ｌ３ｃｏｓθ３ …（１５）
となる。
【００５９】
円の方程式は、図１２（Ｂ）に示すように、カーブ曲率をＲ、円の中心座標を（ａ，ｂ）とすると、
【数７】
（Ｘ−ａ）2 ＋（Ｙ−ｂ）2 ＝Ｒ2 …（１６）
となる。したがって、この方程式（１６）に、上記（１０）〜（１５）の３台の先行車両の座標を代入して、その連立方程式を解けば道路曲率Ｒが求まる。
【００６０】
図１１および図１２に示すカーブ径の推定方法では、３点が決まるとその曲率Ｒが定まるという円の性質を利用して、３台の先行車両の走行位置からカーブ径Ｒを求めたが、本発明では２台の先行車両と自車両との走行位置を用いて、カーブ径を推定することもできる。
【００６１】
図１３は、先行車、先々行車１、すなわち２台の先行車両を距離方向検出手段で捕捉した場面を示している。また、図１４は、２台の先行車と自車両とを用いて道路曲率Ｒを求める方法を模式的に示している。
【００６２】
図１３および図１４に示すように、先行車が角度θ１、距離Ｌ１、先々行車１が角度θ２、距離Ｌ２で捕らえられたとする。自車の位置を原点（０，０）として、Ｘ−Ｙ座標系で先行車（Ｘ１，Ｙ１）、先々行車１（Ｘ２，Ｙ２）の位置を表わすと、上述した（１０）式から（１３）式となる。そして、上記（１６）式に自車両の座標（０，０）と、先行車の座標（Ｘ１，Ｙ１）および先行車１の座標（Ｘ２，Ｙ２）を代入して、その連立方程式を解けば道路曲率Ｒが求まる。
【００６３】
このように、先行車両が２台であった場合でも、前方のカーブ径を推定することができる。ただし、この方法では自車両も曲率半径Ｒの円上にあるので、前方のカーブ径を精度良く推定するには、上記図１１および図１２に示されるように、３台の先行車両を用いることがより好ましい。
【００６４】
これら自車両走行経路検出手段２４、先行車両走行経路検出手段２５、先行車両判別手段２６およびカーブ径推定手段３は、マイクロコンピュータのソフトウェアにより構成されている。
【００６５】
次に作用を説明する。
図１５は、本実施形態における主動作を示すフローチャートであり、まずステップ１において、距離方向検出手段１により、自車両から先行車両までの距離Ｌと方向θを測定し、先行車両走行経路検出手段２５に送出する。これと同時に、対象車両判別手段２において、ステアリング角度検出手段２１によりステアリング角度φを、時間計測手段２２により走行時間ｔを、車速検出手段２３により自車両の車速Ｖをそれぞれ検出し、自車両走行経路検出手段２４および先行車両走行経路検出手段２５に送出する。
【００６６】
自車両走行経路検出手段２４では、ステアリング角度φ、走行時間ｔ、車速Ｖから自車両走行経路（Ｘ（ｔ），Ｙ（ｔ））を上述した（１）〜（４）式を用いて演算して求める。先行車両走行経路検出手段２５では、距離Ｌ、方向θ、ステアリング角度φ、走行時間ｔ、車速Ｖから、捕捉された先行車両の走行経路（Ｘｆ（ｔ），Ｙｆ（ｔ））を上述した（１）〜（６）式を用いて演算して求める。
【００６７】
自車線上の先行車両判別手段２６では、上述した（７）〜（９）式を用いて、自車両の走行経路と先行車両の走行経路とを比較し、その先行車両が自車線上に存在するか否かを判別する。以上の判別は、ステップ２〜４に示すように、捕捉された先行車両全てに対して行われ、自車線上に存在する先行車両のみを選択し、カーブ径の推定に用いる。ステップ２〜４において、自車両または先行車両が車線変更するなど、その先行車両が自車線上に存在しない場合には、その先行車両のデータはカーブ径の推定には用いない。
【００６８】
カーブ径推定手段３では、自車線上の３台以上あるいは２台以上の先行車両のデータを用いて、ステップ５にて、上述した（１０）〜（１６）式により、前方のカーブ径を推定する。
【００６９】
このように、本実施形態のカーブ径推定装置は、自車両から自車線上を走行する２台以上の先行車両までの距離と方向とを用いて、前方のカーブ径を推定するように構成されているので、リフレクタのないカーブ路においても、前方のカーブ路を認識することができる。
【００７０】
本実施形態のカーブ径推定装置は車間距離警報装置や車間距離制御装置に利用することができ、この場合、先行車の認識精度が著しく高くなる。また、カーブの存在を精度良く認識できるので、車間距離警報装置の誤警報を防止することができる。本実施形態のカーブ径推定装置は、車速の制御装置にも利用することができ、この場合、カーブの入口での減速制御が可能となる。さらに、本実施形態のカーブ径推定装置は、車速の警報装置にも利用することができ、カーブ入口での速度過剰状態を検知して、警報を発することができる。
【００７１】
第２実施形態
上述した第１実施形態では、カーブ径推定手段３におけるカーブ径の推定方法が、３台の先行車両または２台の先行車両と自車両を用いたものであるが、本実施形態では１台の先行車両を選定し、その先行車両の走行経路からカーブ径を推定する方法である。したがって、カーブ径推定手段３のソフトウェア構成のみが第１実施形態と相違している。
【００７２】
カーブ径推定装置の基本構成は、図１に示す第１実施形態と同じであり、その詳細な説明は省略するが、距離方向検出手段１として、図５および図６に示すスキャニングレーダ装置や図７および図８に示すマルチレーダ装置を用いることができる。
【００７３】
本実施形態のカーブ径推定手段３は、自車線上を走行する先行車両の走行経路（Ｘｆ（ｔ），Ｙｆ（ｔ））から前方のカーブ径を推定するものである。具体的には、自車線上を走行する先行車両の走行経路の時間関数（Ｘｆ（ｔ），Ｙｆ（ｔ））から、所定の時間間隔でその座標位置を３点抽出する。これは、図１０と上記（５）および（６）式を用いて求める。これにより求められた座標位置３点を上記（１６）式に代入して連立方程式を解くことにより、道路曲率Ｒを求める。
【００７４】
なお、本実施形態では、先行車より先々行車１、また先々行車１より先々行車２の走行経路を用いる方が、より前方のカーブ径の推定が精度良く行われるので、複数先行車両を捕捉した場合には、最も先行する車両の走行経路をカーブ径の推定に用いるようにしている。
【００７５】
次に作用を説明する。
図１６は本実施形態の動作を示すフローチャートであり、まずステップ１１において、距離方向検出手段１により、自車両から先行車両までの距離Ｌと方向θを測定し、先行車両走行経路検出手段２５に送出する。これと同時に、対象車両判別手段２において、ステアリング角度検出手段２１によりステアリング角度φを、時間計測手段２２により走行時間ｔを、車速検出手段２３により自車両の車速Ｖをそれぞれ検出し、自車両走行経路検出手段２４および先行車両走行経路検出手段２５に送出する。
【００７６】
自車両走行経路検出手段２４では、ステアリング角度φ、走行時間ｔ、車速Ｖから自車両走行経路（Ｘ（ｔ），Ｙ（ｔ））を上述した（１）〜（４）式を用いて演算して求める。先行車両走行経路検出手段２５では、距離Ｌ、方向θ、ステアリング角度φ、走行時間ｔ、車速Ｖから、捕捉された先行車両の走行経路（Ｘｆ（ｔ），Ｙｆ（ｔ））を上述した（１）〜（６）式を用いて演算して求める。
【００７７】
自車線上の先行車両判別手段２６では、上述した（７）〜（９）式を用いて、自車両の走行経路と先行車両の走行経路とを比較し、その先行車両が自車線上に存在するか否かを判別する。以上の判別は、ステップ１２，１３，１５に示すように、捕捉された先行車両全てに対して行われ、自車線上に存在する先行車両のみを選択し、カーブ径の推定に用いる。ステップ１２，１３，１５において、自車両または先行車両が車線変更するなど、その先行車両が自車線上に存在しない場合には、その先行車両のデータはカーブ径の推定には用いない。
【００７８】
カーブ径推定手段３では、自車線上の先行車両の走行経路のデータを用いて、ステップ１７にて、前方のカーブ径を推定するが、ステップ１２，１３，１５に示されるように、３台の先行車両が全て自車線上にある場合には、最も先行する先々行車２の走行経路が用いられる。また、この先々行車２が車線変更等により自車線上に存在しない場合には、次に最も先行する先々行車１の走行経路を用いてカーブ径を推定する（ステップ１６）。同様に、この先々行車１も車線変更等により自車線上に存在しない場合には、先行車の走行経路を用いてカーブ径を推定する（ステップ１４）。
【００７９】
このように、本実施形態のカーブ径推定装置は、自車両から自車線上を走行する先行車両の走行経路（Ｘｆ（ｔ），Ｙｆ（ｔ））を用いて、前方のカーブ径Ｒを推定するように構成されているので、第１実施形態と同様、リフレクタのないカーブ路においても、前方のカーブ路を認識することができる。特に、本実施形態によれば、先行車が２台以上存在しなくても、前方のカーブ路を認識することができる。
【００８０】
第３実施形態
本実施形態は、上述した第１実施形態または第２実施形態のカーブ径推定装置を用いて、そのカーブ径の推定値と先行車両の走行経路から自車線上の先行車両を選定する目標先行車検出装置である。
【００８１】
本実施形態の目標先行車検出装置は、図２に示すように、第１実施形態のカーブ径推定装置に先行車選定手段４を付加したものであり、マイクロコンピュータのソフトウェアで構成されている。
距離方向検出手段１、対象車両判別手段２およびカーブ径推定手段３は、第１実施形態または第２実施形態と同じであるため、その説明は省略する。
【００８２】
本実施形態の先行車選定手段４は、カーブ径推定手段３により求められたカーブ径Ｒの推定値を取り込み、このカーブ径に基づいて先行車を選定する信号を外部に出力する。カーブ径の推定方法は、第１実施形態に示す自車線上の２台以上の先行車両の座標を用いる方法、あるいは第２実施形態に示す自車線上の走行車両の走行経路を用いる方法の何れでも良い。
【００８３】
このカーブ径Ｒを用いて、先行車選定手段４は、例えば（１７）式によりカーブ径Ｒに応じたビーム角度θを演算し、光ビームの照射角度を変更するなどして、先行車を検出する（ステップ６）。
【数８】
θ＝Ｃ／Ｒ （Ｃ：定数） …（１７）
【００８４】
本実施形態の目標先行車検出装置は、カーブ径の推定値を用いて目標とする先行車を検出するので、先行車の認識精度が向上することになる。
【００８５】
第４実施形態
上述した第１実施形態および第２実施形態のカーブ径推定装置、および第３実施形態の目標先行車検出装置は、ステアリング角度φと走行時間ｔと車速Ｖとにより自車両および先行車両の走行経路を求めたが、本実施形態では、自車両の左右の車輪速を用いて、自車両および先行車両の走行経路を求める。
【００８６】
すなわち、図３に示すように、対象車両判別手段２には、上述した実施形態におけるステアリング角度検出手段２１、時間計測手段２２および車速検出手段２３の代わりに、左右車輪速検出手段２７が設けられており、具体的には左右の車輪にそれぞれ設けられた車輪速センサで構成されている。
この左右車輪速検出手段２７により、左輪速度Ｖｌと右輪速度Ｖｒとが検出され、自車両走行経路検出手段２４および先行車両走行経路検出手段２５のそれぞれに送出される。
【００８７】
そして、自車両走行経路検出手段２４では、左輪速度Ｖｌと右輪速度Ｖｒとを用いて、下記（１８）式により平均車速Ｖを求める。
【数９】
Ｖ＝（Ｖｌ＋Ｖｒ）／２ …（１８）
【００８８】
また、（２）式に代えて下記（１９）式により道路曲率Ｒを求める。
【数１０】
Ｒ＝Ｖ・Ｔｔ／（Ｖｌ−Ｖｒ） …（１９）
ただし、Ｔｔはトレッドである。
【００８９】
（１８）式により車速Ｖ、（１９）式により道路曲率Ｒが求められるので、これらを上記（１）式に代入して自車両の進行方向ψを求め、このψを上記（３）および（４）式に代入することにより、自車両の走行経路（Ｘ（ｔ），Ｙ（ｔ））を求める。
【００９０】
一方、先行車両走行経路検出手段２５においては、左右車輪速検出手段２７からの左輪速度Ｖｌと右輪速度Ｖｒとを用いて、上述した手順で車速Ｖと自車両の進行方向ψを求め、距離方向検出手段１からの距離Ｌおよび方向θとともに上記（５）および（６）式に代入することにより、先行車両の走行経路（Ｘｆ（ｔ），Ｙｆ（ｔ））を求める。
【００９１】
以下の手順は第１実施形態と同様であるのでその説明は省略するが、本実施形態によれば、左右の車輪速センサから自車両および先行車両の走行経路を検出する構成としたため、道路の傾きや、ステアリングの遊びの影響が少なくなり、道路曲率Ｒの検出精度が向上することになる。
【００９２】
第５実施形態
本発明のカーブ径推定装置および目標先行車検出装置は、さらに改変することができる。本実施形態では、第１〜３実施形態のステアリング角度検出手段２１、時間計測手段２２および車速検出手段２３、第４実施形態の左右車輪速検出手段２７の代わりに、ヨーレイト検出手段２８および車速検出手段２３が設けられており、ヨーレイト検出手段２８は具体的にはヨーレイトセンサで構成されている。なお、ヨーレイト（ｙａｗ ｒａｔｅ）とは車両のｚ軸廻りの揺動レイトをいう。
【００９３】
このヨーレイト検出手段２８で検出された自車両のヨーレイトは、車速検出手段２３で検出された自車両の車速Ｖとともに、自車両走行経路検出手段２４および先行車両検出手段２５のそれぞれに送出される。
【００９４】
そして、自車両走行経路検出手段２４では、上記（２）式に代えて、ヨーレイトηおよび車速Ｖを用いて、道路曲率Ｒを下記（２０）式より求める。
【数１１】
Ｒ＝Ｖ／η （２０）
【００９５】
この（２０）式により道路曲率Ｒが求められるので、これらを上記（１）式に代入して自車両の進行方向ψを求め、このψを上記（３）および（４）式に代入することにより、自車両の走行経路（Ｘ（ｔ），Ｙ（ｔ））を求める。
【００９６】
一方、先行車両走行経路検出手段２５においては、ヨーレイト検出手段２８からのヨーレイトηと車速Ｖとを用いて、上述した手順で自車両の進行方向ψを求め、距離方向検出手段１からの距離Ｌおよび方向θとともに上記（５）および（６）式に代入することにより、先行車両の走行経路（Ｘｆ（ｔ），Ｙｆ（ｔ））を求める。
【００９７】
以下の手順は第１実施形態と同様であるのでその説明は省略するが、本実施形態によれば、ヨーレイトセンサから走行経路を検出する構成としたため、タイヤの摩耗の影響がなくなり、道路曲率Ｒの検出精度が向上することになる。
【００９８】
なお、以上説明した各実施形態は、本発明の理解を容易にするために記載されたものであって、本発明を限定するために記載されたものではない。したがって、上記の実施形態に開示された各要素は、本発明の技術的範囲に属する全ての設計変更や均等物をも含む趣旨である。
【図面の簡単な説明】
【図１】本発明の第１および第２実施形態（車両用カーブ径推定装置）を示すブロック図である。
【図２】本発明の第３実施形態（目標先行車検出装置）を示すブロック図である。
【図３】本発明の第４実施形態（目標先行車検出装置）を示すブロック図である。
【図４】本発明の第５実施形態（目標先行車検出装置）を示すブロック図である。
【図５】本発明に係る距離方向検出手段の実施形態（スキャニングレーダ装置）を示す断面図である。
【図６】本発明に係る距離方向検出手段の他の実施形態（スキャニングレーダ装置）を示す断面図である。
【図７】本発明に係る距離方向検出手段の他の実施形態（マルチレーダ装置）を示す断面図である。
【図８】本発明に係る距離方向検出手段の他の実施形態（マルチレーダ装置）を示す断面図である。
【図９】本発明に係る自車両走行経路検出手段における自車両の走行経路の求め方を説明するための模式図である。
【図１０】本発明に係る先行車両走行経路検出手段における先行車両の走行経路の求め方を説明するための模式図である。
【図１１】本発明に係るカーブ径推定手段におけるカーブ径の求め方を説明するための模式図である。
【図１２】本発明に係るカーブ径推定手段におけるカーブ径の求め方を説明するための模式図である。
【図１３】本発明に係るカーブ径推定手段におけるカーブ径の他の求め方を説明するための模式図である。
【図１４】本発明に係るカーブ径推定手段におけるカーブ径の他の求め方を説明するための模式図である。
【図１５】本発明に係るカーブ径推定手段におけるカーブ径の求め方（第１実施形態）を説明するためのフローチャートである。
【図１６】本発明に係るカーブ径推定手段におけるカーブ径の他の求め方（第２実施形態）を説明するためのフローチャートである。
【図１７】図２に示す目標先行車検出装置における先行車の検出手順を示すフローチャートである。
【図１８】従来の車両用カーブ径推定装置の問題点を説明するための模式図である。
【符号の説明】
１…距離方向検出手段
１１…送信素子
１２…送信レンズ
１３…受信レンズ
１４…受信素子
２…対象車両判別手段
２１…ステアリング角度検出手段
２２…時間計測手段
２３…車速検出手段
２４…自車両走行経路検出手段
２５…先行車両走行経路検出手段
２６…先行車両判別手段
２７…左右車輪速検出手段
２８…ヨーレイト検出手段
３…カーブ径推定手段
４…先行車選定手段[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a vehicle curve diameter estimation device that estimates a curve diameter of a host vehicle before entering the curve, and a target leading vehicle detection device that detects a target leading vehicle traveling on the host lane.
[0002]
[Prior art]
Conventionally, as a vehicle curve diameter estimating device or a target preceding vehicle detecting device, for example, an obstacle detecting device described in Japanese Patent Laid-Open No. 5-87,922 is known. This obstacle detection device sets the radar main axis direction so that even if the target object moves, some of the laser beams can always detect the target object. It is possible to follow objects.
[0003]
Further, a vehicle curve diameter estimation device described in Japanese Patent Laid-Open No. 4-369,800 estimates a curve diameter by detecting a distance between reflectors (reflectors) installed on a curved road. Yes, the distance between the reflectors is calculated based on the vehicle speed of the host vehicle and the distance from the host vehicle to the reflector. In highways and the like, the interval between the reflectors is changed according to the curve diameter, so that the curve diameter can be estimated before entering the curve using this.
[0004]
[Problems to be solved by the invention]
However, such a conventional vehicle curve diameter estimation device or target preceding vehicle detection device has the following problems.
That is, in the technique of following the main vehicle direction of the radar to the preceding vehicle, the preceding vehicle can move relatively slowly at the entrance of the curve as shown in FIG. However, there is a problem that the target preceding vehicle cannot be detected when the main spindle control of the radar is not in time, such as when the preceding vehicle suddenly changes lanes as shown in FIG. For this reason, it is conceivable to estimate the curve diameter of the own lane from the steering angle of the own vehicle and the difference between the left and right wheel speeds, thereby changing the direction of the main axis of the radar. In this way, the lane change of the preceding vehicle can be detected. However, there is a risk of erroneously recognizing that the lane has been changed even if the preceding vehicle is traveling on the own lane at the curve entrance.
[0005]
On the other hand, the technology for recognizing the road shape using reflectors has the problem that it cannot be used on roads with few reflectors, such as ordinary roads, because the preceding vehicle and other lane vehicles get in the way and cannot be detected. . In addition, in this technique, when there is something similar to a reflector on the roadside such as a signboard or a stopped vehicle, there is a possibility that a road shape is erroneously recognized.
[0006]
Although it is also an effective technique to detect the forward curve diameter using a camera, it may not be recognized in backlight or at night, and it is necessary to recognize the road shape with a radar.
[0007]
The present invention has been made in view of such problems of the prior art, and estimates the forward curve diameter from the distance and direction between the preceding vehicle and the preceding vehicle that travels in front of the preceding vehicle, It is an object of the present invention to provide a vehicle curve diameter estimation device and a target preceding vehicle detection device that can accurately detect a target preceding vehicle at an exit.
[0008]
[Means for Solving the Problems]
In order to achieve the above object, a vehicle curve diameter estimating apparatus according to the present invention according to
[0009]
In the vehicle curve diameter estimating apparatus according to
[0010]
Further, the vehicle curve diameter estimation device of the present invention can be used for an inter-vehicle distance warning device and an inter-vehicle distance control device, and in this case, the recognition accuracy of the preceding vehicle is remarkably increased. Furthermore, since the presence of the curve can be recognized with high accuracy, it is possible to prevent a false alarm of the inter-vehicle distance alarm device. The curve diameter estimation device of the present invention can also be used for a vehicle speed control device, and in this case, deceleration control at the entrance of the curve is possible. Furthermore, the curve diameter estimation apparatus of the present invention can be used for a vehicle speed warning device, and can detect an excessive speed state at a curve entrance and issue a warning.
[0012]
here,The curve diameter can be estimated by substituting the traveling position coordinates of at least three vehicles including the host vehicle into the circle equation. thisClaim 1In the vehicle curve diameter estimation apparatus, the curve diameter is estimated by substituting the traveling position coordinates of the own vehicle and two preceding vehicles or three preceding vehicles into the equation of the circle. Therefore, since the travel position coordinates of all the vehicles are coordinates at a specific time, the travel path before and behind the coordinates is not affected, thereby increasing the accuracy of the estimated value of the curve diameter.
[0015]
In the vehicle curve diameter estimation apparatus according to
[0016]
thisClaim 2The vehicle curve diameter estimating apparatus calculates the traveling position coordinates of the own vehicle and the traveling position coordinates of the preceding vehicle on the basis of the steering angle, traveling time, vehicle speed, inter-vehicle distance, and direction. Determine if it is in Here, since the steering angle most relevant to the travel route of the host vehicle is used, the accuracy of the estimated value of the curve diameter is increased.
[0017]
A vehicle curve diameter estimating apparatus according to claim 3.BeforeThe target vehicle discriminating means is detected by the left and right wheel speed detecting means for detecting the left and right wheel speeds of the host vehicle, the time measuring means for measuring the travel time, the left and right wheel speed detecting means and the time measuring means, respectively. Based on the difference between the left and right wheel speeds of the host vehicle and the travel time, the host vehicle travel route detecting means for detecting the travel route of the host vehicle, the left and right wheel speed detecting means, the time measuring means, and the distance direction detection Preceding vehicle detection means for detecting a traveling route of the preceding vehicle based on a difference between left and right wheel speeds of the own vehicle detected by the means, a traveling time, and a distance and direction to the preceding vehicle; Based on the travel route of the host vehicle and the travel route of the preceding vehicle detected by the vehicle travel route detection unit and the preceding vehicle travel route detection unit, respectively, And having a preceding vehicle judgment means for identifying a vehicle.
[0018]
thisClaim 3In this vehicle curve diameter estimating apparatus, since the left and right wheel speeds are used instead of the steering angle, the influence of road inclination and steering play is eliminated.
[0019]
Furthermore, the vehicle curve diameter estimation apparatus according to claim 4.BeforeThe target vehicle discriminating means includes a yaw rate detecting means for detecting the yaw rate of the own vehicle, a time measuring means for measuring a running time, a vehicle speed detecting means for detecting the vehicle speed of the own vehicle, the yaw rate detecting means, and the time. A host vehicle travel route detection unit for detecting a travel route of the host vehicle based on a yaw rate of the host vehicle, a travel time and a vehicle speed of the host vehicle detected by the measurement unit and the vehicle speed detection unit; and the yaw rate detection unit; The preceding vehicle travels based on the yaw rate of the host vehicle, the travel time, the vehicle speed of the host vehicle, and the distance and direction to the preceding vehicle detected by the time measuring unit, the vehicle speed detecting unit, and the distance direction detecting unit, respectively. A preceding vehicle traveling route detecting means for detecting a route, the own vehicle traveling route detecting means and the preceding vehicle traveling route detecting means; Is based on the travel route and the travel path of the preceding vehicle detected the vehicle, and having a preceding vehicle judgment means for identifying a preceding vehicle traveling on the same lane.
[0020]
thisClaim 4In the vehicle curve diameter estimation apparatus, since yaw rate is used, the influence of tire wear is eliminated.
[0021]
[0022]
AlsoClaim 6The vehicle curve diameter estimation apparatus described above is characterized in that the distance direction detection means is a multi-radar apparatus that emits a plurality of light beams or radio waves.
[0023]
Claim 1Thru 6The vehicle curve diameter estimation device described can be widely used, such as an inter-vehicle distance alarm device, an inter-vehicle distance control device, a vehicle speed alarm device, a vehicle speed control device,Claim 7The described invention is a target preceding vehicle detection device, whereinThru 6A preceding vehicle that travels on the own lane is selected based on the vehicle curve diameter estimation device according to any one of the above and the curve diameter estimation value obtained by the curve diameter estimation means of the vehicle curve diameter estimation device. And a preceding vehicle selection means.
[0024]
thisClaim 7In the target preceding vehicle detection device described above, claim 1Thru 6Since the vehicle curve diameter estimation device described is used, the recognition accuracy of the preceding vehicle is remarkably increased.
[0025]
【The invention's effect】
According to the vehicle curve diameter estimating apparatus of the first aspect, it is possible to recognize a forward curved road even on a curved road without a reflector. Further, it can be used for an inter-vehicle distance warning device and an inter-vehicle distance control device, and in this case, the recognition accuracy of the preceding vehicle is remarkably increased. Furthermore, since the presence of the curve can be recognized with high accuracy, it is possible to prevent a false alarm of the inter-vehicle distance alarm device. It can also be used for a vehicle speed control device, and in this case, deceleration control at the entrance of the curve is possible. Furthermore, it can also be used for a warning device for vehicle speed, and an alarm can be issued by detecting an excessive speed state at the entrance of the curve.
[0026]
Claim 1According to the vehicle curve diameter estimation apparatus, since the travel position coordinates of all the vehicles are coordinates at a certain time, it is not influenced by the travel route before and after the travel position coordinates, and thereby the estimated accuracy of the curve diameter Becomes higher.
[0028]
Claim 2According to this vehicle curve diameter estimation apparatus, the steering angle that is most relevant to the travel route of the host vehicle is used, so that the accuracy accuracy of the curve diameter is improved.
[0029]
Claim 3According to this vehicle curve diameter estimating apparatus, since the left and right wheel speeds are used in place of the steering angle, the influence of road inclination and steering play is eliminated.
[0030]
According to the vehicle curve diameter estimating apparatus of the fourth aspect, since the yaw rate of the vehicle is used, the influence of tire wear is eliminated..
[0031]
Claim5 and 6According to the described vehicle curve diameter estimation device, the distance and direction detection accuracy with respect to the preceding vehicle is high, and it is possible to use even a large curve because it can handle multiple directions.
[0032]
Claim 7According to the described target preceding vehicle detection device, since the vehicle curve diameter estimation device having the above-described effect is used, the recognition accuracy of the preceding vehicle is remarkably increased.
[0033]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
First embodiment
FIG. 1 is a block diagram showing an embodiment of a vehicle curve diameter estimation apparatus of the present invention. The vehicle curve diameter estimation apparatus of this embodiment is a distance direction detection means 1, a target vehicle discrimination means 2, and a curve diameter estimation means. 3 is provided.
[0034]
The distance
[0035]
FIG. 5 is a cross-sectional view showing an embodiment of the distance direction detecting means 1 according to the present invention. This
[0036]
FIG. 6 is a cross-sectional view showing another embodiment of the distance direction detection means 1, and the distance direction detection means 1 is also a scanning radar device. The
[0037]
The distance direction detecting means 1 of the present invention can use, for example, a multi-type radar apparatus in addition to the above-described scanning-type radar apparatus. FIG. 7 is a cross-sectional view showing still another embodiment of the distance
[0038]
FIG. 8 is a cross-sectional view showing another embodiment of the
[0039]
The target vehicle discriminating means 2 according to this embodiment is based on the distance L and the direction θ detected by the distance / direction detecting means 1 described above, the preceding vehicle traveling on the own lane, or the preceding vehicle. Is a preceding vehicle traveling on another lane, specifically, it can be composed of a sensor and a microcomputer.
[0040]
As shown in FIG. 1, this target vehicle discrimination means 2 functionally includes a steering angle detection means 21, a time measurement means 22, a vehicle speed detection means 23, a host vehicle travel route detection means 24, and a preceding vehicle travel route detection means. 25 and preceding vehicle discriminating means 26.
[0041]
The steering angle detection means 21 is an encoder, for example, and detects a steering angle φ of the host vehicle. The output signal φ from the steering angle detection means 21 is sent to each of a host vehicle travel route detection means 24 and a preceding vehicle travel route detection means 25 described later.
[0042]
The time measuring means 22 is a timer such as a clock transmitter that measures the traveling time t of the host vehicle, and the output signal t from here is the own vehicle traveling path detecting means 24, the preceding vehicle traveling path detecting means 25, and the like. Sent to each of the.
[0043]
The vehicle speed detection means 23 is a sensor for detecting the vehicle speed V of the host vehicle. For example, a wheel speed sensor is used, and the output signal V is output from the host vehicle travel path detection means 24 and the preceding vehicle travel path detection means. And 25 respectively.
[0044]
The own vehicle travel
[0045]
How to determine the travel route of the host vehicle in the host vehicle travel route detection means 24 will be described with reference to FIG.
As shown in FIG. 5A, the position of the host vehicle at a certain time t = 0 is set as the origin (0, 0), and the travel route of the host vehicle after t time is expressed as a function of time in the XY coordinate system. (Xm (t), Ym (t)). The travel route of the host vehicle can be calculated from the steering angle φ, the travel time t, and the vehicle speed V.
[0046]
That is, as shown in FIG. 5B, when the traveling direction ψ and speed V of the host vehicle are represented by vectors, the traveling direction ψ of the host vehicle is obtained from the steering angle φ and the vehicle speed V by the following equation (1). The radius of curvature R of the equation (1) is obtained by the following equation (2).
[0047]
[Expression 1]
ψ = (1 / R) · ∫Vdt (1)
R = (1 + AV2) ・ (N ・ L / φ) (2)
In the equations (1) and (2), R is a radius of curvature, A is a stability factor, N is an overall steering ratio, and L is a wheelbase. In equation (2), the values of A, N, and L are known, V is an output signal from the vehicle speed detection means 23, φ is an output signal from the steering angle detection means 21, and time t is the time measurement means 22. Therefore, the curvature radius R is obtained, and by substituting it into the equation (1), the traveling direction ψ of the host vehicle is obtained.
[0048]
Accordingly, the travel route (Xm (t), Ym (t)) of the host vehicle is obtained by substituting ψ obtained by the above equation (1) into the following equations (3) and (4).
[Expression 2]
Xm (t) = ∫V · cosψdt (3)
Ym (t) = ∫V · sinψdt (4)
[0049]
The preceding vehicle travel route detection means 25 includes a steering angle φ, a time t, a vehicle speed V, a distance L, and a direction θ detected by the steering angle detection means 21, the time measurement means 22, the vehicle speed detection means 23, and the distance direction detection means 1, respectively. Based on the above, the travel route of the preceding vehicle is detected as a function of time (Xf (t), Yf (t)).
[0050]
A method of obtaining the traveling route of the preceding vehicle in the preceding vehicle traveling route detection means 25 will be described with reference to FIG.
As shown in the figure, the travel route of the preceding vehicle is obtained from a relative positional relationship with the host vehicle, and the travel route of the preceding vehicle is expressed as a function of time t in the XY coordinate system (Xf (t), Yf (T)). Since the travel route of the host vehicle is obtained by the above-described formulas (3) and (4), the travel route of the preceding vehicle based on the host vehicle is the distance L and direction θ between the host vehicle and the preceding vehicle, and the steering angle φ. , And can be calculated from the running time t and the vehicle speed V.
[0051]
That is, it can be obtained by the following equations (5) and (6).
[Equation 3]
Xf (t) = ∫V · cosψdt + Lsinθ (5)
Yf (t) = ∫V · sinψdt + Lcosθ (6)
In the equations (5) and (6), the first term is the travel route coordinates of the host vehicle. Therefore, as in the equations (3) and (4) described above, the known constant and the steering angle detection means 21, can be calculated from input signals from the time measuring means 22 and the vehicle
[0052]
The preceding vehicle discriminating means 26 determines whether the preceding vehicle is on the own lane based on the traveling path of the own vehicle and the traveling path of the preceding vehicle detected by the own vehicle traveling path detecting means 24 and the preceding vehicle traveling path detecting means 25, respectively. It is determined whether the vehicle is a preceding vehicle that travels.
[0053]
Specifically, this determination is made by obtaining a difference Lw between the current position of the host vehicle and the position of the preceding vehicle before the inter-vehicle time Tf from the preceding vehicle, and determining whether this is smaller than the road width W. That is, it is determined whether or not the preceding vehicle is a vehicle traveling on the own lane based on how much the traveling position of the preceding vehicle before the time Tf deviates in the road width direction from the current traveling position of the own vehicle. To do.
[0054]
Here, the inter-vehicle time Tf to the preceding vehicle is obtained by the following equation (7) using the current distance L between the own vehicle and the preceding vehicle and the vehicle speed V of the own vehicle.
[Expression 4]
Tf = L / V (7)
[0055]
Further, the current position of the host vehicle (Xm (t), Ym (t)) and the position of the preceding vehicle (Xf (t−Tf), Yf () before the stored inter-vehicle time Tf to the preceding vehicle are stored. The difference Lw from t−Tf)) is obtained by the following equation (8), and it is determined whether or not it is smaller than the road width W by the equation (9). When Lw is smaller than W, it is determined that the preceding vehicle exists on the own lane, and becomes a candidate for the preceding vehicle when calculating the curve diameter.
[Equation 5]
The curve diameter estimating means 3 estimates the curve diameter based on the distance and direction between the preceding vehicle determined as the preceding vehicle traveling on the own lane by the preceding
[0057]
This curve diameter estimation method will be described with reference to FIGS.
FIG. 11 shows a scene in which the preceding vehicle, the preceding
[0058]
It is assumed that the preceding vehicle is captured at angle θ1, distance L1, the preceding
[Formula 6]
X1 = L1sin θ1 (10)
Y1 = L1 cos θ1 (11)
X2 = L2sin θ2 (12)
Y2 = L2 cos θ2 (13)
X3 = L3sin θ3 (14)
Y3 = L3 cos θ3 (15)
It becomes.
[0059]
As shown in FIG. 12B, the equation of the circle is as follows: R is the curve curvature and (a, b) is the center coordinate of the circle.
[Expression 7]
(X-a)2+ (Y−b)2= R2 ... (16)
It becomes. Therefore, the road curvature R can be obtained by substituting the coordinates of the three preceding vehicles (10) to (15) into the equation (16) and solving the simultaneous equations.
[0060]
In the method of estimating the curve diameter shown in FIG. 11 and FIG. 12, the curve diameter R is obtained from the traveling positions of the three preceding vehicles by utilizing the property of a circle that the curvature R is determined when three points are determined. In the present invention, the curve diameter can also be estimated using the traveling positions of the two preceding vehicles and the host vehicle.
[0061]
FIG. 13 shows a scene in which the preceding vehicle, the preceding
[0062]
As shown in FIGS. 13 and 14, it is assumed that the preceding vehicle is captured at an angle θ1 and a distance L1, and the preceding
[0063]
Thus, even when there are two preceding vehicles, it is possible to estimate the forward curve diameter. However, in this method, the host vehicle is also on a circle with a radius of curvature R, and therefore, in order to accurately estimate the forward curve diameter, use three preceding vehicles as shown in FIGS. 11 and 12 above. Is more preferable.
[0064]
The host vehicle travel route detection means 24, the preceding vehicle travel route detection means 25, the preceding vehicle determination means 26, and the curve diameter estimation means 3 are constituted by microcomputer software.
[0065]
Next, the operation will be described.
FIG. 15 is a flowchart showing the main operation in the present embodiment. First, in
[0066]
The own vehicle travel
[0067]
The preceding vehicle discrimination means 26 on the own lane compares the traveling route of the own vehicle with the traveling route of the preceding vehicle using the above-described equations (7) to (9), and the preceding vehicle exists on the own lane. It is determined whether or not to do so. The above determination is performed on all captured preceding vehicles, as shown in
[0068]
The curve diameter estimating means 3 estimates the forward curve diameter in accordance with the above-described equations (10) to (16) in
[0069]
As described above, the curve diameter estimation device according to the present embodiment is configured to estimate the forward curve diameter using the distance and direction from the own vehicle to two or more preceding vehicles traveling on the own lane. Therefore, the front curve road can be recognized even on a curve road without a reflector.
[0070]
The curve diameter estimation apparatus of this embodiment can be used for an inter-vehicle distance warning device and an inter-vehicle distance control device, and in this case, the recognition accuracy of the preceding vehicle is remarkably increased. Further, since the existence of the curve can be recognized with high accuracy, it is possible to prevent a false alarm of the inter-vehicle distance alarm device. The curve diameter estimation device of the present embodiment can also be used for a vehicle speed control device, and in this case, deceleration control at the entrance of the curve is possible. Furthermore, the curve diameter estimation device of the present embodiment can also be used for a vehicle speed alarm device, and can detect an excessive speed state at the curve entrance and issue an alarm.
[0071]
Second embodiment
In the first embodiment described above, the curve diameter estimating method in the curve diameter estimating means 3 uses three preceding vehicles or two preceding vehicles and the host vehicle. This is a method of selecting a preceding vehicle and estimating the curve diameter from the travel route of the preceding vehicle. Therefore, only the software configuration of the curve diameter estimating means 3 is different from the first embodiment.
[0072]
The basic configuration of the curve diameter estimating apparatus is the same as that of the first embodiment shown in FIG. 1 and detailed description thereof is omitted. However, as the distance
[0073]
The curve diameter estimation means 3 of the present embodiment estimates the forward curve diameter from the travel route (Xf (t), Yf (t)) of the preceding vehicle traveling on the own lane. Specifically, three coordinate positions are extracted at predetermined time intervals from the time function (Xf (t), Yf (t)) of the travel route of the preceding vehicle traveling on the own lane. This is obtained using FIG. 10 and the above equations (5) and (6). The road curvature R is obtained by substituting the three coordinate positions thus obtained for the equation (16) and solving the simultaneous equations.
[0074]
In the present embodiment, the use of the travel route of the preceding
[0075]
Next, the operation will be described.
FIG. 16 is a flowchart showing the operation of this embodiment. First, in
[0076]
The own vehicle travel
[0077]
The preceding vehicle discrimination means 26 on the own lane compares the traveling route of the own vehicle with the traveling route of the preceding vehicle using the above-described equations (7) to (9), and the preceding vehicle exists on the own lane. It is determined whether or not to do so. The above determination is performed for all captured preceding vehicles, as shown in
[0078]
The curve diameter estimating means 3 estimates the forward curve diameter in step 17 using the data of the travel route of the preceding vehicle on the own lane. As shown in
[0079]
As described above, the curve diameter estimation apparatus according to the present embodiment estimates the forward curve diameter R using the travel route (Xf (t), Yf (t)) of the preceding vehicle traveling on the own lane from the own vehicle. Thus, as in the first embodiment, a forward curved road can be recognized even on a curved road without a reflector. In particular, according to the present embodiment, it is possible to recognize a forward curve road even when there are not two or more preceding vehicles.
[0080]
Third embodiment
This embodiment uses the curve diameter estimation device of the first embodiment or the second embodiment described above to select a preceding vehicle on the own lane from an estimated value of the curve diameter and a travel route of the preceding vehicle. It is a dispensing device.
[0081]
As shown in FIG. 2, the target preceding vehicle detection device of this embodiment is obtained by adding preceding vehicle selection means 4 to the curve diameter estimation device of the first embodiment, and is configured by software of a microcomputer.
Since the distance
[0082]
The preceding vehicle selection means 4 of the present embodiment takes in the estimated value of the curve diameter R obtained by the curve diameter estimation means 3, and outputs a signal for selecting the preceding vehicle based on this curve diameter to the outside. The method of estimating the curve diameter is any of the method using the coordinates of two or more preceding vehicles on the own lane shown in the first embodiment, or the method using the travel route of the traveling vehicle on the own lane shown in the second embodiment. But it ’s okay.
[0083]
Using this curve diameter R, the preceding vehicle selection means 4 calculates the beam angle θ according to the curve diameter R by, for example, equation (17), and detects the preceding vehicle by changing the irradiation angle of the light beam. (Step 6).
[Equation 8]
θ = C / R (C: constant) (17)
[0084]
Since the target preceding vehicle detection device of this embodiment detects the target preceding vehicle using the estimated value of the curve diameter, the recognition accuracy of the preceding vehicle is improved.
[0085]
Fourth embodiment
The above-described curve diameter estimation devices of the first and second embodiments and the target preceding vehicle detection device of the third embodiment are based on the traveling angle of the host vehicle and the preceding vehicle based on the steering angle φ, the traveling time t, and the vehicle speed V. However, in this embodiment, the travel routes of the host vehicle and the preceding vehicle are determined using the left and right wheel speeds of the host vehicle.
[0086]
That is, as shown in FIG. 3, the target vehicle discriminating means 2 is provided with left and right wheel
The left and right wheel speed detection means 27 detects the left wheel speed Vl and the right wheel speed Vr and sends them to the host vehicle travel path detection means 24 and the preceding vehicle travel path detection means 25, respectively.
[0087]
Then, the host vehicle travel route detection means 24 uses the left wheel speed Vl and the right wheel speed Vr to obtain the average vehicle speed V by the following equation (18).
[Equation 9]
V = (Vl + Vr) / 2 (18)
[0088]
Further, the road curvature R is obtained by the following equation (19) instead of the equation (2).
[Expression 10]
R = V · Tt / (Vl−Vr) (19)
However, Tt is a tread.
[0089]
Since the vehicle speed V is obtained from the equation (18) and the road curvature R is obtained from the equation (19), these are substituted into the above equation (1) to determine the traveling direction ψ of the host vehicle. By substituting into the equation (4), the travel route (X (t), Y (t)) of the host vehicle is obtained.
[0090]
On the other hand, the preceding vehicle travel route detection means 25 uses the left wheel speed Vl and the right wheel speed Vr from the left and right wheel speed detection means 27 to determine the vehicle speed V and the traveling direction ψ of the host vehicle according to the above-described procedure. The driving route (Xf (t), Yf (t)) of the preceding vehicle is determined by substituting the distance L from the direction detection means 1 and the direction θ into the above equations (5) and (6).
[0091]
Since the following procedure is the same as that of the first embodiment, the description thereof will be omitted. However, according to the present embodiment, the travel route of the host vehicle and the preceding vehicle is detected from the left and right wheel speed sensors. The influence of inclination and steering play is reduced, and the detection accuracy of the road curvature R is improved.
[0092]
Fifth embodiment
The curve diameter estimation device and the target preceding vehicle detection device of the present invention can be further modified. In this embodiment, instead of the steering angle detection means 21, the time measurement means 22 and the vehicle speed detection means 23 of the first to third embodiments and the left and right wheel speed detection means 27 of the fourth embodiment, the yaw rate detection means 28 and the vehicle speed detection.
[0093]
The yaw rate of the host vehicle detected by the yaw
[0094]
Then, the host vehicle travel route detection means 24 uses the yaw rate η and the vehicle speed V instead of the above equation (2) to obtain the road curvature R from the following equation (20).
## EQU11 ##
R = V / η (20)
[0095]
Since the road curvature R is obtained from the equation (20), these are substituted into the above equation (1) to obtain the traveling direction ψ of the host vehicle, and this ψ is substituted into the above equations (3) and (4). Thus, the travel route (X (t), Y (t)) of the host vehicle is obtained.
[0096]
On the other hand, the preceding vehicle travel route detection means 25 uses the yaw rate η and the vehicle speed V from the yaw rate detection means 28 to determine the traveling direction ψ of the host vehicle according to the procedure described above, and the distance L from the distance direction detection means 1. By substituting into the above equations (5) and (6) together with the direction θ, the travel route (Xf (t), Yf (t)) of the preceding vehicle is obtained.
[0097]
Since the following procedure is the same as that in the first embodiment, the description thereof will be omitted. However, according to this embodiment, since the travel route is detected from the yaw rate sensor, there is no influence of tire wear, and the road curvature R The detection accuracy will be improved.
[0098]
Each embodiment described above is described in order to facilitate understanding of the present invention, and is not described in order to limit the present invention. Therefore, each element disclosed in the above embodiment is intended to include all design changes and equivalents belonging to the technical scope of the present invention.
[Brief description of the drawings]
FIG. 1 is a block diagram showing first and second embodiments (vehicle curve diameter estimating apparatus) of the present invention.
FIG. 2 is a block diagram showing a third embodiment (target preceding vehicle detection device) of the present invention.
FIG. 3 is a block diagram showing a fourth embodiment (target preceding vehicle detection device) of the present invention.
FIG. 4 is a block diagram showing a fifth embodiment (target preceding vehicle detection device) of the present invention.
FIG. 5 is a cross-sectional view showing an embodiment (scanning radar apparatus) of a distance direction detecting means according to the present invention.
FIG. 6 is a cross-sectional view showing another embodiment (scanning radar apparatus) of a distance direction detecting means according to the present invention.
FIG. 7 is a cross-sectional view showing another embodiment (multi-radar apparatus) of the distance direction detecting means according to the present invention.
FIG. 8 is a cross-sectional view showing another embodiment (multi-radar apparatus) of the distance direction detecting means according to the present invention.
FIG. 9 is a schematic diagram for explaining how to determine the travel route of the host vehicle in the host vehicle travel route detecting means according to the present invention.
FIG. 10 is a schematic diagram for explaining how to determine the travel route of the preceding vehicle in the preceding vehicle travel route detection means according to the present invention.
FIG. 11 is a schematic diagram for explaining how to obtain the curve diameter in the curve diameter estimating means according to the present invention.
FIG. 12 is a schematic diagram for explaining how to obtain the curve diameter in the curve diameter estimating means according to the present invention.
FIG. 13 is a schematic diagram for explaining another method of obtaining the curve diameter in the curve diameter estimating means according to the present invention.
FIG. 14 is a schematic diagram for explaining another method of obtaining the curve diameter in the curve diameter estimating means according to the present invention.
FIG. 15 is a flowchart for explaining a method of obtaining a curve diameter (first embodiment) in a curve diameter estimating means according to the present invention.
FIG. 16 is a flowchart for explaining another method of obtaining the curve diameter (second embodiment) in the curve diameter estimating means according to the present invention.
FIG. 17 is a flowchart showing a procedure for detecting a preceding vehicle in the target preceding vehicle detection device shown in FIG. 2;
FIG. 18 is a schematic diagram for explaining a problem of a conventional vehicle curve diameter estimating apparatus.
[Explanation of symbols]
1 Distance direction detection means
11: Transmitting element
12 ... Transmission lens
13 ... Receiving lens
14: Receiving element
2 ... Target vehicle discrimination means
21 ... Steering angle detection means
22 Time measuring means
23. Vehicle speed detecting means
24. Own vehicle travel route detection means
25. Preceding vehicle travel route detection means
26 ... preceding vehicle discrimination means
27: Left and right wheel speed detection means
28 ... Yaw rate detection means
3 ... Curve diameter estimation means
4 ... preceding vehicle selection means
Claims (7)
自車両の走行経路と前記距離方向検出手段で検出された距離および方向とに基づいて、前記先行車両が自車線上を走行する先行車両か他車線上を走行する先行車両かを判別する対象車両判別手段と、
前記対象車両判別手段で自車線上を走行する先行車両と判別された先行車両と自車両との距離および方向に基づいて、カーブ径を推定するカーブ径推定手段とを備え、
前記カーブ径推定手段は、自車線上を走行する２台以上の先行車両と自車両との距離および方向に基づいて、カーブ径を推定することを特徴とする車両用カーブ径推定装置。Distance direction detection means for detecting the distance and direction from the host vehicle to the preceding vehicle;
A target vehicle for discriminating whether the preceding vehicle is a preceding vehicle traveling on the own lane or a preceding vehicle traveling on another lane based on the traveling route of the own vehicle and the distance and direction detected by the distance direction detecting means. Discrimination means;
Curve diameter estimating means for estimating a curve diameter based on the distance and direction between the preceding vehicle determined to be the preceding vehicle traveling on the own lane by the target vehicle determining means and the own vehicle;
The curve diameter estimation device for a vehicle, wherein the curve diameter estimation means estimates a curve diameter based on a distance and direction between two or more preceding vehicles traveling on the own lane and the own vehicle.
前記自車両のステアリング角度を検出するステアリング角度検出手段と、
走行時間を計測する時間計測手段と、
前記自車両の車速を検出する車速検出手段と、
前記ステアリング角度検出手段、前記時間計測手段および前記車速検出手段でそれぞれ検出されたステアリング角度、走行時間および車速に基づいて、前記自車両の走行経路を検出する自車両走行経路検出手段と、
前記ステアリング角度検出手段、前記時間計測手段、前記車速検出手段および前記距離方向検出手段でそれぞれ検出されたステアリング角度、走行時間、車速および前記先行車両までの距離と方向に基づいて、前記先行車両の走行経路を検出する先行車両走行経路検出手段と、
前記自車両走行経路検出手段および前記先行車両走行経路検出手段でそれぞれ検出された前記自車両の走行経路および前記先行車両の走行経路に基づいて、自車線上を走行する先行車両を特定する先行車両判別手段とを有することを特徴とする請求項１記載の車両用カーブ径推定装置。 The target vehicle discrimination means is
Steering angle detection means for detecting the steering angle of the host vehicle;
Time measuring means for measuring travel time;
Vehicle speed detection means for detecting the vehicle speed of the host vehicle;
A host vehicle travel route detection unit that detects a travel route of the host vehicle based on a steering angle, a travel time, and a vehicle speed detected by the steering angle detection unit, the time measurement unit, and the vehicle speed detection unit;
Based on the steering angle, travel time, vehicle speed, and distance and direction to the preceding vehicle detected by the steering angle detecting means, the time measuring means, the vehicle speed detecting means, and the distance direction detecting means, respectively, Preceding vehicle travel route detection means for detecting the travel route;
A preceding vehicle that identifies a preceding vehicle traveling on the own lane based on the traveling route of the own vehicle and the traveling route of the preceding vehicle detected by the own vehicle traveling route detection unit and the preceding vehicle traveling route detection unit, respectively. The vehicle curve diameter estimation apparatus according to claim 1 , further comprising a determination unit.
前記自車両の左右の車輪速を検出する左右車輪速検出手段と、
走行時間を計測する時間計測手段と、
前記左右車輪速検出手段および前記時間計測手段でそれぞれ検出された自車両の左右の車輪速の差および走行時間に基づいて、前記自車両の走行経路を検出する自車両走行経路検出手段と、
前記左右車輪速検出手段、前記時間計測手段および前記距離方向検出手段でそれぞれ検出された前記自車両の左右の車輪速の差、走行時間および前記先行車両までの距離と方向とに基づいて、前記先行車両の走行経路を検出する先行車両検出手段と、
前記自車両走行経路検出手段および前記先行車両走行経路検出手段でそれぞれ検出された前記自車両の走行経路および前記先行車両の走行経路に基づいて、自車線上を走行する先行車両を特定する先行車両判別手段とを有することを特徴とする請求項１記載の車両用カーブ径推定装置。 The target vehicle discrimination means is
Left and right wheel speed detection means for detecting left and right wheel speeds of the host vehicle;
Time measuring means for measuring travel time;
A host vehicle travel route detection unit for detecting a travel route of the host vehicle based on a difference between the left and right wheel speeds of the host vehicle detected by the left and right wheel speed detection unit and the time measurement unit and a travel time;
Based on the difference between the left and right wheel speeds of the own vehicle detected by the left and right wheel speed detection means, the time measurement means and the distance direction detection means, the travel time and the distance and direction to the preceding vehicle, Preceding vehicle detection means for detecting the travel route of the preceding vehicle;
A preceding vehicle that identifies a preceding vehicle traveling on the own lane based on the traveling route of the own vehicle and the traveling route of the preceding vehicle detected by the own vehicle traveling route detection unit and the preceding vehicle traveling route detection unit, respectively. The vehicle curve diameter estimation apparatus according to claim 1 , further comprising a determination unit.
前記自車両のヨーレイトを検出するヨーレイト検出手段と、
走行時間を計測する時間計測手段と、
前記自車両の車速を検出する車速検出手段と、
前記ヨーレイト検出手段、前記時間計測手段および前記車速検出手段でそれぞれ検出された自車両のヨーレイト、走行時間および自車両の車速に基づいて、前記自車両の走行経路を検出する自車両走行経路検出手段と、
前記ヨーレイト検出手段、前記時間計測手段、前記車速検出手段および前記距離方向検出手段でそれぞれ検出された自車両のヨーレイト、走行時間、自車両の車速および前記先行車両までの距離と方向に基づいて、前記先行車両の走行経路を検出する先行車両走行経路検出手段と、
前記自車両走行経路検出手段および前記先行車両走行経路検出手段でそれぞれ検出された前記自車両の走行経路および前記先行車両の走行経路に基づいて、自車線上を走行する先行車両を特定する先行車両判別手段とを有することを特徴とする請求項１記載の車両用カーブ径推定装置。 The target vehicle discrimination means is
Yaw rate detecting means for detecting the yaw rate of the host vehicle;
Time measuring means for measuring travel time;
Vehicle speed detection means for detecting the vehicle speed of the host vehicle;
Own vehicle travel route detection means for detecting the travel route of the host vehicle based on the yaw rate, travel time, and vehicle speed of the host vehicle detected by the yaw rate detection unit, the time measurement unit, and the vehicle speed detection unit, respectively. When,
Based on the yaw rate of the host vehicle, the running time, the vehicle speed of the host vehicle, and the distance and direction to the preceding vehicle detected by the yaw rate detecting unit, the time measuring unit, the vehicle speed detecting unit, and the distance direction detecting unit, respectively. Preceding vehicle travel route detecting means for detecting the travel route of the preceding vehicle;
A preceding vehicle that identifies a preceding vehicle traveling on the own lane based on the traveling route of the own vehicle and the traveling route of the preceding vehicle detected by the own vehicle traveling route detection unit and the preceding vehicle traveling route detection unit, respectively. The vehicle curve diameter estimation apparatus according to claim 1 , further comprising a determination unit.
前記車両用カーブ径推定装置の前記カーブ径推定手段で求められたカーブ径推定値に基づいて、自車線上を走行する先行車を選定する先行車選定手段とを備えたことを特徴とする目標先行車検出装置。A vehicle curve diameter estimating device according to any one of claims 1 to 6 ,
A target vehicle selecting means for selecting a preceding vehicle traveling on the own lane based on the curve diameter estimated value obtained by the curve diameter estimating means of the vehicle curve diameter estimating device; Leading vehicle detection device.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP12409496A JP3653862B2 (en) | 1996-04-22 | 1996-04-22 | Vehicle curve diameter estimation device and target preceding vehicle detection device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP12409496A JP3653862B2 (en) | 1996-04-22 | 1996-04-22 | Vehicle curve diameter estimation device and target preceding vehicle detection device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH09288179A JPH09288179A (en) | 1997-11-04 |
| JP3653862B2 true JP3653862B2 (en) | 2005-06-02 |
Family
ID=14876782
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP12409496A Expired - Fee Related JP3653862B2 (en) | 1996-04-22 | 1996-04-22 | Vehicle curve diameter estimation device and target preceding vehicle detection device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3653862B2 (en) |
Families Citing this family (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2003536096A (en) * | 2000-06-08 | 2003-12-02 | オートモーティブ システムズ ラボラトリー インコーポレーテッド | Tracking map generator |
| JP3946479B2 (en) * | 2001-09-28 | 2007-07-18 | 本田技研工業株式会社 | Automotive radar equipment |
| US6826479B2 (en) * | 2002-06-03 | 2004-11-30 | Visteon Global Technologies, Inc. | Method and apparatus for target vehicle identification in automatic cruise control and collision avoidance systems |
| JP4984082B2 (en) * | 2008-03-27 | 2012-07-25 | トヨタ自動車株式会社 | Object detection device, entrainment accident prevention system, and entrainment prevention device |
| JP5370318B2 (en) * | 2010-09-13 | 2013-12-18 | 株式会社デンソー | Idling stop control device |
| DE102012204441A1 (en) | 2011-03-21 | 2012-09-27 | Denso Corporation | Method and device for detecting a course of a road for vehicles |
| JP2012242936A (en) * | 2011-05-17 | 2012-12-10 | Denso Corp | Vehicular road shape recognition method and device and recording medium |
| KR102435550B1 (en) * | 2015-06-09 | 2022-08-24 | 주식회사 에이치엘클레무브 | Apparatur for processing signal of radar and method for processing signal thereof |
| CN113050993A (en) | 2019-12-27 | 2021-06-29 | 中兴通讯股份有限公司 | Laser radar-based detection method and device and computer-readable storage medium |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6326590A (en) * | 1986-07-18 | 1988-02-04 | Nissan Motor Co Ltd | Measuring instrument for vehicle-to-vehicle distance |
| JP2973544B2 (en) * | 1991-03-08 | 1999-11-08 | 日産自動車株式会社 | Scanning radar |
| JP3134275B2 (en) * | 1991-06-19 | 2001-02-13 | オムロン株式会社 | Distance measuring device and collision warning system |
| JP2803393B2 (en) * | 1991-07-02 | 1998-09-24 | トヨタ自動車株式会社 | Automotive radar equipment |
| JPH06282798A (en) * | 1993-03-30 | 1994-10-07 | Fujitsu Ten Ltd | Target searching device and alarm device and automatic tracking device using the same |
| JP2799375B2 (en) * | 1993-09-30 | 1998-09-17 | 本田技研工業株式会社 | Anti-collision device |
| JP3235330B2 (en) * | 1994-03-25 | 2001-12-04 | 株式会社デンソー | Vehicle obstacle warning device |
| SE516317C2 (en) * | 1994-06-07 | 2001-12-17 | Saabtech Electronics Ab | Procedure for determining the lane of a vehicle ahead |
| JP3465435B2 (en) * | 1995-09-11 | 2003-11-10 | 日産自動車株式会社 | Target preceding vehicle detection device |
-
1996
- 1996-04-22 JP JP12409496A patent/JP3653862B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH09288179A (en) | 1997-11-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP3658519B2 (en) | Vehicle control system and vehicle control device | |
| US6166628A (en) | Arrangement and method for detecting objects from a motor vehicle | |
| JPH1194946A (en) | Obstacle recognition device for vehicle | |
| JPS61278775A (en) | Preceding vehicle detecting device | |
| JPH11203588A (en) | Vehicle type discriminating device | |
| JP2910377B2 (en) | Radar equipment for vehicles | |
| JPH07225276A (en) | Optical radar apparatus for vehicle | |
| JP2007304034A (en) | On-board device for discriminating road shape | |
| JPH09159757A (en) | On-vehicle radar device | |
| JP3519617B2 (en) | Control target sorting device | |
| JP3653862B2 (en) | Vehicle curve diameter estimation device and target preceding vehicle detection device | |
| JP2002175599A (en) | Lane position estimating device for precedent vehicle or target | |
| JPH09178857A (en) | Device for measuring interval between vehicles | |
| JPH07100426B2 (en) | Rear-end collision warning system for vehicles | |
| GB2358975A (en) | Motor vehicle trajectory measurement | |
| JP2973544B2 (en) | Scanning radar | |
| JPH05288847A (en) | Approach detection apparatus | |
| JPH11144198A (en) | Object identifying device for vehicle | |
| JP3465435B2 (en) | Target preceding vehicle detection device | |
| JPH06148329A (en) | Vehicular gap detection apparatus | |
| JPH08240658A (en) | Radar apparatus | |
| JPH11167699A (en) | Object recognizing device for vehicle | |
| JPH05113482A (en) | Rear end collision prevention device mounted on car | |
| JPH10160486A (en) | Apparatus for detecting position of vehicle | |
| JPH02137100A (en) | Elevated express-highway travelling recognition device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20040115 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040127 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20040326 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20040713 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20040913 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20050208 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050221 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090311 Year of fee payment: 4 |
|
| LAPS | Cancellation because of no payment of annual fees |