JP2006323472A - 車両用走行制御装置および送信波の照射制御方法 - Google Patents
車両用走行制御装置および送信波の照射制御方法 Download PDFInfo
- Publication number
- JP2006323472A JP2006323472A JP2005143886A JP2005143886A JP2006323472A JP 2006323472 A JP2006323472 A JP 2006323472A JP 2005143886 A JP2005143886 A JP 2005143886A JP 2005143886 A JP2005143886 A JP 2005143886A JP 2006323472 A JP2006323472 A JP 2006323472A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- irradiation direction
- transmission wave
- irradiation
- preceding vehicle
- 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.)
- Pending
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Controls For Constant Speed Travelling (AREA)
- Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
- Traffic Control Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
【課題】 先行車両との車間距離を正しく検出できる車両用走行制御装置および送信波の照射制御方法を提供する。
【解決手段】 路面からの反射光を先行車両とは誤認識しないように、路面からの反射光の影響を無視できる、路面からある一定の距離だけ離れた高さ位置をレーザ光下限高さとして設定する。先行車両200のリフレクタ201がレーザ光下限高さよりも低い位置にある場合には、先行車両200の後端部におけるレーザ光下限高さが基準照射方向となるように、コントローラ16が基準照射仰俯角を演算して車間距離センサ11に信号を出力する。車間距離センサ11は、コントローラ16からの信号に基づいて基準照射仰俯角を設定して、レーザ光により走査する。なお、先行車両200のリフレクタ201がレーザ光下限高さよりも高い位置にある場合には、レーザ光の基準照射方向は、先行車両200のリフレクタ201が存在する方向に設定される。
【選択図】 図4
【解決手段】 路面からの反射光を先行車両とは誤認識しないように、路面からの反射光の影響を無視できる、路面からある一定の距離だけ離れた高さ位置をレーザ光下限高さとして設定する。先行車両200のリフレクタ201がレーザ光下限高さよりも低い位置にある場合には、先行車両200の後端部におけるレーザ光下限高さが基準照射方向となるように、コントローラ16が基準照射仰俯角を演算して車間距離センサ11に信号を出力する。車間距離センサ11は、コントローラ16からの信号に基づいて基準照射仰俯角を設定して、レーザ光により走査する。なお、先行車両200のリフレクタ201がレーザ光下限高さよりも高い位置にある場合には、レーザ光の基準照射方向は、先行車両200のリフレクタ201が存在する方向に設定される。
【選択図】 図4
Description
本発明は、先行車両との距離に基づいて自車両の走行状態を制御する車両用走行制御技術に関する。
自車両の前方を走行する先行車両との車間距離を測定して、自車両の走行状態を制御する車両用走行制御装置が知られている。この装置では、レーザ光により車幅方向および高さ方向にそれぞれ所定角度の範囲を走査することで、反射光を検出して先行車両までの距離を測定している(特許文献1参照)。
従来の車両用走行制御装置を用いて自車両の走行状態を制御する場合、先行車両までの距離を測定する際に、強度の高い反射光を得るために反射率の高い先行車両のリフレクタに向けてレーザ光を照射することが考えられる。しかし、先行車両のリフレクタが低い位置に配設されている場合には、路面に照射されたレーザ光の反射光を検出して、路面を先行車両と誤認識してしまい、先行車両との車間距離を正しく検出できない恐れがある。
(1) 請求項1の発明による車両用走行制御装置は、自車両の前方を走行する先行車両に対して送信波を照射するとともに、照射した送信波の反射波を検出して自車両と先行車両との距離を測定する測距手段と、測距手段で測定した自車両と先行車両との距離に基づいて、自車両の走行状態を制御する走行状態制御手段とを有する車両用走行制御装置において、測距手段で検出された反射波の強度分布に基づいて次に照射すべき送信波の照射方向を演算する照射方向演算手段と、照射方向演算手段で演算された照射方向における送信波の照射高さが所定の下限値よりも高い場合には、照射方向演算手段で演算された照射方向を送信波の照射方向として決定し、照射方向演算手段で演算された照射方向における送信波の照射高さが下限値よりも低い場合には、送信波の照射高さが下限値と一致するように送信波の照射方向を決定する照射方向決定手段と、照射方向決定手段で決定された送信波の照射方向に送信波が照射されるように測距手段が送信する送信波の照射方向を制御する照射方向制御手段とを備えることを特徴とする。
(2) 請求項6の発明による送信波の照射制御方法は、自車両の前方を走行する先行車両に対して送信波を照射するとともに、照射した送信波の反射波を検出して自車両と先行車両との距離を測定する際に、検出された反射波の強度分布に基づいて次に照射すべき送信波の照射方向を演算し、演算された照射方向における送信波の照射高さが所定の高さである下限値よりも高い場合には、演算された照射方向を送信波の照射方向として決定し、演算された照射方向における送信波の照射高さが下限値よりも低い場合には、送信波の照射高さが下限値と一致するように送信波の照射方向を決定し、決定された送信波の照射方向に送信波を照射することを特徴とする。
(2) 請求項6の発明による送信波の照射制御方法は、自車両の前方を走行する先行車両に対して送信波を照射するとともに、照射した送信波の反射波を検出して自車両と先行車両との距離を測定する際に、検出された反射波の強度分布に基づいて次に照射すべき送信波の照射方向を演算し、演算された照射方向における送信波の照射高さが所定の高さである下限値よりも高い場合には、演算された照射方向を送信波の照射方向として決定し、演算された照射方向における送信波の照射高さが下限値よりも低い場合には、送信波の照射高さが下限値と一致するように送信波の照射方向を決定し、決定された送信波の照射方向に送信波を照射することを特徴とする。
本発明によれば、先行車両との距離を測定する際に、検出された反射波の強度分布に基づいて次に照射すべき送信波の照射方向を演算し、演算された照射方向における送信波の照射高さが所定の高さである下限値よりも高い場合には、演算された照射方向を送信波の照射方向として決定し、演算された照射方向における送信波の照射高さが下限値よりも低い場合には、送信波の照射高さが下限値と一致するように送信波の照射方向を決定するように構成した。これにより、照射した送信波の路面からの反射波を抑制できるので、路面を先行車両として誤認識する恐れがなく、先行車両との車間距離を正しく検出できる。
図1〜7を参照して、本発明による車両用走行制御装置の一実施の形態を説明する。図1は、本発明による車両用走行制御装置を搭載した車両の構成を示す図である。この車両100はエンジン1を走行駆動源とする車両であり、エンジン1の駆動力は自動変速機2、プロペラシャフト3、最終減速機4を介して駆動輪5a、5bに伝達される。また、駆動輪5a、5bと従動輪6a、6bにはそれぞれディスクブレーキ7a〜7dが装備されている。
エンジン制御装置8はスロットルバルブ開度指令値θ*に応じてエンジン1のスロットルバルブ開度制御、燃料噴射制御、点火時期制御などを行い、エンジン1のトルクと回転速度を制御する。また、制動制御装置9は制動圧指令値P*に応じて制動油圧を発生させ、ディスクブレーキ7a〜7dに供給する。なお、スロットルバルブ開度指令値θ*および制動圧指令値P*は、後述するコントローラ16で演算されて出力される。
自動変速機2の出力側には自車速Vを検出する車速センサ10が設けられている。また、車両100の前部の車体下部には先行車両との車間距離Lを検出する車間距離センサ11が設けられている。車間距離センサ11は、レーザ光により車幅方向および高さ方向にそれぞれ所定角度の範囲を走査することで得られる先行車両からの反射光を受光し、先行車両との車間距離Lを計測するとともに、先行車両の位置を検出する、スキャンニング式のレーザレーダ装置である。後述するコントローラ16は車間距離Lの時間変化(相対速度)と自車速Vとに基づいて先行車両の車速Vpを演算する。
車両100の前部には降雨の有無を検出する雨滴感知センサ12が設けられている。車室内の運転席近傍には操作スイッチ15が設けられている。この操作スイッチ15には、運転者が車両用走行制御装置の起動と停止を行うスイッチや、設定車速Vsetを入力するスイッチなどが含まれる。
コントローラ16は、車速センサ10により検出された自車速V、車間距離センサ11により検出された先行車両の有無と車間距離L、操作スイッチ15により設定された設定車速Vsetなどに基づいて、先行車両が検出されているときは設定車速Vset以下で先行車両との車間距離Lがその目標値L*になるように車間距離制御(先行車追従走行制御)を行うとともに、先行車両が検出されないときは自車速Vが設定車速Vsetになるように車速制御(一定速走行制御)を行い、制御演算結果のスロットルバルブ開度指令値θ*をエンジン制御装置8へ出力し、制御結果の制動圧指令値P*を制動制御装置9へ出力する。
また、コントローラ16は、車間距離センサ11が照射するレーザ光の走査範囲を制御する。すなわち、コントローラ16は、車間距離センサ11が受光した反射光の強度分布の情報を得て、先行車両のリフレクタが存在する方向を推定するとともに、雨滴感知センサ12により検出された降雨の有無を加味して、レーザ光を照射すべき方向(照射方向)を演算して、車間距離センサ11に出力する。コントローラ16におけるレーザ光の照射方向の演算については後述する。車間距離センサ11は、コントローラ16で演算されたレーザ光の照射方向に基づいてレーザ光を照射する。
このように構成される車両用走行制御装置は、操作スイッチ15によって起動されると、先行車両の有無や設定車速Vsetなどに基づいて、先行車両が検出されているときには設定車速Vset以下で先行車両との車間距離Lがその目標値L*になるように車間距離を制御し、先行車両が検出されないときには自車速Vが設定車速Vsetになるように制御する。
図2はコントローラ16の走行制御機能を示す制御ブロック図である。コントローラ16はマイクロコンピューターのソフトウエア形態による目標車間距離設定部21、車間距離指令値演算部22、相対速度演算部23、目標車速演算部24、目標車速選択部25および車速制御部26を備えている。
目標車間距離設定部21は次式により自車速Vに応じた目標車間距離L*を設定する。
L*=V×To+Lo ・・・(1)
(1)式において、Toは車間時間、Loは停車時の車間距離である。なお、自車速Vに代えて先行車両の車速Vtに応じた目標車間距離L*を設定してもよい。
L*=V×To+Lo ・・・(1)
(1)式において、Toは車間時間、Loは停車時の車間距離である。なお、自車速Vに代えて先行車両の車速Vtに応じた目標車間距離L*を設定してもよい。
車間距離指令値演算部22は、車間距離Lがその目標値L*に達するまでの車間距離の時間的な変化を表す車間距離指令値Ltを決定する。具体的には、目標車間距離L*に対して次式に示すローパスフィルターFt(s)を施し、車間距離指令値Ltを演算する。
Ft(s)=ω2/(s2+2ζωs+ω) ・・・(2)
(2)式において、ωとζは車間距離制御系における応答特性を目標の応答特性とするための固有振動数と減衰係数であり、sは微分演算子である。
Ft(s)=ω2/(s2+2ζωs+ω) ・・・(2)
(2)式において、ωとζは車間距離制御系における応答特性を目標の応答特性とするための固有振動数と減衰係数であり、sは微分演算子である。
相対速度演算部23は、車間距離センサ11により検出した先行車両との車間距離Lに基づいて先行車両との相対速度ΔVを演算する。具体的には、車間距離Lに対して次式に示すバンドパスフィルタFd(s)を施し、相対速度ΔVを演算する。
Fd(s)=ωc2s/(s2+2ζcωcs+ωc2) ・・・(3)
(3)式において、ωcは固有振動数、ζcは減衰係数であり、これらは車間距離Lに含まれるノイズ成分の大きさと、短周期の車体前後の加速度変動の許容値とにより決定する。また、sは微分演算子である。なお、バンドパスフィルタに代えてハイパスフィルタを車間距離Lに施し、相対速度ΔVを演算してもよい。
Fd(s)=ωc2s/(s2+2ζcωcs+ωc2) ・・・(3)
(3)式において、ωcは固有振動数、ζcは減衰係数であり、これらは車間距離Lに含まれるノイズ成分の大きさと、短周期の車体前後の加速度変動の許容値とにより決定する。また、sは微分演算子である。なお、バンドパスフィルタに代えてハイパスフィルタを車間距離Lに施し、相対速度ΔVを演算してもよい。
目標車速演算部24は、フィードバック補償器を用いて車間距離Lを車間距離指令値Ltに一致させるための目標車速V*を演算する。具体的には、次式により先行車両との車間距離Lと相対速度ΔVに基づいて目標車速V*を演算する。
V*=Vt−{fd(Lt−L)+fv×ΔV} ・・・(4)
(4)式において、fdは距離制御ゲイン、fvは車速制御ゲインであり、Vtは先行車速度(Vt=V+ΔV)である。
V*=Vt−{fd(Lt−L)+fv×ΔV} ・・・(4)
(4)式において、fdは距離制御ゲイン、fvは車速制御ゲインであり、Vtは先行車速度(Vt=V+ΔV)である。
目標車速選択部25は、先行車両の有無に基づいて目標車速V*、設定車速Vsetおよび現在の自車速Vのいずれかを選択し、選択目標車速Vs*として出力する。
車速制御部26は、自車速Vを選択目標車速Vs*に一致させるための目標制駆動力Forを演算し、目標制駆動力Forに基づいてスロットルバルブ開度指令値θ*と制動圧指令値P*を決定し、エンジン制御装置8と制動制御装置9へ出力する。
−−−車間距離センサ11のレーザ光による走査について−−−
レーザ光の照射方向を固定した状態では、車間距離センサ11が照射するレーザ光は小さな領域しか照射できないため、すなわち、レーザ光の照射パターンが小さいため、自車両との相対位置が刻々と変化する先行車両の有無および先行車両との車間距離Lを正しく検出できない。そこで、車間距離センサ11では、レーザ光を車幅方向および高さ方向にそれぞれ所定角度の範囲で走査することで、先行車両からの反射光を受光して、先行車両との車間距離Lを計測するとともに、先行車両の位置を検出する。
レーザ光の照射方向を固定した状態では、車間距離センサ11が照射するレーザ光は小さな領域しか照射できないため、すなわち、レーザ光の照射パターンが小さいため、自車両との相対位置が刻々と変化する先行車両の有無および先行車両との車間距離Lを正しく検出できない。そこで、車間距離センサ11では、レーザ光を車幅方向および高さ方向にそれぞれ所定角度の範囲で走査することで、先行車両からの反射光を受光して、先行車両との車間距離Lを計測するとともに、先行車両の位置を検出する。
図3は、車間距離センサ11が照射するレーザ光の1回の走査範囲を模式的に示した図であり、車両100から前方に所定距離だけ離れた、車両100の前後方向と直交する垂直な仮想平面に対して投影されるレーザ光の照射方向(照射中心)の軌跡を示す。なお、図3に示したレーザ光の走査範囲は、説明の便宜上、上下方向に拡大されて記載されている。
車間距離センサ11が照射するレーザ光は、照射する仰角または俯角を変えて、1回の走査で水平方向に4往復掃引される。1往復目には、レーザ光は、軌跡111で示すように、車幅方向の一方端の基点101から他方端の基点102まで水平に、すなわち、照射する仰角または俯角を一定に保ったまま左右方向に掃引される。なお、103はレーザ光の照射パターンである。レーザ光は、基点102まで水平に掃引された後、軌跡112で示すように、照射する仰角または俯角が変更されて、軌跡111の上方を基点102から基点101まで掃引される。
2往復目には、レーザ光は、軌跡111で示すように、再び基点101から基点102まで水平に掃引され、その後、軌跡113で示すように、照射する仰角または俯角が変更されて、軌跡111の下方を基点102から基点101まで掃引される。3往復目には、レーザ光は、軌跡111で示すように、再び基点101から基点102まで水平に掃引され、その後、軌跡114で示すように、軌跡112の上方を基点102から基点101まで掃引される。4往復目には、レーザ光は、軌跡111で示すように、再び基点101から基点102まで水平に掃引され、その後、軌跡115で示すように軌跡111の下方かつ軌跡113の上方を基点102から基点101まで掃引される。
すなわち、レーザ光は、1回の走査で、軌跡111→軌跡112→軌跡111→軌跡113→軌跡111→軌跡114→軌跡111→軌跡115の順に掃引される。レーザ光が基点101から基点102へ向かって掃引される際には、軌跡111を描くように掃引されるが、軌跡111を描くように掃引される際のレーザ光の照射仰角または照射俯角をレーザ光の基準照射仰俯角と呼び、基準照射仰俯角で照射されるレーザ光の照射方向を基準照射方向と呼ぶ。
1回の走査が行われると、上述したように、車間距離センサ11は、受光した反射光の強度分布および送信から受信までの時間に基づいて、先行車両の有無および車間距離Lを演算してコントローラ16に出力する。また、車間距離センサ11は、受光した反射光の強度分布の情報をコントローラ16に出力する。コントローラ16は、車間距離センサ11から出力された反射光の強度分布の情報から、反射光の強度の最大値と照射仰俯角との関係に基づいて、先行車両が存在する場合には、先行車両のリフレクタが存在する高さ位置を予測する。すなわち、先行車両のリフレクタが基準照射方向に存在するか否か、先行車両のリフレクタが基準照射方向に存在しない場合には基準方向に対して上下方向のどちらに存在するかを予測する演算を行う。
先行車両のリフレクタが基準照射方向に存在すると判断されると、コントローラ16は、レーザ光の基準照射仰俯角を変更せずに走査するよう車間距離センサ11に信号(基準照射仰俯角設定信号)を出力する。先行車両のリフレクタが基準照射方向よりも上方に存在すると判断されると、コントローラ16は、直前の走査における基準照射方向よりも上方を走査するように、レーザ光の基準照射仰俯角を所定角度だけ変更するよう車間距離センサ11に基準照射仰俯角設定信号を出力する。先行車両のリフレクタが基準照射方向よりも下方に存在すると判断されると、コントローラ16は、直前の走査における基準照射方向よりも下方を走査するように、レーザ光の基準照射仰俯角を所定角度だけ変更するよう車間距離センサ11に基準照射仰俯角設定信号を出力する。
なお、上述した所定角度、すなわち、先行車両のリフレクタが基準照射方向よりも上方または下方に存在すると判断された際の基準照射仰俯角の変化量は、たとえば0.1度というように、微少角度に設定されている。これにより、先行車両のリフレクタが基準照射方向よりも上方または下方に存在すると判断された場合には、基準照射方向は徐々に先行車両のリフレクタの方向へ向くように変更される。
先行車両が存在しない場合、コントローラ16は、レーザ光の基準照射仰俯角をあらかじめ定められた角度(待機角度)に設定するよう車間距離センサ11に信号を出力する。
車間距離センサ11は、コントローラ16からの信号に基づいて、基準照射仰俯角を設定して、上述したように走査を行う。以降、上述した走査と基準仰俯角の変更が繰り返されることで、レーザ光の基準照射方向が反射率の高い先行車両のリフレクタが存在する方向に設定されて、先行車両との距離が測定される。リフレクタは入射光の反射率が高いので、リフレクタが存在する方向にレーザ光を照射することで強度の高い反射光が得られ、先行車両との距離を安定して測定できる。
−−−先行車両のリフレクタ位置が低い場合−−−
上述のように、レーザ光の基準照射方向が先行車両のリフレクタが存在する方向に設定されるが、先行車両のリフレクタ配設位置が低い場合には、レーザ光が路面にも照射されてしまう。すなわち、レーザ光の照射パターンの下端(レーザ光下端)で路面を照射してしまう。レーザ光が路面にも照射されてしまうと、車間距離センサ11が路面からの反射光を受光して、路面を先行車両として誤認識してしまう恐れがある。
上述のように、レーザ光の基準照射方向が先行車両のリフレクタが存在する方向に設定されるが、先行車両のリフレクタ配設位置が低い場合には、レーザ光が路面にも照射されてしまう。すなわち、レーザ光の照射パターンの下端(レーザ光下端)で路面を照射してしまう。レーザ光が路面にも照射されてしまうと、車間距離センサ11が路面からの反射光を受光して、路面を先行車両として誤認識してしまう恐れがある。
そこで、図4に示すように、本実施の形態の車両用走行制御装置では、路面からの反射光を先行車両とは誤認識しないように、路面からの反射光の影響を無視できる、路面からある一定の距離だけ離れた高さ位置をレーザ光下限高さとして設定し、基準照射方向に照射されたレーザ光の光軸が先行車両200の後端部におけるレーザ光下限高さよりも下側に向かないように、基準照射仰俯角を制御する。すなわち、先行車両200のリフレクタ201がレーザ光下限高さよりも低い位置にある場合には、先行車両200の後端部におけるレーザ光下限高さが基準照射方向となるように、コントローラ16が基準照射仰俯角を演算して車間距離センサ11に信号を出力する。車間距離センサ11は、コントローラ16からの信号に基づいて基準照射仰俯角を設定して、レーザ光により走査する。なお、先行車両200のリフレクタ201がレーザ光下限高さよりも高い位置にある場合には、上述のとおり、レーザ光の基準照射方向は、先行車両200のリフレクタ201が存在する方向に設定される。
−−−雨天の場合−−−
雨天の場合、路面が雨で濡れているため、路面に照射されたレーザ光は、車両100が存在する後側にはほとんど反射せず、車両100の前方へ反射される。そのため、レーザ光下限高さよりも低い位置にレーザ光を照射しても、車間距離センサ11が路面からの反射光をほとんど受光しないので、路面を先行車両として誤認識する恐れはない。また、雨天時には、雨滴や霧、先行車両が跳ね上げる水しぶきなどによって反射光が減衰するので、強度の高い反射光が得られる先行車両のリフレクタが存在する方向に基準照射方向を設定することが望ましい。
雨天の場合、路面が雨で濡れているため、路面に照射されたレーザ光は、車両100が存在する後側にはほとんど反射せず、車両100の前方へ反射される。そのため、レーザ光下限高さよりも低い位置にレーザ光を照射しても、車間距離センサ11が路面からの反射光をほとんど受光しないので、路面を先行車両として誤認識する恐れはない。また、雨天時には、雨滴や霧、先行車両が跳ね上げる水しぶきなどによって反射光が減衰するので、強度の高い反射光が得られる先行車両のリフレクタが存在する方向に基準照射方向を設定することが望ましい。
そこで、雨天の場合には、図5に示すように、先行車両200のリフレクタ201がレーザ光下限高さよりも低い位置にある場合であっても、レーザ光の基準照射方向を先行車両200のリフレクタ201が存在する方向に設定する。降雨の有無は、雨滴感知センサ12によって検出される(図1)。
−−−フローチャート−−−
図6は、本実施の形態の走行制御プログラムを示すフローチャートである。コントローラ16は、操作スイッチ15により走行制御装置が起動されると、たとえば10msecごとに図6に示す走行制御プログラムを実行する。
図6は、本実施の形態の走行制御プログラムを示すフローチャートである。コントローラ16は、操作スイッチ15により走行制御装置が起動されると、たとえば10msecごとに図6に示す走行制御プログラムを実行する。
ステップ1において車速センサ10から自車速Vを、車間距離センサ11から先行車両の有無、先行車両との車間距離Lおよび反射光の強度分布の情報を、雨滴感知センサ12から降雨の有無の示す検出信号を、操作スイッチ15から設定車速Vsetをそれぞれ読み込むとともに、上記(4)式により目標車速V*を演算する。
ステップ2では先行車両との車間距離Lが目標値L*となるように車間距離制御を行って先行車両に追従走行中か否かを確認する。追従走行を行っていないときはステップ9へ進み、選択目標車速Vs*に設定車速Vsetを設定してステップ10へ進む。一方、追従走行中のときはステップ4へ進み、選択目標車速Vs*に目標車速V*を設定してステップ10へ進む。
選択目標車速Vs*を設定した後、ステップ10において自車速Vを選択目標車速Vs*まで加速するための目標加速度α*を次式により演算する。
α*=k(Vs*−V) ・・・(5)
(5)式において、kは速度を加速度に変換するための係数である。続くステップ11で加速度制限係数Kにより目標加速度α*を制限する。
K・α*→α* ・・・(6)
α*=k(Vs*−V) ・・・(5)
(5)式において、kは速度を加速度に変換するための係数である。続くステップ11で加速度制限係数Kにより目標加速度α*を制限する。
K・α*→α* ・・・(6)
ステップ12において目標加速度α*に車両質量Mを乗じて目標制駆動力Forを演算する。
For=α*・M ・・・(7)
そして、ステップ13で制御指令値であるスロットルバルブ開度指令値θ*と制動圧指令値P*を演算してステップS14のサブルーチンへ進む。
For=α*・M ・・・(7)
そして、ステップ13で制御指令値であるスロットルバルブ開度指令値θ*と制動圧指令値P*を演算してステップS14のサブルーチンへ進む。
ステップS14のサブルーチンにおいて、ステップS1で読み込んだ先行車両の有無および反射光の強度分布の情報に基づいて、車間距離センサ11が照射するレーザ光の基準照射仰俯角を演算してステップS15へ進む。ステップS14のサブルーチンについては後述する。
ステップS15において、ステップS13およびステップS14のサブルーチンで演算された各値を出力してリターンする。すなわち、ステップS15において、ステップS13で演算されたスロットルバルブ開度指令値θ*をエンジン制御装置8へ出力し、制動圧指令値P*を制動制御装置9へ出力し、ステップS14のサブルーチンで演算された基準照射仰俯角を基準照射仰俯角設定信号として車間距離センサ11へ出力する。
図7は、図6のフローチャートにおけるステップS14のサブルーチンを示している。ステップS31において、メインルーチンのステップS1で読み込んだ先行車両の有無の情報から先行車両があるか否かを判断する。ステップS31が肯定判断されるとステップS33へ進み、ステップS1で読み込んだ反射光の強度分布の情報から先行車両のリフレクタの予測位置を演算してステップS35へ進む。
ステップS35において、ステップS33で演算された先行車両のリフレクタの位置が基準照射方向よりも下方であるか否かを判断する。ステップS35が肯定判断されるとステップS37へ進み、現在の基準照射方向がレーザ光下限高さよりも上側を照射するように設定されているか否かを判断する。ステップS37が否定判断されるとステップS39へ進み、ステップS1で読み込んだ雨滴感知センサ12の検出信号から、降雨状態であるか否かを判断する。ステップS39が否定判断されるとステップS41へ進み、基準照射方向が先行車両の後端部におけるレーザ下限高さを向くように基準照射仰俯角を演算して、図6に示したメインルーチンに戻る。
ステップS35が否定判断されるか、ステップS37またはステップS39が肯定判断されるとステップS43へ進み、ステップS33で演算された先行車両のリフレクタの位置の方向へ向けて所定角度だけ基準照射仰俯角を変更するように演算して、図6に示したメインルーチンに戻る。なお、ステップS33では、基準照射方向とステップS33で演算された先行車両のリフレクタの位置の方向とが一致している場合には、基準照射仰俯角を変更しない。
ステップS31が否定判断されるとステップS45へ進み、基準照射仰俯角を待機角度に設定するように演算して、図6に示したメインルーチンに戻る。
このように構成される車両用走行制御装置の動作をまとめると、次のようになる。イグニッションスイッチがONされて、操作スイッチ15により車両用走行制御装置が起動されると、コントローラ16は、車速センサ10、車間距離センサ11、雨滴感知センサ12および操作スイッチ15からの各種信号を読み込む(ステップS1)。先行車両に追従走行中でなければ選択目標車速Vs*に設定車速Vsetを設定し(ステップS2否定判断、ステップS9)、先行車両に追従走行中であれば選択目標車速Vs*に目標車速V*を設定して(ステップS2肯定判断、ステップS4)、走行制御に必要な各値を演算して(ステップS10〜13)、スロットルバルブ開度指令値θ*および制動圧指令値P*を出力する(ステップS15)。エンジン制御装置8はスロットルバルブ開度指令値θ*にしたがってエンジン1のスロットルバルブ開度を調節し、制動制御装置9は制動圧指令値P*にしたがってディスクブレーキ7a〜7dを駆動制御する。
また、コントローラ16は、車間距離センサ11が照射するレーザ光の基準照射仰俯角を演算して(ステップS14)、基準照射仰俯角設定信号を車間距離センサ11に出力する(ステップS15)。すなわち、リフレクタ位置を予測した結果(ステップS33)、先行車両のリフレクタ位置がレーザ光下限高さよりも高い場合には(ステップS35否定判断)、先行車両のリフレクタの位置の方向へ向けて所定角度だけ基準照射仰俯角を変更するように基準照射仰俯角を演算して(ステップS43)、基準照射仰俯角設定信号として出力する(ステップS15)。
先行車両のリフレクタ位置がレーザ光下限高さよりも低い場合であっても(ステップS35肯定判断)、基準照射方向がレーザ光下限高さよりも上側を照射するように設定されている場合には(ステップS37肯定判断)、先行車両のリフレクタの位置の方向へ向けて所定角度だけ基準照射仰俯角を変更するように基準照射仰俯角を演算して(ステップS43)、基準照射仰俯角設定信号として出力する(ステップS15)。
先行車両のリフレクタ位置がレーザ光下限高さよりも低い場合であり(ステップS35肯定判断)、基準照射方向がすでにレーザ光下限高さを照射するように設定されている場合には(ステップS37否定判断)、基準照射方向が先行車両の後端部におけるレーザ下限高さを向くように基準照射仰俯角を演算して(ステップS41)、基準照射仰俯角設定信号として出力する(ステップS15)。
先行車両がなければ(ステップS31否定判断)、基準照射仰俯角が待機角度となるように基準照射仰俯角設定信号を出力する(ステップS45、ステップS15)。また、雨天時には、先行車両のリフレクタ位置がレーザ光下限高さよりも低い場合であっても(ステップS35肯定判断)、先行車両のリフレクタの位置の方向へ向けて所定角度だけ基準照射仰俯角を変更するように基準照射仰俯角を演算して(ステップS39肯定判断、ステップS43)、基準照射仰俯角設定信号として出力する(ステップS15)。
車間距離センサ11は、基準照射仰俯角設定信号にしたがってレーザ光の基準照射仰俯角を設定して、レーザ光により走査する。
上述した車両用走行制御装置では、次の作用効果を奏する。
(1) 車間距離センサ11で検出された反射光の強度分布に基づいて次にレーザ光を照射すべき方向を演算し、その方向が先行車両の後部におけるレーザ光下限高さより高い場合には、演算した照射すべき方向にレーザ光が照射されるように基準照射方向を設定するように構成した。演算したレーザ光を照射すべき方向が先行車両の後部におけるレーザ光下限高さより低い場合には、先行車両の後部におけるレーザ光下限高さにレーザ光が照射されるように基準照射方向を設定するように構成した。これにより、照射したレーザ光の路面からの反射光を抑制できるので、路面を先行車両として誤認識する恐れがなく、先行車両との車間距離を正しく検出できる。したがって、車間距離センサ11で検出された車間距離の信頼性が向上するので、車両用走行制御装置による走行制御の信頼性を向上できる。
(1) 車間距離センサ11で検出された反射光の強度分布に基づいて次にレーザ光を照射すべき方向を演算し、その方向が先行車両の後部におけるレーザ光下限高さより高い場合には、演算した照射すべき方向にレーザ光が照射されるように基準照射方向を設定するように構成した。演算したレーザ光を照射すべき方向が先行車両の後部におけるレーザ光下限高さより低い場合には、先行車両の後部におけるレーザ光下限高さにレーザ光が照射されるように基準照射方向を設定するように構成した。これにより、照射したレーザ光の路面からの反射光を抑制できるので、路面を先行車両として誤認識する恐れがなく、先行車両との車間距離を正しく検出できる。したがって、車間距離センサ11で検出された車間距離の信頼性が向上するので、車両用走行制御装置による走行制御の信頼性を向上できる。
(2) 車間距離センサ11で検出された反射光の強度分布に基づいて、次にレーザ光を照射すべき方向として基準照射仰俯角を演算する際に、先行車両のリフレクタ高さ位置を予測するように構成した。リフレクタの反射率は先行者車両の他の部分より高いので、リフレクタが存在する方向にレーザ光を照射することで強度の高い反射光が得られ、先行車両との距離を安定して測定できる。これにより、車間距離センサ11で検出された車間距離の信頼性が向上するので、車両用走行制御装置による走行制御の信頼性を向上できる。また、強度の高い反射光が得られるので、車間距離制御が可能な車間距離を大きくできる。
(3) 雨天の場合には、演算した先行車両のリフレクタの高さ位置が先行車両の後端部におけるレーザ光下限高さより低い場合であっても、先行車両のリフレクタが存在する高さ位置に基準照射方向を設定するように構成した。これにより、雨天の場合には、先行車両のリフレクタの高さ位置が低くても、リフレクタからの反射光に基づいた車間距離制御が可能である。したがって、雨滴や霧、先行車両が跳ね上げる水しぶきなどによって反射光が減衰するような環境下でも車間距離制御が可能となり、車両用走行制御装置の利便性が向上する。
(4) 降雨の有無に雨滴センサを用いるように構成した。これにより、降雨の有無を安価に検出できるので、車両用走行制御装置のコスト増を抑制できる。
−−−変形例−−−
(1) 上述の説明では、レーザ光下限高さは、路面からある一定の距離だけ離れた高さ位置であるが、本発明はこれに限定されない。車間距離センサ11が照射するレーザ光は上下左右方向に広がる所定の照射角度で照射されるため、先行車両200の後端部におけるレーザ光下限高さに向けてレーザ光を照射しても、図8(a)に示すように、車間距離が小さいときにはレーザ光の照射パターンの下端が路面を照射しないか、路面を照射しても照射パターンのごく一部であるが、図8(b)に示すように、車間距離が大きいときにはレーザ光が路面を照射する部分が多くなってしまう。
(1) 上述の説明では、レーザ光下限高さは、路面からある一定の距離だけ離れた高さ位置であるが、本発明はこれに限定されない。車間距離センサ11が照射するレーザ光は上下左右方向に広がる所定の照射角度で照射されるため、先行車両200の後端部におけるレーザ光下限高さに向けてレーザ光を照射しても、図8(a)に示すように、車間距離が小さいときにはレーザ光の照射パターンの下端が路面を照射しないか、路面を照射しても照射パターンのごく一部であるが、図8(b)に示すように、車間距離が大きいときにはレーザ光が路面を照射する部分が多くなってしまう。
そこで、図9(a)〜(c)に示すように、車両100からの距離が離れるほどレーザ光下限高さを高くするように設定することとしてもよい。たとえば、図9(a)に示すように、車両100からの距離が離れるにつれて段階的にレーザ光下限高さを高くしてもよく、図9(b)に示すように、車両100から所定の距離だけ離れるまではレーザ光下限高さを一定値で設定し、車両100から所定の距離以上離れたときに、レーザ光下限高さを徐々に高くするようにしてもよい。また、図9(c)に示すように、レーザ光下限高さを車両100との距離に比例して増加する曲線に近似させてもよい。
(2) 上述の説明では、車間距離センサ11の走査パターンは図3に示すようなものであるが、本発明はこれに限定されない。すなわち、図3に示した走査パターンは一例であり、掃引順序や掃引回数など、走査パターンは他の様々な形態であってもよい。また、上述の説明では、レーザ光を左右方向に掃引しているが、上下方向に掃引するようにしてもよい。
(3) 上述の説明では、積荷や乗員の増減による車高の変化や、積荷矢乗員の配置位置、加減速などに起因する車両のピッチング方向の姿勢変化に起因するレーザ光の照射方向の変化については特に言及していないが、自車両の姿勢変化を検出する各種のセンサを用いることで、自車両の姿勢変化を検出して、自車両の姿勢変化を打ち消すようにレーザ光の照射方向を変更するように構成してもよい。
(4) 上述の説明では、降雨の有無の検出に雨滴感知センサ12を用いているが、本発明はこれに限定されない。たとえば、ワイパの動作の有無を検出することで、降雨の有無を判断するように構成してもよく、撮像素子を利用して、先行車両が跳ね上げる水しぶきを画像処理によって検出することで、降雨の有無を判断してもよい。また、自車両の下部に発光素子と受光素子とを設け、発光素子から照射した照射光による自車両下部路面からの反射光を受光素子で検出することで、路面の反射率を検出することなどによって、降雨の有無を判断してもよい。
(5) 上述の説明では、先行車両のリフレクタが基準照射方向よりも上方または下方に存在すると判断された際の基準照射仰俯角の変化量は、たとえば0.1度に設定されているが、本発明はこれに限定されず、先行車両の検出に適した値であれば、他の値であってもよい。また、先行車両のリフレクタが基準照射方向よりも上方または下方に存在すると判断された際に、基準照射方向がすぐに先行車両のリフレクタの方向へ向くように、基準照射仰俯角を変更するように構成してもよい。
(6) 上述の説明では、基準照射仰俯角の演算は、コントローラ16で演算するように構成しているが、本発明はこれに限定されない。たとえば、車間距離センサ11に基準照射仰俯角を演算する演算装置を設け、この演算装置で上述した図7に示したサブルーチンに相当する内容のプログラムを実行することで、車間距離センサ11側で基準照射仰俯角を制御するように構成してもよい。
(7) 上述した各実施の形態および変形例は、それぞれ組み合わせてもよい。
(7) 上述した各実施の形態および変形例は、それぞれ組み合わせてもよい。
以上の実施の形態および変形例において、たとえば、測距手段および照射方向制御手段は車間距離センサ11に、照射方向演算手段および照射方向決定手段はコントローラ16に、雨天検出手段は雨滴感知センサ12にそれぞれ対応する。走行状態制御手段は、エンジン制御装置8、制動制御装置9およびコントローラ16によって実現される。なお、以上の説明はあくまで一例であり、発明を解釈する際、上記の実施形態の記載事項と特許請求の範囲の記載事項の対応関係になんら限定も拘束もされない。
1 エンジン 7a〜7d ディスクブレーキ
8 エンジン制御装置 9 制動制御装置
11 車間距離センサ 12 雨滴検出センサ
16 コントローラ 100 車両(自車両)
111〜115 軌跡 200 先行車両
201 リフレクタ
8 エンジン制御装置 9 制動制御装置
11 車間距離センサ 12 雨滴検出センサ
16 コントローラ 100 車両(自車両)
111〜115 軌跡 200 先行車両
201 リフレクタ
Claims (6)
- 自車両の前方を走行する先行車両に対して送信波を照射するとともに、照射した前記送信波の反射波を検出して前記自車両と前記先行車両との距離を測定する測距手段と、
前記測距手段で測定した前記自車両と前記先行車両との距離に基づいて、前記自車両の走行状態を制御する走行状態制御手段とを有する車両用走行制御装置において、
前記測距手段で検出された反射波の強度分布に基づいて次に照射すべき送信波の照射方向を演算する照射方向演算手段と、
前記照射方向演算手段で演算された照射方向における前記送信波の照射高さが所定の下限値よりも高い場合には、前記照射方向演算手段で演算された照射方向を前記送信波の照射方向として決定し、前記照射方向演算手段で演算された照射方向における前記送信波の照射高さが前記下限値よりも低い場合には、前記送信波の照射高さが前記下限値と一致するように前記送信波の照射方向を決定する照射方向決定手段と、
前記照射方向決定手段で決定された前記送信波の照射方向に前記送信波が照射されるように前記測距手段が送信する送信波の照射方向を制御する照射方向制御手段とを備えることを特徴とする車両用走行制御装置。 - 請求項1に記載の車両用走行制御装置において、
前記照射方向演算手段は、前記反射波検出手段で検出された反射波の強度分布に基づいて、前記先行車両の後方に取り付けられたリフレクタがあると予測される方向に前記送信波の照射方向が近づくように、次に照射すべき送信波の照射方向を演算することを特徴とする車両用走行制御装置。 - 請求項1または請求項2に記載の車両用走行制御装置において、
前記照射方向決定手段は、前記測距手段が測定した前記自車両と前記先行車両との距離に応じて前記下限値を変更することを特徴とする車両用走行制御装置。 - 請求項1〜3のいずれか一項に記載の車両用走行制御装置において、
雨天であるか否かを検出する雨天検出手段をさらに備え、
前記照射方向決定手段は、前記雨天検出手段が雨天であることを検出したときには、前記照射方向演算手段で演算された照射方向における前記送信波の照射高さが前記下限値よりも低い場合であっても、前記照射方向演算手段で演算された照射方向を前記送信波の照射方向として決定することを特徴とする車両用走行制御装置。 - 請求項4に記載の車両用走行制御装置において、
前記雨天検出手段は、雨滴感知センサであることを特徴とする車両用走行制御装置。 - 自車両の前方を走行する先行車両に対して送信波を照射するとともに、照射した前記送信波の反射波を検出して前記自車両と前記先行車両との距離を測定する際に、検出された反射波の強度分布に基づいて次に照射すべき送信波の照射方向を演算し、
演算された照射方向における前記送信波の照射高さが所定の高さである下限値よりも高い場合には、演算された照射方向を前記送信波の照射方向として決定し、
演算された照射方向における前記送信波の照射高さが前記下限値よりも低い場合には、前記送信波の照射高さが前記下限値と一致するように前記送信波の照射方向を決定し、
決定された前記送信波の照射方向に前記送信波を照射することを特徴とする送信波の照射制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005143886A JP2006323472A (ja) | 2005-05-17 | 2005-05-17 | 車両用走行制御装置および送信波の照射制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005143886A JP2006323472A (ja) | 2005-05-17 | 2005-05-17 | 車両用走行制御装置および送信波の照射制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2006323472A true JP2006323472A (ja) | 2006-11-30 |
Family
ID=37543127
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005143886A Pending JP2006323472A (ja) | 2005-05-17 | 2005-05-17 | 車両用走行制御装置および送信波の照射制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2006323472A (ja) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009237938A (ja) * | 2008-03-27 | 2009-10-15 | Fuji Heavy Ind Ltd | 運転支援装置および運転支援システム |
JP2015535204A (ja) * | 2012-09-20 | 2015-12-10 | グーグル インコーポレイテッド | 道路天候条件検出 |
-
2005
- 2005-05-17 JP JP2005143886A patent/JP2006323472A/ja active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009237938A (ja) * | 2008-03-27 | 2009-10-15 | Fuji Heavy Ind Ltd | 運転支援装置および運転支援システム |
JP2015535204A (ja) * | 2012-09-20 | 2015-12-10 | グーグル インコーポレイテッド | 道路天候条件検出 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3915742B2 (ja) | 車両用物体認識装置 | |
EP1944189B2 (en) | Automatic collision management system | |
US6927699B2 (en) | Object recognition apparatus for vehicle, and inter-vehicle distance control unit | |
EP3039450B1 (en) | In-vehicle control device | |
US6401024B1 (en) | Vehicle follow-up control system | |
US5714928A (en) | System for preventing collision for vehicle | |
US7650239B2 (en) | Object recognition apparatus for motor vehicle | |
CN103813950B (zh) | 用于改善行驶稳定性的方法 | |
US6229263B1 (en) | Lighting-direction control unit for vehicle lamp | |
US7095199B2 (en) | Automatic vehicle wiper system | |
CN109094567B (zh) | 汽车安全防护方法和装置 | |
US20080234900A1 (en) | Look ahead vehicle suspension system | |
US7838836B2 (en) | Method for detecting a spray of water at the rear of a vehicle | |
JP2000147124A (ja) | 車載レーダ装置 | |
JP2005231382A (ja) | 車両用走行制御装置 | |
EP3584117A1 (en) | Vehicle lamp tool and method for controlling vehicle lamp tool | |
JP3941791B2 (ja) | 車両用物体認識装置及びプログラム | |
US6618323B2 (en) | Optical axis adjusting device for vehicle headlamp | |
JP2006323472A (ja) | 車両用走行制御装置および送信波の照射制御方法 | |
JP4556597B2 (ja) | 先行車両検出装置 | |
JP4330937B2 (ja) | レーダ装置 | |
JP2005145187A (ja) | 車両用走行制御装置 | |
JP4760207B2 (ja) | 走行制御装置 | |
US10571553B2 (en) | Sensor mounting state determination device and sensor mounting state determination method | |
JP2005145403A (ja) | 車間距離制御装置 |