JPH09147299A - カーブ路判定装置 - Google Patents
カーブ路判定装置Info
- Publication number
- JPH09147299A JPH09147299A JP7307509A JP30750995A JPH09147299A JP H09147299 A JPH09147299 A JP H09147299A JP 7307509 A JP7307509 A JP 7307509A JP 30750995 A JP30750995 A JP 30750995A JP H09147299 A JPH09147299 A JP H09147299A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- traveling
- value
- curved road
- yaw rate
- 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.)
- Granted
Links
Landscapes
- Traffic Control Systems (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
であるかを確実に判定できるカーブ路判定装置を提供す
る。 【解決手段】走行中の車両の角速度ωを検出するヨーレ
ートセンサを備え、角速度ωを基に車両のカーブ路走行
状態を判定するカーブ路判定装置において、車両の走行
速度Vを検出する車速センサと、角速度ωの積分値θを
算出する積分値算出手段と、車速センサの出力Vと積分
値θを基に、車両の進行方向に対して垂直な方向の移動
量Xを算出する移動量算出手段と、移動量算出手段によ
り算出された移動量Xと、車両の走行レーンの幅に相当
する値Wとを比較する比較手段と、比較手段が、移動量
Xが車両の走行道路の幅に相当するWより大きいことを
検出した時に、車両がカーブ路走行状態であると判定す
るカーブ路判定手段により構成される。
Description
ーダ追尾装置等に利用されるカーブ路の判定装置に係
り、特に、カーブ路走行と車線変更とが明確に区分でき
るカーブ路判定装置に関する。
の前方に向けて照射して、その反射波から前車の走行速
度及び前車までの距離(車間距離)を算出するミリ波レ
ーダ装置がある。その際、道路(以下、走行レーンと称
する)が直線ではなく、カーブしている場合には、走行
レーンのカーブ路の曲率半径に対応して電波(ビーム)
の照射方向を調整しなければ、前車を的確に捕捉するこ
とができない。そこで、車両にカーブ路を走行する時に
生ずる角速度ωを検出するヨーレートセンサを設置し
て、カーブ路走行時におけるヨーレートセンサの出力ω
と車速Vを基に道路の曲率半径Rを算出して、ビームの
照射方向を制御している。
ーブだけでなく、車線変更、道路上の障害物を避けるた
め等でハンドル操作が常に行われている。カーブ路を走
行中の時には前車を追尾するためにビームの照射方向を
変更する必要があるが、一時的な車線変更、道路上の障
害物を避ける時には、その都度ビームの照射方向を調整
する必要はない。そこで、ヨーレートセンサの出力ωが
走行レーンのカーブによるものか否かを判定することが
重要になる。
変動しているので、ヨーレートセンサの出力ωにしきい
値を設定して、その値を超えた状態が所定時間以上継続
した時には車線変更ではなく、走行レーンがカーブして
いると判定していた。
がゆっくりと車線変更を行った場合にはカーブ路と区別
できないために、しきい値(判定レベル)を高めに設定
する必要があった。そのために、走行レーンがカーブし
ているにもかかわらず、しきい値の大小によってはカー
ブ路が検出できないか、または、検出するのが遅れると
いうことが生ずる。特に、低速走行中には、その影響が
大きく問題になる。
車両がカーブ路を走行中か車線変更かを早期に確実に判
定できるカーブ路判定装置を提供することを目的とす
る。
に本発明は、走行中の車両の角速度ωを検出するヨーレ
ートセンサを備え、前記ヨーレートセンサから出力され
る前記角速度ωを基に前記車両のカーブ路走行状態を判
定するカーブ路判定装置において、前記車両の走行速度
Vを検出する車速センサと、前記角速度ωの積分値θを
算出する積分値算出手段と、前記車速センサの出力Vと
前記積分値θを基に、前記車両の進行方向に対して垂直
な方向の移動量Xを算出する移動量算出手段と、前記移
動量算出手段により算出された移動量Xと、前記車両の
走行道路の幅に相当する値Wとを比較する比較手段と、
前記比較手段が、前記移動量Xが前記車両の走行道路の
幅に相当するWより大きいことを検出した時に、前記車
両がカーブ路走行状態であると判定するカーブ路判定手
段を備えたことを特徴とするものである。
と、又は前記積分値θが所定時間一定値にあることを検
出すると、前記積分値算出手段に対し積分値をリセット
させ、再び積分値θの算出を開始させるリセット手段を
設けたことを特徴とするものである。
の動作原理を説明するための図である。以下、図を用い
てカーブ路判定装置の動作原理について述べる。A点の
車両9が一定の角速度ωでカーブ路を走行してB点に移
動した状態について考えると、カーブ路半径R(m)、
その間の角度変化θと車両9の進行方向に対して垂直な
方向の移動量Xとの関係は(1)式のごとくなる。
あるから、 R=Vt/θ・・・・・・・・・・・(2)式 となる。但し、R:カーブ路半径(m) θ:角度変化(ラジアン) V:車速(m/sec) X:車両の進行方向に対して垂直の方向の移動量(m) 以上の(1)式、(2)式より X=(2Vt/θ)×sin2 (θ/2)・・・・(3)式 この車両の進行方向に対して垂直の方向の移動量Xが道
路幅Wより大きいと走行レーンの変更ではなく、カーブ
路を走行中であると判定できる。
カーブ路を走行中であると判定する。尚、道路幅Wは高
速道路等に基づいて定められた値を予めROM等に記憶
しておくか、ナビゲーションの地図データあるいは外部
からの通信データに基づいてリアルタイムに設定されて
もよい。
置のシステム構成を示す図である。以下、図を用いて説
明する。1は走行中の車両の角速度ωを計測するヨーレ
ートセンサで、角速度により生ずる素子の歪を検出す
る。2は車軸等に連結され車速Vを計測する速度センサ
である。3はミリ波レーダ信号処理ECUで、ヨーレー
トセンサ1、車速センサ2、ミリ波レーダセンサ51か
らの信号を基にビームの照射方向を算出してビームステ
アECU53に出力し、ビームステア52に照射角を制
御する。また、これとは別にミリ波レーダで得たビート
信号に基づいて、前車との相対距離及び相対速度のデー
タを算出し、これらデータをクルーズECU6へ出力す
る。6はミリ波レーダ信号処理ECU3の出力を基に前
車との相対位置を維持するようにスロットルアクチュエ
ータ7を調整して車速を制御するためのクルーズECU
である。
積分するヨーレート値積分手段である。32は車両がカ
ーブ路を走行することによる回転半径の方向(即ち、車
両の進行方向に垂直な成分)の移動量Xを算出する移動
量X算出手段である。33はカーブ路走行か車線変更か
を判定する基準となる基準値(車線幅W+余裕値α)を
記憶したメモリである。34は車両の垂直方向の移動量
Xと基準値(W+α)を比較してカーブ路を走行中か否
かを判定する比較器である。尚、ヨーレート値積分手段
31、移動量X算出手段32、メモリ33、比較器34
及びリセット手段35はミリ波レーダ信号処理ECU3
内に含まれ、CPU(中央処理装置)、ROM(リード
オンリメモリ)、RAM(ランダムアクセスメモリ)に
よって構成される。従って、このミリ波レーダ信号処理
ECU3の処理はソフトで行われる。
は常にヨーレートセンサ1からカーブ路に対応した角速
度ωが出力されており、その出力ωはヨーレート値積分
手段31に入力されて車両の角度変化θが算出される。
一方、車速センサ2からの出力Vを基に、移動量X算出
手段32が(3)式により車両の進行方向に垂直な方向
の移動量Xを算出して比較器34に出力する。比較器3
4は移動量Xと予めメモリ33に記憶されている基準値
(W+α)と比較して移動量Xの方が大きい時には、車
両はカーブ路を走行中であると判定してカーブ路検出信
号を出力する。尚、片側3車線以上ある広い道路で2車
線分を一度に車線変更する場合を想定して、そのような
道路では余裕値αを大きく設定する等の方法で対処すれ
ばよい。
U53に送られる。カーブ路と判定されるとビームステ
アECU53は(2)式を基にカーブ路の曲率半径Rを
算出し、対応したビーム照射角度を算出してビームステ
ア52にビームの照射角を変更させる。図3の本発明の
一実施例のカーブ路判定装置の移動量Xの算出期間を説
明するための図で、(a)は車線内の車両の位置を示す
図、(b)は時間と瞬間ヨーレート値の関係を示す図、
(c)は時間と積分ヨーレート値の関係を示す図であ
る。以下、図を用いて説明する。
ーンを走行中の車両が右側の走行レーンに車線変更して
B点に到達した場合には、ヨーレートセンサ1からの出
力は図3(b)のごとく時刻taから時間tとともに最
初は+側(左側)に変化し、その後、ヨーレート値が0
になる点(時刻tb)を通過して−側(右側)へとヨー
レート値が変化する。そして、完全に車線変更が完了し
て右側の走行レーンに移った時刻tcには、ヨーレート
値は再び0になる。
ば、図3(c)のごとく時刻taから時間tとともに上
昇し、時刻tbで最大となり、車線変更が完了した時刻
tcでは再び0になる。即ち、車線変更では車両の方向
は車線変更の前後では変化しない。尚、車線変更に限ら
ず障害物を避けて走行した場合でも、その前後でヨーレ
ート値の積分値は同様に0になる。結局、時刻taから
tbの間では移動量Xは道路幅Wより大きくならず、カ
ーブ路走行とは認定されずに再び0から算出が開始され
る。
の移動量Xを算出するに際して、その開始条件は車両が
直進状態にあると判定される時点(ヨーレート値ωが0
である時間が所定時間t1 継続した)td、または、ヨ
ーレート値の積分値が0になった時点ta、tc(tc
は終了条件と同時に次の開始条件でもある)となる。ま
た、終了条件はヨーレート値の積分値が再度0になった
時点tcとすることにより、車線変更等小さなハンドル
操作を繰り返しその間のヨーレート値の積分値が0とな
ると、その時点で移動量Xがその都度クリアされるの
で、移動量Xは道路幅W(またはW+α)より大きくな
らずカーブ路とは判定されない。一方、カーブ路走行中
ではヨーレート値の積分値がいつまでも0にならないの
で積分期間が長くなり、その結果、移動量Xが大きくな
りカーブ路を走行していると判定される。
合には、移動量Xの算出を図3(a)のB点より開始し
て、移動量Xが道路幅W(またはW+α)を超えた時点
(C点)で、ヨーレートω値の積分値が再度0に戻って
いなくてもカーブ路と判定される。しかし、カーブ路ま
たは交差点等で車両が曲がった後直進するような場合に
は、ヨーレート値ωが0になっても車両の方向が変化し
ているのでヨーレート値ωの積分値が0に復帰せず、次
の移動量Xの算出が開始できない。そこで、リセット手
段35はヨーレート値ωが0になっている時間が所定時
間t2 継続した時点(あるいは積分値θが0でない一定
値のままt2 継続した時点)teでカーブ路が終了した
と判定して、ヨーレート値ωの積分値θ及び積分時間t
をリセットする。そして、その時点teから次の移動量
Xの算出を開始する。尚、時点tbで積分値θ及び積分
時間tをリセットしてもよい。これによれば、車両の小
さな曲がり走行を抜ける毎にカーブ路判定がなされ、
(3)式に添った正確な処理を行うことができる(この
式では1つの円運動を基本としているため)。
向に対して垂直な方向の移動量を車線幅と比較して、移
動量が道路幅を超えた時点でカーブ路走行と判定するの
で、カーブ路の判定時期が早く、また、カーブ路走行か
車線変更かの判定が適切に行える。
ートセンサの出力を基に車両がカーブ路を走行中か車線
変更を正確に判定できるカーブ路判定装置を提供でき
る。その結果、車線変更またはカーブ路に対応した制御
が的確にできる。
理を説明するための図である。
ム構成を示す図である。
Xの算出期間を説明するための図で、(a)は車線内の
車両の位置を示す図、(b)は時間と瞬間ヨーレート値
の関係を示す図、(c)は時間と積分ヨーレート値の関
係を示す図である。
較器 2・・・・車速センサ 51・・・ミ
リ波レーダセンサ 3・・・・ミリ波レーダ信号処理ECU 52・・・ビ
ームステア 31・・・ヨーレート値積分手段 53・・・ビ
ームステアECU 32・・・移動量算出手段 6・・・・ク
ルーズECU 33・・・メモリ
Claims (2)
- 【請求項1】 走行中の車両の角速度ωを検出するヨー
レートセンサを備え、前記ヨーレートセンサから出力さ
れる前記角速度ωを基に前記車両のカーブ路走行状態を
判定するカーブ路判定装置において、 前記車両の走行速度Vを検出する車速センサと、 前記角速度ωの積分値θを算出する積分値算出手段と、 前記車速センサの出力Vと前記積分値θを基に、前記車
両の進行方向に対して垂直な方向の移動量Xを算出する
移動量算出手段と、 前記移動量算出手段により算出された移動量Xと、前記
車両の走行道路の幅に相当する値Wとを比較する比較手
段と、 前記比較手段が、前記移動量Xが前記車両の走行道路の
幅に相当するWより大きいことを検出した時に、前記車
両がカーブ路走行状態であると判定するカーブ路判定手
段を備えたことを特徴とするカーブ路判定装置。 - 【請求項2】 前記角速度ωが所定時間0にあること、
又は前記積分値θが所定時間一定値にあることを検出す
ると、前記積分値算出手段に対し積分値をリセットさ
せ、再び積分値θの算出を開始させるリセット手段を設
けたことを特徴とする請求項1記載のカーブ路判定装
置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP30750995A JP3209671B2 (ja) | 1995-11-27 | 1995-11-27 | カーブ路判定装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP30750995A JP3209671B2 (ja) | 1995-11-27 | 1995-11-27 | カーブ路判定装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH09147299A true JPH09147299A (ja) | 1997-06-06 |
JP3209671B2 JP3209671B2 (ja) | 2001-09-17 |
Family
ID=17969938
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP30750995A Expired - Fee Related JP3209671B2 (ja) | 1995-11-27 | 1995-11-27 | カーブ路判定装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3209671B2 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1260896A3 (en) * | 2001-05-16 | 2003-10-22 | Fujitsu Ten Limited | Method and apparatus for correcting a curve radius |
JP2004046783A (ja) * | 2001-12-20 | 2004-02-12 | Valeo Vision | 自動車の運転補助装置 |
WO2017017794A1 (ja) * | 2015-07-28 | 2017-02-02 | 日産自動車株式会社 | 走行制御装置の制御方法および走行制御装置 |
JPWO2017163368A1 (ja) * | 2016-03-24 | 2019-03-14 | 日産自動車株式会社 | 走路検出方法及び走路検出装置 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4069912B2 (ja) | 2004-08-19 | 2008-04-02 | 日産自動車株式会社 | 車両運動制御装置 |
-
1995
- 1995-11-27 JP JP30750995A patent/JP3209671B2/ja not_active Expired - Fee Related
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1260896A3 (en) * | 2001-05-16 | 2003-10-22 | Fujitsu Ten Limited | Method and apparatus for correcting a curve radius |
EP1762921A2 (en) * | 2001-05-16 | 2007-03-14 | Fujitsu Ten Limited | Method and apparatus for correcting a curve radius |
EP1762921A3 (en) * | 2001-05-16 | 2008-10-29 | Fujitsu Ten Limited | Method and apparatus for correcting a curve radius |
JP2004046783A (ja) * | 2001-12-20 | 2004-02-12 | Valeo Vision | 自動車の運転補助装置 |
WO2017017794A1 (ja) * | 2015-07-28 | 2017-02-02 | 日産自動車株式会社 | 走行制御装置の制御方法および走行制御装置 |
CN107924623A (zh) * | 2015-07-28 | 2018-04-17 | 日产自动车株式会社 | 行驶控制装置的控制方法及行驶控制装置 |
JPWO2017017794A1 (ja) * | 2015-07-28 | 2018-06-14 | 日産自動車株式会社 | 走行制御装置の制御方法および走行制御装置 |
US10259416B2 (en) | 2015-07-28 | 2019-04-16 | Nissan Motor Co., Ltd. | Travel control method and travel control apparatus |
JPWO2017163368A1 (ja) * | 2016-03-24 | 2019-03-14 | 日産自動車株式会社 | 走路検出方法及び走路検出装置 |
US10275666B2 (en) | 2016-03-24 | 2019-04-30 | Nissan Motor Co., Ltd. | Travel lane detection method and travel lane detection device |
Also Published As
Publication number | Publication date |
---|---|
JP3209671B2 (ja) | 2001-09-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3088281B1 (en) | Automatic driving vehicle system | |
EP0775919B1 (en) | A scan-type radar apparatus for a vehicle to accurately detect an object in a lane of the radar equipped vehicle | |
JP3045401B2 (ja) | 自動車の前方車道状況を確認する方法 | |
US7447577B2 (en) | Curve's radius estimation device | |
US6853884B2 (en) | Lane-keep control system for vehicle | |
JPH0378596B2 (ja) | ||
JPH1054875A (ja) | 車載走査型レーダ装置 | |
JPH0347209B2 (ja) | ||
JPH0342797B2 (ja) | ||
US8165797B2 (en) | Vehicular control object determination system and vehicular travel locus estimation system | |
JP2009059082A (ja) | 車両用物体検知装置 | |
JP3324325B2 (ja) | 車両前方監視装置 | |
JP4723220B2 (ja) | 通行方向認識方法および装置 | |
KR102192436B1 (ko) | 레이다 기반의 타겟 각도 결정 장치 및 방법 | |
JP4134885B2 (ja) | カーブ推定装置およびこれを用いた走行制御装置 | |
JP2002175599A (ja) | 先行車または物標の車線位置推定装置 | |
JPH04248489A (ja) | 車両用先行車検出装置 | |
JP2002296350A (ja) | 物体検知装置 | |
JP2004066912A (ja) | 車両用障害物検知装置 | |
JP3209671B2 (ja) | カーブ路判定装置 | |
JP3719691B2 (ja) | 車両認識装置 | |
JPH05238403A (ja) | 4輪操舵装置 | |
JP2000180537A (ja) | スキャン式レーダの制御対象物体識別方法 | |
JP4113334B2 (ja) | 先行車両認識方法及び装置 | |
JP3995311B2 (ja) | 車間距離制御システムにおけるターゲット認識方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20010626 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090713 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090713 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100713 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100713 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110713 Year of fee payment: 10 |
|
LAPS | Cancellation because of no payment of annual fees |