JP3969198B2 - 車間制御装置 - Google Patents
車間制御装置 Download PDFInfo
- Publication number
- JP3969198B2 JP3969198B2 JP2002165942A JP2002165942A JP3969198B2 JP 3969198 B2 JP3969198 B2 JP 3969198B2 JP 2002165942 A JP2002165942 A JP 2002165942A JP 2002165942 A JP2002165942 A JP 2002165942A JP 3969198 B2 JP3969198 B2 JP 3969198B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- inter
- distance
- control
- 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.)
- Expired - Fee Related
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)
- Radar Systems Or Details Thereof (AREA)
Description
【発明の属する技術分野】
本発明は、車間制御に関し、特にキャリアカー等の特殊車両に対する適切な車間制御を実現するための技術に関する。
【0002】
【従来の技術及び発明が解決しようとする課題】
従来より、例えば光波,ミリ波などの送信波を車両周囲の所定角度に渡って掃引送信し、その反射波を検出することによって、車両前方の物体を認識する物体認識装置が考えられている。この種の装置としては、例えば、先行車両などの障害物を検出して警報を発生する装置や、先行車両と所定の車間距離を保持するように車速を制御する装置などに適用され、それらの制御対象としての先行車両などの物体認識に利用されている。
【0003】
自車前方に存在する車両を認識する場合には、前方車両の後端左右に取り付けられたリフレクタ(反射物:例えばブレーキランプやボデイ等)からの反射波を検出して認識することが望ましい。
しかし、先行車が例えば全長の長いキャリアカーといった特殊な形状をしている車両である場合、リフレクタが左右端部にしかなく、そのリフレクタ間においては適当な反射物が存在しない場合、次のような不都合が生じる。つまり、このようなキャリアカーでは、荷台の後にある車両後端部と荷台の前にある運転席部分の後部とでは数m以上の間隔がある。その場合、ある程度遠方から測距している状態においては、車両後端部をセンサの検出範囲内に捉えていたとしても、車間が詰まってきた状態では、レーザ光の照射角度がリフレクタ間に収まり、つまりレーザ光がリフレクタの間を通過してしまうことが考えられる。
【0004】
この場合、先行車が存在しないと誤認識してしまったり、あるいは、運転席後部のみ検出する状態になって、実際のよりも遠い位置に先行車が存在すると誤認識してしまう可能性がある。このような誤った測距に基づく車間制御は適切なものでなくなってしまう。
【0005】
そこで、本発明は、このような特殊形状車両に対しても適切な車間制御を実現できる技術を提供することを目的とする。
【0006】
【課題を解決するための手段】
上記問題を解決するためなされた本発明の車間制御装置は、車幅方向あるいは車高方向の少なくともいずれか一方の所定角度に渡り電磁波を掃引送信し、送信した電磁波が反射物体にて反射された反射波を受信し、その反射波に基づいて認識対象の物体の自車に対する相対位置及び相対速度を算出し、その認識された物体の相対位置に基づき自車に対する先行車を選択し、自車を先行車に追従させて走行させるのであるが、先行車のリフレクタの位置や電磁波送信角度に基づいて、リフレクタをロストしない車間制御を実現する。つまり、先行車の後端部における車幅方向又は車高方向の端部付近に存在する一対のリフレクタの位置を算出し、その算出された一対のリフレクタ位置が電磁波送信の所定角度内に共に含まれるという条件を満たす最短距離を算出する。そして、目標車間距離がその算出された最短距離よりも短くならないように調整するのである。
【0007】
このようにすれば、例えば車幅方向の所定範囲内に電磁波を送信して先行車を認識する場合に、その先行車が上述のキャリアカーのような特殊形状の車両であったとしても、接近しすぎて電磁波がリフレクタ間を通過してしまう状況を回避できる。そのため、先行車が存在しないと誤認識してしまったり、あるいは、実際のよりも遠い位置に先行車が存在すると誤認識してしまうことを防止でき、適切な車間制御を実現できるようになる。
【0008】
このリフレクタ位置に関しては、リフレクタをどの程度の大きさ分だけ認識するかに関係する。つまり、技術思想としては、リフレクタの一部でも認識できている状態であればよいのであるが、実際の車間制御においては先行車との車間の変化に対して応答するまでに多少の時間差があるため、例えばリフレクタのほんの一部でも認識できていればよいとすると、リフレクタを全く認識できない状態に移行し易い。そのため、例えば請求項2に示すように、一対のリフレクタ全体に着目した場合の車幅方向端位置又は車高方向端位置を算出することが考えられる。これは、例えば車幅方向の所定角度の範囲に電磁波を送信することを想定した場合、先行車後部の左端付近に存在するリフレクタであればその左端位置、右端付近に存在するリフレクタであればその右端位置に着目し、それらの位置が電磁波送信の所定角度内に共に含まれるように車間制御するのである。このようにすれば、確実に一対のリフレクタを捉えることができ、ロスト防止の面での確実性は向上する。
【0009】
また、請求項3に示すように、一対のリフレクタそれぞれの中心位置に着目してもよい。中心位置が含まれるようにすれば、少なくともリフレクタの半分は認識できている状態となるからである。
ところで、上述した特殊車両においてリフレクタをロストする状況は、先行車に接近しすぎて電磁波がリフレクタ間を通過してしまうということである。したがって、先行車に接近していない状況であれば必要以上に目標車間を調整する必要はない。また、例えば先行車に接近していてもそれが一時的なものであり、リフレクタを十分に認識でき続けられる状況であれば、やはり必要以上に目標車間を調整する必要はない。したがって、例えば請求項4に示すように、物体認識手段が物体の長さも認識可能(つまりリフレクタと考えられる物体の長さも認識可能)であることを前提として目標車間距離調整手段が次のような調整を行っても良い。つまり、先行車の一対のリフレクタの長さに関して、安定的に認識されている状態で認識したリフレクタ本来の長さを記憶しておき、その後、物体認識手段にて認識した一対のリフレクタ長さの内の少なくとも一方が前記記憶されている対応値よりも所定割合小さくなり、且つ自車と先行車との相対速度が負の場合には、先行車から離れる挙動となる目標車間距離に調整するのである。
【0010】
この所定割合としては例えば2分の1といった値が考えられる。この場合であれば、先行車からある程度離れている状況ではリフレクタを全部認識できていて問題ないが、接近するとリフレクタの一部しか認識できない状況に移行する。但し、大部分認識できている場合には、その時点では目標車間距離の調整はしない。そして、さらに接近してリフレクタの半分未満しか認識できない状況に移行した場合には、さらに接近するとリフレクタをロストしてしまう可能性があるので、先行車から離れる挙動を示せるような目標車間距離に調整する必要性が出てくる。しかし、「さらに接近する」のはその時点で相対速度が負である場合であり、逆に相対速度が零又は正であればそれ以上接近することはないため、必要以上に調整する必要はない。
【0011】
このようにすることで、リフレクタのロスト防止に真に必要な状況にのみ目標車間距離の調整が実行される可能性が高くなり、全体としてより適切な車間制御が実現されることとなる。
【0012】
【発明の実施の形態】
以下、本発明の好適な実施例を図面に基づいて説明する。図1は、本実施例にかかる車両走行制御装置1のシステム構成を概略的に示すブロック図であり、車間制御用電子制御装置(以下「車間制御ECU」という)2、エンジン制御用電子制御装置(以下「エンジンECU」という)6、及びブレーキ電子制御装置(以下「ブレーキECU」という)4を中心に構成されている。
【0013】
車間制御ECU2は、マイクロコンピュータを中心として構成されている電子回路であり、現車速(Vn)信号、操舵角(str-eng ,S0)信号、ヨーレート信号、目標車間時間信号、ワイパスイッチ情報、アイドル制御やブレーキ制御の制御状態信号等をエンジンECU6から受信する。そして、車間制御ECU2は、この受信したデータに基づいて、カーブ曲率半径Rを推定したり、車間制御演算をしている。
【0014】
レーザレーダセンサ3は、レーザによるスキャニング測距器とマイクロコンピュータとを中心として構成されている電子回路である。スキャニング測距器は、車幅方向の所定角度範囲にレーザ光をスキャン照射し、物体からの反射光に基づいて、自車と前方物体との距離をスキャン角度に対応して検出可能であり、マイクロコンピュータは、スキャニング測距器にて検出した先行車の角度や相対速度等、及び車間制御ECU2から受信する現車速(Vn)信号、カーブ曲率半径R等に基づいて先行車の自車線確率を演算し、相対速度等の情報も含めた先行車情報として車間制御ECU2に送信する。また、自己のダイアグノーシス信号も車間制御ECU2に送信する。なお、このレーザレーダセンサ3は、車両後部の左右にそれぞれ存在するブレーキランプ等のリフレクタ(反射物)を、同一先行車の一対のリフレクタである旨も含めて判定し、その情報を車間制御ECU2に送信可能であるが、これらの点については、後で詳しく説明する。
【0015】
さらに、車間制御ECU2は、このようにレーザレーダセンサ3から受信した先行車情報に含まれる自車線確率等に基づいて、車間制御すべき先行車を決定し、先行車との車間を適切に調節するための制御指令値として、エンジンECU6に、目標加速度信号、フューエルカット要求信号、ODカット要求信号、3速シフトダウン要求信号、ブレーキ要求信号を送信している。また、警報発生の判定をして、警報吹鳴要求信号或いは警報吹鳴解除要求信号を送信したりする。さらに、ダイアグノーシス信号、表示データ信号等を送信する。
【0016】
ブレーキECU4は、マイクロコンピュータを中心として構成されている電子回路であり、車両の操舵角を検出するステアリングセンサ8、車両の旋回状態としてのヨーレートを検出するヨーレートセンサ10、および各車輪の速度を検出する車輪速センサ12から操舵角やヨーレートを求めて、これらのデータをエンジンECU6を介して車間制御ECU2に送信する。また、ブレーキECU4は、エンジンECU6を介する車間制御ECU2からの目標加速度等に基づくブレーキ要求に応じてブレーキ力を制御するために、ブレーキ油圧回路に備えられた増圧制御弁・減圧制御弁の開閉をデューティ制御するブレーキアクチュエータ25を制御したり、エンジンECU6を介する車間制御ECU2からの警報要求信号に応じて警報ブザー14を鳴動する。
【0017】
エンジンECU6は、マイクロコンピュータを中心として構成されている電子回路であり、アクセルペダルの踏み込み量を検出するアクセルペダルセンサ15、車両速度を検出する車速センサ16、フットブレーキの踏み込みの有無を検出するブレーキスイッチ18、クルーズコントロールスイッチ20、クルーズメインスイッチ22、及びその他のセンサやスイッチ類からの検出信号等を受信し、さらに、上述したブレーキECU4及び車間制御ECU2からの各種信号を受信している。
【0018】
そして、エンジンECU6は、この受信した信号から判定する運転状態に応じて、内燃機関(ここでは、ガソリンエンジン)のスロットル開度を調整するスロットルアクチュエータ24、トランスミッション26のアクチュエータ駆動段に対して駆動命令を出力している。これらのアクチュエータにより、内燃機関の出力、ブレーキ力あるいは変速シフトを制御することが可能となっている。
【0019】
次に、本実施例のオートクルーズ制御の概略を図2の状態遷移図を参照して説明する。
制御は、ステップAの「クルーズOFF」状態から開始され、クルーズメインスイッチ22をONすることによって、ステップBの「クルーズReady」状態へ遷移する。そして、ステップBの状態でクルーズコントロールスイッチ20中のクルーズセットスイッチをONすることにより、ステップCのクルーズ制御に遷移する。なお、ステップCのクルーズ制御中にフットブレーキがONされたり、所定の有効車速範囲をオーバーした場合には、ステップCのクルーズ制御からステップBのクルーズReady状態へ遷移する。
【0020】
ステップCのクルーズ制御においては、セット車速以下の先行車が存在しない場合にはステップDの車速制御(定速走行)を行い、セット車速以下の先行車が存在する場合にはステップEの車間制御(追従走行)を行う。そして、これら車速制御及び車間制御を含むクルーズ制御中にアクセルペダルが踏み込まれた場合には、所定の条件が成立するとステップFのオーバライド状態に遷移する。
【0021】
次に、レーザレーダセンサ3にて行われる処理についてさらに説明する。まず、レーザレーダセンサ3に備えられたスキャニング測距器による測距データ(距離・角度の計測データ)を1スキャン分読み込む。スキャン周期は例えば100msecであり、100msec毎にデータを取り込むこととする。
【0022】
そして、データのセグメント化を行う。測距データとして得た距離データとスキャン角度θについては極座標系からXZ直交座標系に変換し、その変換後のデータをグルーピングしてセグメントを形成する。例えば、点認識されたデータ同士のX軸方向の距離が0.2m以下、Z軸方向の距離が2m以下という2条件を共に満たす場合に、その点集合を一体化してセグメントデータを求める。このセグメントデータは、一体化された点集合を含むような大きさに設定された、X軸及びZ軸に平行な2辺を持つ長方形の領域であり、中心座標(X,Z)と大きさを示すための2辺のデータ(W,D)をデータ内容とする。
【0023】
このような測距データのセグメント化により、例えば車両の左右のテールランプに具備されている反射板や車体などのリフレクタを複数のスキャン角度において検出したような場合に、それらが同一のリフレクタのものであると認識することができる。車両の後部左右には一対のリフレクタが存在することが多いので、その場合は、各リフレクタをそれぞれ一つのセグメントとして認識する。
【0024】
ひとまとまりにされたセグメントデータに対して作成される障害物のモデルを物標と呼ぶが、この物標は、中心座標(X,Y)、幅W、奥行きD、X軸方向,Y軸方向の相対速度(Vx,Vy)、中心座標(X,Y)の過去4回分のデータ、状態フラグ、自車線確率及び存在時間などの情報を持つ。状態フラグは、物標の状態が、未定状態、認識状態、外挿状態、誤結合補間状態のいずれであるかを表すフラグである。なお、レーザ光が掃引照射される所定角度内に出現する先行車両等の障害物の個数には通常ある程度の上限がある。そして、その上限を超えて障害物を認識した場合は、不必要な路側物を検出している場合がほとんどである。そこで、所定値をその上限に対してある程度大きく設定しておけば、所定値以内の個数の物標として認識される障害物を監視するだけで車間制御を実行することができる。
【0025】
但し、この状態ではどのセグメントデータ同士が同じ先行車の一対のリフレクタに対応するものか分からないので、その判定処理を行う。これは、例えば所定の判定条件に適合する二つのセグメントデータをペアにする処理であり、その判定条件としては、例えば次のような条件が考えられる。▲1▼所定時間(回数)連続して認識されている。▲2▼二つのセグメントデータの最左端から最右端までの長さ、すなわち両者をマージしたと想定した場合の幅が所定値(例えば3.0m)以内。▲3▼中心座標のY軸方向の差が所定値(例えば3.0m)以内。▲4▼相対速度VY の差が所定値(例えば3.0km/h)以内。そして、この条件を満たしたとき、該当する一対のセグメントデータ同士は同一先行車のものであると判定され、その情報自体も物標データに含められる。したがって、車間制御ECU2側としては、レーザレーダセンサ3から送出される先行車情報中を参照することで、その先行車が有する一対のリフレクタに対応する一つのセグメントがどれであるかも分かるようになっている。
【0026】
なお、レーザレーダセンサ3が実行する処理についてより詳細に理解するのであれば、例えば特開2001−80437号公報等を参照されたい。但し、当該公報記載の場合は、マージ条件に従って左右のリフレクタのセグメントをマージして一つのセグメントにしているが、本実施例の場合は、一対であると判定はするが、セグメント間を埋めるようなことはしない。
【0027】
次に、車間制御ECU2にて実行される車両走行制御処理の詳細について、図3〜図6のフローチャートを参照して説明する。
図3は、車間制御ECU2におけるメイン処理を示すフローチャートである。まず、最初のステップS100において状態遷移フラグ処理を行う。この状態遷移フラグ処理においては、クルーズメインスイッチ22のON・OFF状態に応じてメインスイッチフラグをON又はOFFに設定するメインスイッチフラグ処理,クルーズコントロールスイッチ20中のクルーズセットスイッチのON・OFF状態に応じてクルーズ制御中フラグをON又はOFFに設定するクルーズ制御中フラグ処理,車間制御中であるか否かに応じて車間クルーズ制御中フラグをON又はOFFに設定する車間クルーズ制御中フラグ処理,及びオーバーライド中であるか否かに応じてオーバライド中フラグをON又はOFFに設定するオーバライド中フラグ処理を順次行う。
【0028】
そして、目標車間距離演算を行う(S110)。このS110にて実行される目標車間距離演算処理の詳細について、図4,5のフローチャートに基づき説明する。
まず、図4のS1101に示すように、レーザレーダセンサ3の取付位置(詳しくはスキャニング測距器の掃引照射の原点)に基づき死角が生じる距離を算出する。その死角が生じる距離Z(Zr,Zl)は、センサ取付位置に基づいて、下記の式1により求める。
【0029】
Z=Xtan(θ/2) …[式1]
ここで、レーザレーダセンサ3による検知において水平方向の死角が生じる距離は、図7(a)に示すように、センサ光軸Oから左右の車幅方向端部までの各距離X(Xr,Xl)及びセンサの最大水平検知角度θによって決まる。
【0030】
なお、図7(a)で用いた記号の意味を下記のまとめておく。
θ:センサの最大水平検知角
Xr:センサ光軸から右の車幅方向端までの距離
Xl:センサ光軸から左の車幅方向端までの距離
Zr:センサ右側に死角が発生する距離
Zl:センサ左側に死角が発生する距離
O:センサの光軸中心
続くS1102では、レーザレーダセンサ3から得た情報に基づいて、先行車の有する一対のリフレクタ群を検出(特定)する。
【0031】
そして、S1103では、このように特定されたリフレクタ群について、センサ光軸Oから各リフレクタまでの水平方向の距離を計測する。この計測では、図7(b),(c)に示すように、リフレクタの長さも加味し、左のリフレクタの左端及び右のリフレクタの右端の内でセンサ光軸Oから最も離れているた方の端部を反射点xkとする。例えば図7(b),(c)で言えば、右のリフレクタの右端がセンサ光軸から最も遠い反射点xkとなる。なお、このように先行車として認識されているときの左右それぞれのリフレクタに対応すると考えられるセグメントの横長をSLS(Standard Left Segment)及びSRS(Standard Right Segment)とする。これらSLS,SRSについては、例えば所定期間(所定処理回数)連続してほぼ同じ長さを検出できている場合の値を採用すること等が考えられる。
【0032】
そして、続くS1104では目標車間距離候補Zkを求める。この処理について、図5のフローチャートを参照して説明する。
まず、S1141では、図4のS1103にて求めたセンサ光軸Oから反射点xkまでの距離(xk)及びセンサの最大水平検知角θに基づいて、図7(c)に示すように当該反射点xkがセンサ検知範囲から消えてしまう距離Zkを求める。
【0033】
続くS1142では、先行車の有する一対のリフレクタに対応するセグメントの横長RS,LSを算出する。上述のように、セグメントデータは、X軸及びZ軸に平行な2辺を持つ長方形の領域として規定され、中心座標(X,Z)と大きさを示すための2辺のデータ(幅W,奥行きD)をデータ内容とする。したがって、先行車の有する左側のリフレクタに対応するセグメントの幅Wが横長LS(Left Segment)となり、右側のリフレクタに対応するセグメントの幅Wが横長RS(Right Segmen)となる。
【0034】
そして、S1143〜S1145では、先行車の自車に対する相対速度とセグメントの横長RS,LSに基づいて、条件判断を行う。
まずS1143では先行車の相対速度が負か否かを判断し、相対速度が正又は零の場合は(S1143:NO)、S1141で算出した目標車間距離候補Zkをそのまま出力する(S1147)。
【0035】
また、先行車の相対速度が負の場合は(S1143:YES)、続くS1144にて、現在検出されている先行車の右のリフレクタに対応すると考えられるセグメントの横長RSが、S1142にて説明した、先行車として認識されているときの右のリフレクタに対応すると考えられるセグメントの横長SRSの2分の1の長さ未満か否かを判断する。そして、RS<SRS/2の場合は(S1144:YES)、S1141で算出した目標車間距離候補Zkを所定量増分する(S1146)。図8(a)に示すように自車両のセンサ検知範囲に先行車の左右のリフレクタが完全に入っている状態から、図8(b)に示すように自車両と先行車が近づき、先行車の右のリフレクタがセンサ検知範囲に半分未満しか入らない状態に移行したとする。このようなRS<SRS/2となっている状態に対応する目標車間距離候補Zk(図8(b)参照)をそのまま採用すると、さらに自車両が先行車に近づく結果となり、右のリフレクタがセンサ検知範囲から外れてしまう可能性がある。そのため、S1146では、目標車間距離候補Zkを所定量増分して、車間をより大きくする方向へ対処することで、そのような不都合が生じないようにしている。
【0036】
一方、RS≧SRS/2の場合は(S1144:NO)、S1145へ移行して、現在検出されている先行車の左のリフレクタに対応すると考えられるセグメントの横長LSが、先行車として認識されているときの左のリフレクタに対応すると考えられるセグメントの横長SLSの2分の1の長さ未満か否かを判断する。そして、LS<SLS/2の場合は(S1145:YES)、やはりS1146へ移行して、S1141で算出した目標車間距離候補Zkを所定量増分する(S1146)。なお、S1145にて否定判断、つまりRS≧SRS/2であり(S1144:NO)且つLS≧SLS/2の場合は、S1147へ移行し、S1141で算出した目標車間距離候補Zkをそのまま出力する(S1147)。
【0037】
図4に戻り、S1104の処理後は、S1105において、自車速から目標車間距離候補Zvを求める。
続くS1106では、上記S1104にて算出された目標車間距離候補ZkとS1105にて算出された目標車間距離候補Zvの内、値の大きな方を目標車間距離Dとして選択する。
【0038】
最終的に決定される目標車間距離は、上述したレーザレーダセンサ3の死角が発生する距離Z(Zr,Zl)より小さくなってはならない。そのため、S1107以下の処理にてその判断を行う。つまり、S1106で選択された目標車間距離Dがセンサ左側に死角が発生する距離Zlよりも大きく(S1107:YES)、且つセンサ右側に死角が発生する距離Zrよりも大きい場合(S1108:YES)は、最終的な目標車間距離としてS1106で選択された目標車間距離Dを採用する(S1110)。
【0039】
一方、S1108にて否定判断、つまりZl<D≦Zrの場合は、最終的な目標車間距離としてセンサ右側に死角が発生する距離Zrを採用する(S1111)。
また、S1107にて否定判断、つまりD≦Zlの場合には、S1109へ移行し、Zr>Zlか否かを判断する。そして、Zr>Zl(つまり、この場合はZr>Zl≧D)の場合は(S1109:YES)、S1111へ移行し、最終的な目標車間距離としてZrを採用する。また、Zr≦Zl(つまり、この場合はZl≧Zr≧D)の場合は(S1109:NO)、S1112へ移行し、最終的な目標車間距離としてZlを採用する。
【0040】
以上、図4及び5を参照して図3のS110における目標者間距離演算について説明したので、続いて図3のS120移行の処理を説明する。
S120では、セット車速演算を行う(S120)。ここでは、クルーズコントロールスイッチ20からの信号等に基づいて、クルーズ制御において、車間制御から定速制御に切り替わった際等のセット車速を、自車速度に対応して演算する処理を行う。
【0041】
続いて、カーブ半径を推定する(S130)。ここでは、ステアリングセンサ8にて検出された操舵角に基づき、自車前方の自車線のカーブ半径を演算する処理を行う。
続いて、先行車を選択する(S140)。ここでは、レーザレーダセンサ3より受信した物標データに基づいて先行車候補群を抽出し、先行車候補があれば、車間距離が最小の物標を先行車として選択する処理を行う。
【0042】
そして、車間クルーズ目標加速度演算処理を行う(S150)。ここでは、車間制御及び車速制御に用いる目標加速度を先行車の加速度に基づいて演算する。それでは、このS150にて実行される車間クルーズ目標加速度演算処理の詳細について、図6に基づき説明する。
【0043】
まず、同図(a)に示すように、先行車を認識中であるかどうかを判断する(S310)。このとき先行車を認識中でなければ(S310:NO)、上述した定速CC制御部での演算結果、つまり、先行車を未認識の場合のセット車速に制御するための加速度を目標加速度として設定する(S350)。
【0044】
一方、先行車を認識中であれば(S310:YES)、S320へ移行して車間距離偏差を演算する。この車間距離偏差(m)は、現在の車間距離から予め設定した目標車間距離を減算した値である。尚、目標車間距離は車速に応じて可変とすることで、より運転者の感覚に合致させることができる。
【0045】
さらに、続くS330にて相対速度を演算する。この相対速度の演算に際しては、ノイズなどの影響を減少させるため、複数回検出された相対速度を平滑化する。
そして、このようにして得られた車間距離偏差と相対速度に基づき、上述した低速ACC制御部と高速ACC制御部の各車間制御演算部において目標加速度を演算する(S340)。
【0046】
各車間制御演算部は、図6(b)に示すような車間距離偏差と相対速度に応じて目標加速度を決定するための制御マップを夫々備えており、この制御マップを参照して適切な目標加速度を選択する。この制御マップは、車間距離偏差(m)として−15,−10,−5,0,5,10,15の7つの値、相対速度(km/h)として16,8,0,−8,−16,−24の6つの値に対する目標加速度を示すものであるが、マップ値として示されていない値については、マップ内では直線補間により演算した値を採用し、マップ外ではマップ端の値を採用する。また、マップ内の値を用いる場合においても、所定の上下限ガードを施すことも考えられる。
【0047】
図3に戻り、このようにS150において車間制御及び車速制御における各目標加速度が夫々設定されると、このいずれの目標加速度をエンジンECU6に出力するか否かを判定する処理を行う。
すなわち、まずクルーズ制御中フラグがONであるか否かを判断し、クルーズ制御中フラグがOFFであれば(S160:NO)、そのまま本処理を終了する。 一方、クルーズ制御中フラグがONであれば(S160:YES)、続いて、警報演算を行う(S165)。
【0048】
この警報演算は、例えば警報要求を現在指示中なければ、所定の条件成立を判断して警報要求を指示するための処理を実行する。まず、以下の算出式に示すように、車速と相対速度に応じて警報距離を算出する。
警報距離=f(車速,相対速度)
次に、この警報距離よりも車間距離が短い状態が生じているかどうかを判断し、車間距離が警報距離以上の場合には何ら警報処理はしない。そして、警報距離よりも車間距離が短い場合には警報要求を成立させる。この警報要求信号が車間制御ECU2からエンジンECU6を介してブレーキECU4へ出力されると、ブレーキECU4はこの警報要求信号に応じて警報ブザー14を鳴動する。
【0049】
一方、現在警報要求中であれば、所定の条件成立を判断して警報要求を解除する。例えば警報要求が成立した後1秒経過していなければ、そのまま何もしない。これは、警報処理を実行した場合、少なくとも1秒間はその状態を続けるためである。そして、警報要求が成立した後1秒経過すると、車間距離が警報距離以上かどうかを判断し、車間距離が警報距離未満の場合には、そのまま何もしない。そして、車間距離が警報距離以上の場合には警報要求を解除する。
【0050】
S165の処理後は、オーバライド中フラグがONであるか否かを判断し(S170)、オーバライド中フラグがONであれば(S170:YES)、そのまま本処理を終了する。
一方、オーバライド中フラグがOFFであれば(S170:NO)、続いて、車間クルーズ制御中フラグがONか否かを判断する(S180)。そして、車間クルーズ制御中フラグがONであれば(S180:YES)、S150にて演算した車間制御用の目標加速度を制御目標加速度として設定し、車間クルーズ制御中フラグがOFFであれば(S180:NO)、S150にて演算した車速制御用の目標加速度を制御目標加速度として設定する。
【0051】
そして、このようにして設定された制御目標加速度を、エンジンECU6に対して制御指令値として出力する。エンジンECU6では、この制御目標加速度を実現するためのエンジン制御を実行する。
尚、本実施例において、車間制御ECU2が、先行車選択手段及び車間制御手段に該当し、レーザレーダセンサ3が物体認識手段に該当する。
【0052】
以上説明したように、本実施例の車両走行制御装置1においては、レーザレーダセンサ3にて、先行車後端の左右端部付近に存在すると考えられる一対のリフレクタに対応するセグメントを特定し、その一つのセグメントが共にレーザレーダセンサ3の検知角内に含まれるような最短距離、つまりレーザレーダセンサ3の死角が発生する距離Z(Zr,Zl)を算出し、目標車間距離が最短距離よりも短くならないように調整する。このようにすることで、先行車が図9に示すキャリアカーのようなリフレクタ間に反射物がない特殊形状の車両であったとしても、接近しすぎてレーザ光がリフレクタ間を通過してしまう状況を回避できる。そのため、先行車が存在しないと誤認識してしまったり、あるいは、実際のよりも遠い位置に先行車が存在すると誤認識してしまうことを防止でき、適切な車間制御を実現できるようになる。
【0053】
また、実際の車間制御においては車間の変化に対して自車両の挙動が制御されるまでに多少の時間差があるため、例えばリフレクタのほんの一部でも認識できていればよいとすると、リフレクタを全く認識できない状態に移行し易い。そこで本実施例では、図5に示す処理を実行することで、センサ検知範囲に先行車の左右のリフレクタのいずれか一方が半分未満しか検知できない状況になり且つ相対速度が負の場合に目標車間距離を増分するようにした。これにより、真に必要な状況になって初めて目標車間距離候補Zkが所定量増分される可能性が高くなり、上述の課題にも対応できる。
【0054】
なお、リフレクタとしてはブレーキランプ等のような反射物が主に考えられるが、ボディ自体であってもレーザ光を良好に反射するものであればリフレクタになり得る。キャリアカーの場合には、車両後部の左右には支柱があり、またブレーキランプ等もやはり左右に存在するので、ブレーキランプが検出できなければリフレクタが検出できないというわけではないことは付言しておく。
【0055】
以上、本発明の実施例について説明したが、本発明の実施の形態は、上記実施例に何ら限定されることなく、本発明の技術的範囲に属する限り種々の形態をとり得ることはいうまでもない。
(1)例えば上記実施例では、図5のS1144,S1145に示すように、で、センサ検知範囲に先行車の左右のリフレクタのいずれか一方が半分未満しか検知できない状況になった時点で目標車間距離を増分するようにしたが、これは、リフレクタ本来の長さに対して所定割合小さくなった場合の一例として「半分」としたのであるが、例えば「3分の2」や「3分の1」といった他の割合を採用することも可能である。
【0056】
(2)上記実施例ではより適切な車間制御を実行するため、左右のリフレクタのいずれか一方が半分未満しか検知できない状況になり且つ相対速度が負の場合に目標車間距離を増分するようにした。しかし、このような対処はせずに、単純に、先行車の一対のリフレクタに対応するセグメント位置がレーザレーダセンサ3の検知角内に共に含まれるように目標車間距離を調整するだけでもよい。その場合、一対のリフレクタそれぞれの中心位置に着目し中心位置が含まれるようにすることもできるし、一対のリフレクタ全体に着目した場合の左右端まで全て含まれるようにすることもできる。つまり、先行車後部の左端付近に存在するリフレクタであればその左端位置、右端付近に存在するリフレクタであればその右端位置に着目し、それらの位置が電磁波送信の所定角度内に共に含まれるように車間制御するのである。このようにすれば、確実に一対のリフレクタを捉えることができ、ロスト防止には確実である。
【0057】
(3)上記実施例ではレーザレーダセンサ3が水平方向、つまり車幅方向の所定角度範囲を検知角としたが、車高方向の所定角度範囲を検知角とする場合であっても同様に実施できる。車両後部の上下端にしかリフレクタが存在しないような特殊形状の先行車であれば、このような対処が有効である。
【0058】
また、車幅方向及び車高方向の2次元スキャンが可能なレーザレーダセンサも知られており、このようなレーザレーダセンサを用いた場合にも同様の考え方を適用できる。
(4)減速手段としては、上述した実施例で説明したものも含め、採用可能なものを挙げておく。ブレーキ装置のブレーキ圧を調整して行うもの、内燃機関に燃料が供給されるのを阻止するフューエルカット制御、前記内燃機関に接続された自動変速機がオーバードライブのシフト位置となるのを禁止するオーバードライブカット制御、前記自動変速機を高位のシフト位置からシフトダウンさせるシフトダウン制御、前記内燃機関の点火時期を遅らせる点火遅角制御、前記自動変速機が備えたトルクコンバータをロックアップ状態にするロックアップ制御、前記内燃機関からの排気の流動抵抗を増加させる排気ブレーキ制御およびリターダ制御を実行して行うものなどである。
【0059】
(5)また、上記実施例においては、車間距離をそのまま用いていたが、車間距離を車速で除算した車間時間を用いても同様に実現できる。つまり、相対速度と車間時間偏差比をパラメータとする目標加速度の制御マップを準備しておき、制御時には、その時点での相対速度と車間時間偏差比に基づいて目標加速度を算出して、車間制御を実行するのである。
【0060】
(6)上記実施例では「物体認識手段」としてレーザ光を用いたレーザレーダセンサ3を採用したが、ミリ波等の電波や超音波等を用いるものであってもよい。また、スキャン方式にこだわる必要はなく、距離以外に方位を測定できる方式であればよい。そして、例えばミリ波でFMCWレーダ又はドップラーレーダなどを用いた場合には、反射波(受信波)から先行車までの距離情報と先行車の相対速度情報が一度に得られるため、レーザ光を用いた場合のように、距離情報に基づいて相対速度を算出するという過程は不要となる。
【図面の簡単な説明】
【図1】実施例の車両走行制御装置のシステムブロック図である。
【図2】実施例のオートクルーズ制御の概略を示す状態遷移図である。
【図3】車間制御ECUにて実行されるメイン処理を示すフローチャートである。
【図4】メイン処理中で実行される目標車間距離演算処理を示すフローチャートである。
【図5】目標車間距離演算処理中で実行される目標車間距離候補Zk演算処理を示すフローチャートである。
【図6】メイン処理中で実行される目標加速度演算処理を示すフローチャート及びその演算に用いる制御マップの説明図である。
【図7】レーザレーダセンサの死角を生じる距離等の説明図である。
【図8】リフレクタの一部がセンサ検知角から外れていく様子を示す説明図である。
【図9】特殊形状車両における車間制御の問題点を示す説明図である。
【符号の説明】
1…車両走行制御装置、2…車間制御用電子制御装置(車間制御ECU)、3…レーザレーダセンサ、4…ブレーキ電子制御装置(ブレーキECU)、6…エンジン電子制御装置(エンジンECU)、8…ステアリングセンサ、10…ヨーレートセンサ、12…車輪速センサ、14…警報ブザー、15…アクセルペダルセンサ、16…車速センサ、18…ブレーキスイッチ、20…クルーズコントロールスイッチ、22…クルーズメインスイッチ、24…スロットルアクチュエータ、25…ブレーキアクチュエータ、26…トランスミッション
Claims (4)
- 自車両を加減速させる加速手段及び減速手段と、
車幅方向又は車高方向の少なくともいずれか一方の所定角度に渡り電磁波を掃引送信し、前記送信した電磁波が反射物体にて反射された反射波を受信し、その反射波に基づいて認識対象の物体の自車に対する相対位置及び相対速度を算出する物体認識手段と、
前記物体認識手段にて認識された物体の相対位置に基づき、自車に対する先行車を選択する先行車選択手段と、
前記先行車選択手段によって選択された先行車と自車との実車間距離に相当する物理量である実車間物理量と、自車と先行車との目標車間距離に相当する物理量である目標車間物理量との差である車間偏差、及び自車と先行車との相対速度に基づいて車間制御量を算出し、その算出された車間制御量に基づき前記加速手段及び減速手段を駆動制御することによって、自車を先行車に追従させて走行させる車間制御手段と、
を備える車間制御装置において、
前記車間制御手段は、
前記先行車選択手段によって選択した先行車の後端部における車幅方向又は車高方向の端部付近に存在する一対のリフレクタの位置が前記物体認識手段による電磁波送信の所定角度内に共に含まれるという条件を満たす最短距離を算出する最短距離算出手段と、
前記目標車間距離が前記最短距離算出手段にて算出された最短距離よりも短くならないように調整する目標車間距離調整手段とを備えること
を特徴とする車間制御装置。 - 請求項1に記載の車間制御装置において、
前記最短距離算出手段は、前記一対のリフレクタ全体に着目した場合の車幅方向端位置又は車高方向端位置を用いて算出すること
を特徴とする車間制御装置。 - 請求項1に記載の車間制御装置において、
前記最短距離算出手段は、前記一対のリフレクタそれぞれの中心位置を用いて算出すること
を特徴とする車間制御装置。 - 請求項1に記載の車間制御装置において、
前記物体認識手段は、前記認識した物体の長さも認識可能であり、
前記目標車間距離調整手段は、
先行車の一対のリフレクタの長さに関して、安定的に認識されている状態で認識したリフレクタ本来の長さを記憶しておき、
その後、前記物体認識手段にて認識した一対のリフレクタ長さの内の少なくとも一方が前記記憶されている対応値よりも所定割合小さくなり、且つ自車と先行車との相対速度が負の場合には、先行車から離れる挙動となる目標車間距離に調整すること
を特徴とする車間制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002165942A JP3969198B2 (ja) | 2002-06-06 | 2002-06-06 | 車間制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002165942A JP3969198B2 (ja) | 2002-06-06 | 2002-06-06 | 車間制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004009885A JP2004009885A (ja) | 2004-01-15 |
JP3969198B2 true JP3969198B2 (ja) | 2007-09-05 |
Family
ID=30433660
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002165942A Expired - Fee Related JP3969198B2 (ja) | 2002-06-06 | 2002-06-06 | 車間制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3969198B2 (ja) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3987044B2 (ja) | 2004-02-19 | 2007-10-03 | 本田技研工業株式会社 | 車間距離制御装置 |
JP4882844B2 (ja) * | 2007-04-18 | 2012-02-22 | トヨタ自動車株式会社 | 制動灯検出装置 |
JP6011489B2 (ja) | 2013-08-26 | 2016-10-19 | トヨタ自動車株式会社 | 車載制御装置 |
CN106585623B (zh) * | 2016-12-21 | 2023-12-01 | 驭势科技(北京)有限公司 | 一种用于探测车辆周围目标的探测***以及其应用 |
JP7324059B2 (ja) * | 2019-06-10 | 2023-08-09 | 株式会社Subaru | 車両用物体検出装置 |
JP7494827B2 (ja) | 2021-10-14 | 2024-06-04 | トヨタ自動車株式会社 | 運転支援装置、車両、運転支援方法及び運転支援プログラム |
-
2002
- 2002-06-06 JP JP2002165942A patent/JP3969198B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2004009885A (ja) | 2004-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3891011B2 (ja) | クルーズ制御装置、プログラム | |
JP7163589B2 (ja) | 運転支援装置 | |
JP3681620B2 (ja) | 車両用障害物認識装置 | |
JP4513662B2 (ja) | 車載レーダ装置、車両制御システム | |
US20030045991A1 (en) | Travel control system for vehicle | |
JP3736520B2 (ja) | 車両用障害物認識装置 | |
JP7176415B2 (ja) | 衝突前制御装置 | |
US20090228184A1 (en) | Vehicle Control Device and Vehicle Control Method | |
US20080106459A1 (en) | Radar Sensor And Method for Distance And Cruise Control | |
JP6321373B2 (ja) | 進路推定装置,及びプログラム | |
JP2002040139A (ja) | 物体認識方法及び装置、記録媒体 | |
JP2001287568A (ja) | 車間制御方法及び装置、車間警報方法及び装置、記録媒体 | |
JP4066573B2 (ja) | 先行車選択装置、車間制御装置及び記録媒体 | |
JP2000025486A (ja) | 車間距離制御装置及び記録媒体 | |
JP4692077B2 (ja) | 先行車検出装置 | |
CN114834444A (zh) | 车辆控制装置 | |
JP3621005B2 (ja) | 車両用障害物認識装置、車間制御装置、車間警報装置及び記録媒体 | |
JP3969198B2 (ja) | 車間制御装置 | |
JP5994757B2 (ja) | 車両の制御装置 | |
JP2000235699A (ja) | 車間距離制御装置 | |
JP3661492B2 (ja) | 車間制御装置及び記録媒体 | |
CN111591287A (zh) | 碰撞前控制装置 | |
JP3512063B2 (ja) | 先行車両の横方向相対速度計測方法 | |
US20240174230A1 (en) | Vehicle control device | |
JP4556597B2 (ja) | 先行車両検出装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040907 |
|
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: 20070515 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070528 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 3969198 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100615 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110615 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110615 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120615 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120615 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130615 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140615 Year of fee payment: 7 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |