JP4075624B2 - 車載レーダ装置,プログラム - Google Patents
車載レーダ装置,プログラム Download PDFInfo
- Publication number
- JP4075624B2 JP4075624B2 JP2003018922A JP2003018922A JP4075624B2 JP 4075624 B2 JP4075624 B2 JP 4075624B2 JP 2003018922 A JP2003018922 A JP 2003018922A JP 2003018922 A JP2003018922 A JP 2003018922A JP 4075624 B2 JP4075624 B2 JP 4075624B2
- Authority
- JP
- Japan
- Prior art keywords
- target
- cycle
- extrapolation
- vehicle
- predicted
- 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 - Lifetime
Links
Images
Landscapes
- Radar Systems Or Details Thereof (AREA)
Description
【発明の属する技術分野】
本発明は、レーダ波を送受信することにより、レーダ波を反射した先行車両等の物標を検出する車載レーダ装置に関する。
【0002】
【従来の技術】
従来より、電波を送信し、その反射波を受信して前方車両や路側物等の各種物標に関する情報(距離,相対速度,方位)を求める車載レーダ装置が知られている。
【0003】
具体的には、レーダ波の周波数が増加する上り区間、及び周波数が減少する下り区間のそれぞれについて、ビート信号に対し高速フーリエ変換(FFT)に代表される周波数解析処理を施すことにより、ビート信号の各区間毎のパワースペクトルを求める。そして、パワースペクトルから抽出したピーク周波数成分(以下では単に「ピーク」と称する。)を両区間の間で適宜組み合わせて、その組み合わせたピーク(以下では「ピークペア」と称する。)の周波数を、FMCWレーダにおいて周知の計算式に当てはめることにより、そのピークペアにて特定される物標との距離や相対速度を求めている。
【0004】
ところで、物標から直接受信される電波と、道路などに反射して受信される電波とが干渉し合ういわゆるマルチパス現象等により、物標からの反射が一時的に受信できなくなる場合がある。この場合、その物標を認識できずにロストしてしまい、その物標に関する情報の提供が中断されることになる。
【0005】
これに対して、前サイクルで認識された物標(前サイクル物標)をロストした場合、その前サイクル物標の情報から、その物標が今サイクルで検出された場合に持つべき情報(位置,速度)を予測し、その予測した物標を外挿することが行われている(例えば、特許文献1参照。)。
【0006】
【特許文献1】
特開平5−150035号公報(段落[0008])
【0007】
【発明が解決しようとする課題】
しかし、この方法では、物標の過去の挙動に基づく動きの予測であり、基本的に物標が前サイクルの時と同じ状態を保っていることを前提として、外挿する物標についての情報を求めている。このため、道路が直線ではなかったり、物標の挙動に変化(加減速や車線変更など)があると、実際とは大きく異なった位置や、道路外など本来ならばあり得ない位置に物標が外挿されてしまう可能性があるという問題があった。
【0008】
また、物標が小さかったり、比較的遠距離に物標が存在する等して、レーダ波のビーム幅が物標の幅より広くなる領域では、物標の正確な横位置(ビームの走査方向に沿った位置/方位)を特定できず、物標が検出されたビームの中心軸に沿った方向が、物標の方向として検出される。このような状況で外挿が行われると、外挿する物標の予測に使用される前サイクル物標の横位置精度が低いため、上述のように、本来ならばあり得ない位置に物標が外挿されてしまう可能性があった。
【0009】
本発明は、上記問題点を解決するために、物標の外挿が可能なレーダ装置において、外挿の位置精度及び信頼性を向上させることを目的とする。
【0010】
【課題を解決するための手段】
上記目的を達成するためになされた本発明の車載レーダ装置では、物標認識手段が、予め設定された測定サイクル毎に、レーダ波を送受信することで得られる情報に基づいて前記レーダ波を反射した物標を認識する。そして、前回の測定サイクルで認識された物標を前サイクル物標、今回の測定サイクルで認識された物標を今サイクル物標とし、前サイクル物標から算出した該前サイクル物標に対応する今サイクル物標の予測位置,予測速度と、今サイクル物標の検出位置,検出速度との差分が、いずれも予め設定された上限値より小さい場合に履歴接続があるものとして、前サイクル物標が、今サイクル物標のいずれとも履歴接続がない場合に、外挿手段が、その前サイクル物標から予測される物標を、実際に認識されたものとして外挿する。
【0011】
これと共に、道路形状推定手段が、走行中の道路形状を推定し、外挿手段による外挿物標が、移動体であり且つ道路形状推定手段にて推定された道路端に沿って設定される禁止区域内にある場合、第1補正手段が、外挿物標の位置を、道路端と禁止区域との境界となる位置に変更する。
このように、本発明のレーダ装置では、物標の過去の履歴から求めた外挿すべき物標の位置を、実際に走行中の道路形状に基づいて補正しているため、実際とは大きく異なった位置や、道路外など本来ならばあり得ない位置に物標が外挿されることを防止でき、外挿の位置精度、及び信頼性を向上させることができる。
【0012】
なお、道路形状推定手段では、道路形状を、例えば、物標認識手段が認識する物標の中から抽出した停止物に基づいて推定してもよいし、外部より入力される車両の推定走行軌跡の曲率半径を示す推定R値に基づいて推定してもよいし、或いは、外部より入力される当該装置を搭載した車両の位置と、該位置に対応した地図データとに基づいて推定してもよい。
【0013】
ところで、車線変更中の車両など道路を横切る方向に大きな速度や加速度を有する物標や、大きく曲がった道路を走行中の物標をロストした場合に、ロスト前の情報に基づいて予測を行うと、横位置が道路からはずれてしまうことがある。
そこで、第1補正手段では、外挿物標の横位置のみを、禁止区域の境界となる位置に変更するように構成してもよい。
【0014】
ここで、横位置とは、車両の進行方向とは直交する方向に沿った位置のことであり、これに対応して縦位置とは車両の進行方向に沿った位置のことである(以下同様。)。そして、禁止区域は推定された道路端を挟んで両側に設定してもよいし、その道路端から道路側だけに設定してもよい。なお、横位置が変更される禁止区域の境界とは、道路側の境界のことをいう。また、禁止区域のうち道路端から道路側の領域幅は、少なくとも普通乗用車の平均的な車幅の半分程度に設定されていればよい。この場合、外挿物標が移動体、即ち走行中の車両であれば、その車両が道路端からはみだすことがないように横位置を補正することができる。
【0015】
但し、上述のように外挿物標の横位置のみを補正すると、場合によっては、外挿物標との距離が補正前と補正後とで大きく変化してしまい、却って予測位置の精度を劣化させてしまうおそれがある。
そこで、外挿手段にて設定された位置と第1補正手段により変更された位置との位置差が、予め設定された許容値より大きい場合、更に、縦位置変更手段が、その位置差が許容値以下となるように、外挿物標の縦位置を変更するように構成することが望ましい。
【0016】
また、外挿手段による物標の外挿が連続すると、物標の挙動は、最後に検知された時の状態から変化している可能性が高くなり、実際の物標に対する外挿された物標の誤差が大きくなることが考えられる。
そこで、第2補正手段が、外挿手段による物標の外挿が連続した場合に、外挿手段が外挿する物標の位置の予測に使用するパラメータの値を、前サイクル物標の位置から、該パラメータによって予測される位置までの距離が抑制されるように補正するように構成してもよい。
【0017】
特に、一定の加速度や減速度が長期間に渡って維持される可能性は低いものと考えられるため、第2補正手段が補正するパラメータには、少なくとも加速度(減速度)が含まれていることが望ましい。
なお、このような第2補正手段は、道路形状推定手段や第1補正手段と共に設けてもよいが、これら道路形状推定手段や第1補正手段を設けることなく、単独で設けてもよい。
【0018】
ところで、上記レーダ装置を構成する各手段は、コンピュータを機能させるためのプログラムとして構成してもよい。
この場合、そのプログラムを、コンピュータが読み取り可能な記録媒体に記憶させ、その記憶させたプログラムを必要に応じてコンピュータシステムにロードして起動することにより用いることができる。なお、記録媒体は、持ち運び可能なものであってもよいし、コンピュータシステムに組み込まれたものであってもよい。また、プログラムは、ネットワークを介してコンピュータシステムにロードするものであってもよい。
【0019】
【発明の実施の形態】
以下に本発明の実施形態を図面と共に説明する。
図1は、実施形態のレーダセンサ1の構成、及びレーダセンサ1を用いて構成したクルーズ制御システムの概略構成を示したブロック図である。
【0020】
クルーズ制御システムは、車間制御電子制御装置(以下「車間制御ECU」と称す。)30、エンジン電子制御装置(以下「エンジンECU」と称す。)32、ブレーキ電子制御装置(以下「ブレーキECU」と称す。)34を備え、これらはLAN通信バスを介して互いに接続されている。また、各ECU30,32,34は、いずれも周知のマイクロコンピュータを中心に構成され、少なくともLAN通信バスを介して通信を行うためのバスコントローラを備えている。尚、本実施形態では、LAN通信バスを介して行うECU間のデータ通信は、車載ネットワークで一般的に利用されているCAN(ドイツ、Robert Bosch 社が提案した「Controller Area Network」)プロトコルを用いている。
【0021】
また、車間制御ECU30には、図示しない警報ブザー、クルーズコントロールスイッチ、目標車間設定スイッチ等が接続されている他、本発明のレーダ装置に相当するレーダセンサ1が接続されている。
ここで、レーダセンサ1は、FMCW方式のいわゆる「ミリ波レーダ」として構成されたものであり、周波数変調されたミリ波帯のレーダ波を送受信することにより、先行車や路側物等の物標を認識し、これら認識した物標に関する情報である物標情報や、レーダセンサ1自身のダイアグ情報等を生成して、車間制御ECU30に送信する。なお、物標情報には、少なくとも相対速度及び位置(距離データ及び横位置データ)が含まれている。
【0022】
ブレーキECU34は、ステアリングセンサ、ヨーレートセンサからの検出情報(操舵角,ヨーレート)に加え、M/C圧センサからの情報に基づいて判断したブレーキペダル状態を、LAN通信バスを介して車間制御ECU30に送信すると共に、その判断したブレーキペダル状態に従って、ブレーキ力を制御するためにブレーキ油圧回路に備えられた増圧制御弁・減圧制御弁を開閉するブレーキアクチュエータを制御するように構成されている。
【0023】
エンジンECU32、車速センサ、スロットル開度センサ、アクセルペダル開度センサからの検出情報(車速,エンジン制御状態、アクセル操作状態)を車間制御ECU30に送信すると共に、車間制御ECU30からは目標加速度、フューエルカット要求、ダイアグ情報等を受信し、これら受信した情報から特定される運転状態に応じて、内燃機関(ここでは、ガソリンエンジン)のスロットル開度を調整するスロットルアクチュエータ等に対して駆動命令を出力するように構成されている。
【0024】
車間制御ECU30は、エンジンECU32から現車速やエンジン制御状態、ブレーキECU34からは操舵角、ヨーレート、ブレーキ制御などの制御状態等を受信する。そして、レーダセンサ1から受信した先行車情報に基づいて車間距離制御すべき先行車を決定し、クルーズコントロールスイッチや目標車間設定スイッチからの検出信号に基づき、先行車との車間距離を適切に調節するための制御指令値として、エンジンECU32には目標加速度、フューエルカット要求、ダイアグ情報等を送信し、ブレーキECU34には、目標加速度、ブレーキ要求等を送信する。また、車間制御ECU30は、警報発生の判定を行い、警報が必要な場合には警報ブザーを鳴動させるように構成されている。
【0025】
次に、レーダセンサ1は、時間に対して周波数が直線的に増加する上り区間、及び周波数が直線的に減少する下り区間を有するように変調されたミリ波帯の高周波信号を生成する発振器10と、発振器10が生成する高周波信号を増幅する増幅器12と、増幅器12の出力を送信信号Ssとローカル信号Lとに電力分配する分配器14と、送信信号Ssに応じたレーダ波を放射する送信アンテナ16と、レーダ波を受信するn個の受信アンテナからなる受信側アンテナ部20とを備えている。
【0026】
また、レーダセンサ1は、受信側アンテナ部20を構成するアンテナのいずれかを順次選択し、選択されたアンテナからの受信信号Srを後段に供給する受信スイッチ21と、受信スイッチ21から供給される受信信号Srを増幅する増幅器22と、増幅器22にて増幅された受信信号Sr及びローカル信号Lを混合してビート信号BTを生成するミキサ23と、ミキサ23が生成したビート信号BTから不要な信号成分を除去するフィルタ24と、フィルタ24の出力をサンプリングしデジタルデータに変換するA/D変換器25と、発振器10の起動,停止や、A/D変換器25を介したビート信号BTのサンプリングを制御すると共に、そのサンプリングデータを用いた信号処理や、車間制御ECU30との通信を行い、信号処理に必要な情報(車速,道路形状情報)、及びその信号処理の結果として得られる情報(物標情報,ダイアグ情報等)を送受信する処理等を行う信号処理部26とを備えている。
【0027】
このうち、受信側アンテナ部20を構成する各アンテナは、そのビーム幅がいずれも送信アンテナ16のビーム幅全体を含むように設定されている。そして、各アンテナがそれぞれCH1〜CHnに割り当てられている。
また、信号処理部26は、周知のマイクロコンピュータを中心に構成され、更に、A/D変換器25を介して取り込んだデータについて、高速フーリエ変換(FFT)処理等を実行するための演算処理装置(例えばDSP)を備えている。
【0028】
このように構成された本実施形態のレーダセンサ1では、信号処理部26からの指令に従って発振器10が起動すると、その発振器10が生成し、増幅器12が増幅した高周波信号を、分配器14が電力分配することにより、送信信号Ss及びローカル信号Lを生成し、このうち送信信号Ssは、送信アンテナ16を介してレーダ波として送出される。
【0029】
そして、送信アンテナ16から送出され物標に反射して戻ってきたレーダ波(反射波)は、受信側アンテナ部20を構成する全ての受信アンテナにて受信され、受信スイッチ21によって選択されている受信チャンネルCHi(i=1〜n)の受信信号Srのみが増幅器22で増幅されたあとミキサ23に供給される。すると、ミキサ23では、この受信信号Srに分配器14からのローカル信号Lを混合することによりビート信号BTを生成する。このビート信号BTは、フィルタ24にて不要な信号成分が除去された後、A/D変換器25にてサンプリングされ、信号処理部26に取り込まれる。
【0030】
なお、受信スイッチ21は、レーダ波の一変調周期の間に、全てのチャンネルCH1〜CHnが所定回(例えば512回)ずつ選択されるよう切り替えられ、また、A/D変換器25は、この切替タイミングに同期してサンプリングを行う。つまり、レーダ波の一変調周期の間に、各チャンネルCH1〜CHn毎かつレーダ波の上り/下り各区間毎にサンプリングデータが蓄積されることになる。
【0031】
ここで、レーダセンサ1の信号処理部26が実行するメイン処理を、図2に示すフローチャートに沿って説明する。
本処理では、まず車間制御ECU30から、現車速,道路形状情報(ここでは推定R値)を受信すると(S10)、VCO10を起動することでレーダ波の送信を開始し(S12)、A/D変換器25を介してビート信号BTのサンプリング値を取り込む(S14)。必要なだけサンプリング値を取り込むと、VCO10を停止することでレーダ波の送信を停止する(S16)。
【0032】
次に、取り込んだサンプリング値について周波数解析処理(ここではFFT処理)を実行して、各チャンネルCH1〜CHn毎かつ上り/下り各区間毎にビート信号BTのパワースペクトルを求める(S18)。
このようにして求められたパワースペクトルを、各区間毎に全チャンネルについて平均化することで得られた平均化パワースペクトル上のピークであって、パワー値が予め設定されたしきい値より大きいものを抽出すると共に、各ピークを発生させたレーダ波の到来方向を示すピーク方位を算出する(S20)。なお、ピーク方位は、例えば、各チャンネルCH1〜CHnにて検出される同一ピークの信号成分に基づき、これら信号成分の位相差から算出することができる。
【0033】
このようにして抽出されたピークに基づき、上り区間のピークと下り区間のピークとの組み合わせを設定し、その設定したピークの組合せのうち、組み合わせた両ピークのパワー差及び角度差が予め設定された許容範囲内にあるものを抽出する。更に、FMCWレーダにおける周知の方法にて、両ピークから特定されれる物標の距離,相対速度を算出し、その算出距離が予め設定された上限距離より小さく、且つその算出速度が予め設定された下限速度より大きく,上限速度より小さいもののみをピークペアとしてペア登録する(S22)。なお、ピークペアには、それぞれ検出カウンタが割り当てられ、そのカウント値CNTiはゼロに初期化される。また、本ステップでは、算出した距離とS20にて求めたピーク方位とに基づいて、横位置及び縦位置も算出される。
【0034】
以下、S22にてペア登録されたピークペアに基づき、履歴追尾(S24)、物標認識(S26)、道路形状計算(S28)、物標外挿(S30)を行い、更に、物標認識にて認識された物標、及び物標外挿にて外挿された物標についての物標情報(速度,位置)やレーダセンサ1のダイアグ情報を車間制御ECU30に送信(S32)して本処理を終了する。
【0035】
以下では、S24〜S30に示した各処理の詳細について順番に説明する。
まず、S24の履歴追尾では、図3のフローチャートに示すように、前サイクルにてペア登録されたピークペア(以下では「前サイクルペア」と称する。)の個数がゼロであるか否か(S240)、また、今サイクルにてペア登録されたピークペア(以下では「今サイクルペア」と称する。)の個数がゼロであるか否か(S241)を判断し、いずれか一方でもゼロであれば、本処理を終了する。
【0036】
前サイクルペアの個数、及び今サイクルペアの個数のいずれもがゼロでなければ、今サイクルペアと前サイクルペアとの組み合わせを設定し(S242)、その組み合わせたペア(以下では「組合せペア」と称する。)のいずれか一組を取り出す(S243)。
【0037】
取り出した組合せペアのうち、前サイクルペアの情報に基づいて、その前サイクルペアに対応する今サイクルペアの予測位置及び予測速度を算出する(S244)。なお、予測位置の算出は、S10にて道路形状情報として取得した推定R値(車両の推定走行軌跡の曲率半径)を利用して行うものとする。
【0038】
そして、算出した予測位置,予測速度と、今サイクルペアから求めた検出位置,検出速度とに基づいて、両者の位置差分,速度差分を求める(S245)。
その位置差分が予め設定された上限位置差DRTSDより小さく、且つ速度差分が予め設定された上限速度差DVTSDより小さいか否かを判断し(S246)、いずれも小さい場合にのみ、組合せペアを構成する両ピークペアは履歴接続があるものとして、今サイクルペアの検出カウンタのカウント値CNTiを、前サイクルペアの検出カウンタのカウント値CNTiに1を加算した値で更新する(S247)。
【0039】
次に、今サイクルペアにて特定される物標の位置・速度・加速度を設定する(S248)。但し、検出カウンタが更新された今サイクルペアについては、対応する前サイクルペアの持つ履歴情報を利用して、今サイクルペアから求めた位置,速度をフィルタ処理等によって平滑化し、その平滑化された速度と前サイクルペアの速度とに基づいて加速度を算出する。そして、以後では、今サイクルペアの情報として、これら平滑化した位置,速度、及び算出した加速度を用いる。一方、検出カウンタが更新されなかった今サイクルペアについては、今サイクルペアから求めた位置,速度をそのまま今サイクルペアの情報として使用し、加速度の算出は行わない。
【0040】
そして、先のS242にて設定した全ての組合わせペアについて、上述の処理(S243〜S248)を実行したか否かを判断し(S249)、未処理の組合わせペアがある時はS243に戻り、一方、全ての組合わせペアについて処理が終了していれば、本処理を終了する。
【0041】
つまり、本処理を実行することにより、前サイクルペアとの履歴接続がある今サイクルペアには、対応する前サイクルペアの情報(検出カウンタのカウント値CNTi)が引き継がれると共に加速度が求められ、一方、前サイクルペアとの履歴接続がない今サイクルペアについては、検出カウンタのカウント値CNTiはゼロのままとなる。
【0042】
次にS26の物標認識では、今サイクルペアのうち、検出カウンタのカウント値CNTiが予め設定された認識しきい値CNTTSD以上であるもの、即ち、認識しきい値CNTTSD回以上の履歴接続が確認されたものを、物標として認識し、これを認識物標登録する。
【0043】
次にS28の道路形状計算では、図4のフローチャートに示すように、S20にて抽出されたピークの中から停止物を抽出する停止物抽出(S280)、及び抽出した停止物に基づいて道路端を位置を求める道路端算出(S290)を実行する。
【0044】
このうちS280の停止物抽出では、図5のフローチャートに示すように、今回の測定サイクルにおいて先のS26にて登録された物標である今サイクル物標の個数がゼロであるか否かを判断し(S281)、ゼロであればそのまま本処理を終了する。一方、今サイクル物標の個数がゼロでなければ、その中から一つを取り出し(S282)、その今サイクル物標の絶対速度を示す物標絶対速度を算出する(S283)。この物標絶対速度は、物標の相対速度(但し、自車両から遠ざかりつつある場合をプラスとする。)にS10にて取得した自車速度を加算した結果の絶対値をとることで算出される。
【0045】
この物標絶対速度が予め設定された許容停止速度S_TSD(本実施形態では10km/h)より小さいか否かを判断し(S284)、許容停止速度S_TSDより小さければ、その物標を停止物として停止物登録をする(S285)。
そして、全ての今サイクル物標について上述の処理(S282〜S285)を実行したか否かを判断し(S286)、未処理の今サイクル物標があれば、S282に戻り、全ての今サイクル物標について処理が終了していれば、本処理を終了する。
【0046】
一方S290の道路端算出では、図6のフローチャートに示すように、まず、S291では、S285にて停止物登録された物標を、その方位角度順に並ぶようにソートし(S291)、そのソートされた物標を、左角度方向から右角度方向へと、条件に合う停止物をグルーピングし、路側物群(左)を形成する(S292)。
【0047】
このとき、路側物群として、道路形状の認識を路側に設置されたデリニエータのみが抽出されるように、次の▲1▼,▲2▼いずれか一方の排除条件でも満たす停止物は、看板や車両などであるものと判断して排除してもよい。
▲1▼横幅Wが大の停止物
排除条件:横幅W≧1.2m且つ縦横比D/W<5
▲2▼移動物体の近傍に位置する停止物
排除条件:中心間距離が横方向ΔX≦2m,又は縦方向ΔZ≦2m
また、条件に見合う停止物とは、左角度方向から右角度方向へと、距離Zが単調増加で且つ次の接続条件を満たすもののことである。
【0048】
接続条件:中心間距離がΔX≦3.5m,ΔZ≦55m
なお、距離が減少した場合、あるいは距離は単調増加であっても上記接続条件を満たさない場合には、別の新たな路側物群(左)を形成する。ここでは、停止物が1つの場合であっても一つの路側物群(左)とするが、道路端の認識に際しては、停止物が3つ以上の路側物群(左)のみを使用する。
【0049】
そして、このようにして形成された路側物群(左)を構成する停止物の中で、縦方向への距離Zが最も大きい、つまり最遠停止物については、それが道路の左側のものか右側のものかを判断し、道路右側のものであると判断した場合には、路側物群(左)から除外する(S293)。
【0050】
ここで、最遠停止物についての判断では、まず、路側物群(左)の中から最遠停止物を除いた残りの停止物を滑らかな曲線で結び、この曲線近傍に最遠停止物が存在するか否かで判断する。
そして、その曲線と最遠停止物の横方向への距離ΔXが1.5m未満であれば、道路左側の停止物であると判断して路側物群(左)に含めたままにし、逆に距離ΔXが1.5m以上であれば、道路右側の停止物であると判断して路側物群(左)から除外する。なお、最遠停止物と曲線との最も近い距離、すなわち、最遠停止物から曲線に下した垂線の長さで判断してもよいが、現実的には、上述したように横方向への距離ΔXのみ考えれば特段問題はない。
【0051】
その後、S292の場合とは逆に、右角度方向から左角度方向へと、条件に合う停止物をグルーピングして、路側物群(右)を形成し(S294)、その路側物群(右)を構成する停止物の中で、縦方向への距離Zが最も大きい、つまり最遠停止物については、それが道路の右側のものか左側のものかを判断し、道路左側のものであると判断した場合には、路側物群(右)から除外する(S295)。
【0052】
これらS294及びS295における処理は、先のS292及びS293における処理とは、左右の方向が異なるだけで、全く同様である。
このようにして、路側物群(左)と路側物群(右)とが得られると、路側物群(左)における最遠停止物と路側物群(右)における最遠停止物が同じ場合、つまり、1つの最遠停止物が路側物群(左)にも属し、路側物群(右)にも属するという競合状態にある場合には、その最遠停止物を路側物群(左)及び路側物群(右)のいずれからも排除する(S296)。もちろん、重複していない場合にはこのような処理を行う必要はない。
【0053】
最後に、構成停止物が3つ以上の路側物群(左)と路側物群(右)とに基づいて、路側物群(左)から道路の左端を、路側物群(右)から道路の右端をそれぞれ認識して(S297)、本処理を終了する。
なお、本実施形態においては、各路側物群の構成停止物間を補間することで道路左右端を線分の集合として認識する。また、本処理(道路端算出)については、特開2001−256600号に詳述されているため、ここでのこれ以上の説明は省略する。
【0054】
次にS30の物標外挿では、図7のフローチャートに示すように、まず、前サイクル物標の個数がゼロであるか否かを判断し(S300)、ゼロであればそのまま本処理を終了する。一方、前サイクル物標の個数がゼロでなければ、その中から一つを取り出し(S301)、取り出した前サイクル物標が、S26にて登録された物標、即ち今サイクル物標との履歴接続があるか否かを判断する(S302)。
【0055】
そして、履歴接続があれば、その今サイクル物標の外挿カウンタのカウント値ICNTiを外挿上限サイクル数ICNTTSDに設定(S303)した後、S308に移行し、一方、履歴接続がなければ、前サイクル物標の外挿カウンタのカウント値ICNTiがゼロより大きいか否かを判断する(S304)。カウント値ICNTiがゼロ以下であれば、外挿を許可しないものとして、そのままS308に移行し、カウント値ICNTiがゼロより大きければ、外挿を許可するものとして、外挿値計算を実行する(S305)。
【0056】
この外挿値計算では、図8のフローチャートに示すように、まず、S301で取り出した前サイクル物標の外挿カウンタのカウント値ICNTiが、外挿上限サイクル数ICNTTSDより小さいか否かを判断し(S310)、外挿上限サイクル数ICNTTSD以上であれば、その物標をロスト(消失)して1回目の外挿であるものとし、前サイクル物標の情報(位置,速度,加速度)をそのまま利用して、その前サイクル物標が今サイクルにて検出されるべき予測位置,速度を算出する(S311)。
【0057】
一方、カウント値ICNTiが外挿上限サイクル数ICNTTSDより小さければ、その物標を連続してロストしているものとし、加速度を0.5倍にした前サイクル物標の情報を利用して、その前サイクル物標が今サイクルにて検出されるべき予測位置,速度を算出する(S312)。
【0058】
これらS311又はS312にて算出された予測速度に基づき、物標は静止物であるか否かを判断し(S313)、静止物であれば、そのまま本処理を終了する。
一方、物標が静止物でなければ、S311又はS312にて算出された予測位置は、S290にて算出された道路端に沿って設けられた所定幅(本実施形態では普通自動車の平均幅の半分。)を有する禁止区域内に存在するか否かを判断し(S314)、禁止区域外にあれば、そのまま本処理を終了する。
【0059】
また、S312にて算出された位置が禁止区域内にあれば、その横位置を禁止区域の境界上に変更し(S315)、その変更した位置と、S311又はS312にて求めた予測位置の位置差が、許容位置差C1(本実施形態では2m)以上であるか否かを判断する(S316)。
【0060】
その位置差が許容位置差C1未満であれば、そのまま本処理を終了し、許容位置差C1以上であれば、その位置差が許容位置差C1になるように縦位置を変更して(S317)、本処理を終了する。なお、縦位置を変更する代わりに、禁止区域の境界に沿って位置を変更してもよい。
【0061】
図7に戻り、この外挿値計算にて算出された外挿値(位置(縦位置,横位置),速度,加速度)を持つ外挿ペアが実際に検出されたものとして、これを認識物標登録し(S306)、その登録された物標に、前サイクル物標の外挿カウンタのカウント値ICNTiを引き継がせると共に、そのカウント値から1を減算することで外挿カウンタを更新する(S307)。
【0062】
そして、全ての前サイクル物標について上述の処理(S301〜S307)を実行したか否かを判断し(S308)、未処理の前サイクル物標があれば、S301に戻り、全ての前サイクル物標について処理が終了していれば、本処理を終了する。
【0063】
つまり、本処理では、前サイクル物標の中で今サイクル物標との履歴接続がないもののうち、外挿上限サイクル数ICNTTSDで決まる外挿期間以内のものについては、ピークペア(ひいては物標)の外挿を許可することにより、物標の登録を継続し、一方、外挿期間を経過しても履歴接続のある今サイクル物標が検知されないものについては外挿を行わないことにより、その物標の登録を削除するようにされている。
【0064】
ここで、図9は、斜線変更中の先行車をロストした場合を例にして、外挿物標の横位置及び縦位置が補正される様子を示す説明図である。
図示されているように、前サイクルまで検出されていた物標をロストした場合、その前サイクル物標の位置(図中●で示す。)と、前サイクル物標の速度や加速度(図中矢印で示す。)とに基づいて、予測位置(図中▲で示す。)を求める(S311)。ここでは、その予測位置が禁止区域内にあるため(S314:YES)、横位置が禁止区域の境界上の位置(図中△で示す。)に変更され(S315)、更に、その変更位置と予測位置との位置差がC1以上であるため(S316:YES)、縦位置がその位置差C1とする位置(図中○で示す)に変更され(317)、その変更された位置が、外挿物標の位置として使用される。
【0065】
以上説明したように、本実施形態のレーダセンサ1では、先行車等の移動物標の外挿を行う必要がある場合、停止物から推定された道路端の近傍に設定された禁止区域内、即ち走行中の先行車が存在し得ない位置に、外挿物標が存在するものとして予測された時には、その横位置や縦位置が、物標が存在し得る領域であって予測距離が大きく変化することのない位置となるように補正される。
【0066】
従って、本実施形態のレーダセンサ1によれば、本来ならばあり得ない位置に物標が外挿されてしまうことがなく、外挿の位置精度及び信頼性を向上させることができる。
また、本実施形態のレーダセンサ1では、外挿が連続した場合に、予測値の算出に用いるパラメータである加速度や速度の影響が抑制されるようにされているため、外挿中の物標に対応する実際の移動物体の挙動が変化した場合に、道路から大きく外れる予測値が算出されてしまう可能性を抑えることができる。
【0067】
このように、本実施形態のレーダセンサ1では、一時的にロストした先行車等の位置を、高い信頼度で求めることができるため、その情報に基づいて、車間制御や車間警報を良好に実施することができる。
なお、本実施形態において、S10〜S26が物標認識手段、S30が物標外挿手段、S28が道路形状推定手段、S313〜S315が第1補正手段、S316〜S317が縦位置変更手段、S310〜S312が第2補正手段に相当する。
【0068】
以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲において、様々な態様にて実施することが可能である。
例えば、上記実施形態では、道路形状情報として、レーダセンサ1により認識される物標の中から停止物(路側物など)を抽出し、その停止物から推定される道路端の位置を用いているが、例えば、車間制御ECU30から、車両の推定軌跡の曲率半径を表す推定R値を入力し、その推定R値から道路形状を推定するように構成してもよい。また、車両がGPS等、車両の現在位置を測定する装置を備えている場合には、その装置から得られる位置情報と、その位置情報が示す位置に対応した地図データとから道路形状を推定するように構成してもよい。
【0069】
また、本実施形態では、外挿が連続した場合に、位置や速度を算出するためのパラメータである加速度を0.5倍にして使用するようにされているが、倍数は0より大きく1より小さく設定されていればよい。また、加速度だけでなく速度にも、或いは加速度の代わりに速度に、0より大きく1より小さい倍数を乗じるようにしてもよい。
【図面の簡単な説明】
【図1】 レーダセンサの構成、及びレーダセンサを用いて構成したクルーズ制御システムの概略構成を示すブロック図である。
【図2】 レーダセンサの信号処理部が実行するメイン処理の内容を示すフローチャートである。
【図3】 メイン処理で実行する履歴追尾の内容を示すフローチャートである。
【図4】 メイン処理で実行する道路形状計算の内容を示すフローチャートである。
【図5】 道路形状計算で実行する停止物抽出の内容を示すフローチャートである。
【図6】 道路形状計算で実行する道路端算出の内容を示すフローチャートである。
【図7】 メイン処理で実行する物標外挿の内容を示すフローチャートである。
【図8】 物標外挿で実行する外挿値計算の内容を示すフローチャートである。
【図9】 斜線変更中の先行車をロストした場合を例にして、外挿物標の横位置及び縦位置が補正される様子を示す説明図である。
【符号の説明】
1…レーダセンサ、10…発振器、12,22…増幅器、14…分配器、16…送信アンテナ、20…受信側アンテナ部、21…受信スイッチ、23…ミキサ、24…フィルタ、25…A/D変換器、26…信号処理部、30…車間制御ECU、32…エンジンECU、34…ブレーキECU。
Claims (9)
- 予め設定された測定サイクル毎に、レーダ波を送受信することで得られる情報に基づいて前記レーダ波を反射した物標を認識する物標認識手段と、
前回の測定サイクルで認識された物標を前サイクル物標、今回の測定サイクルで前記物標認識手段にて認識された物標を今サイクル物標とし、前記前サイクル物標から算出した該前サイクル物標に対応する今サイクル物標の予測位置,予測速度と、前記今サイクル物標の検出位置,検出速度との差分が、いずれも予め設定された上限値より小さい場合に履歴接続があるものとして、前記前サイクル物標が、前記今サイクル物標のいずれとも履歴接続がない場合、該前サイクル物標から予測される物標を、実際に認識されたものとして外挿する外挿手段と、
走行中の道路形状を推定する道路形状推定手段と、
前記外挿手段による外挿物標が、移動体であり且つ前記道路形状推定手段にて推定された道路端に沿って設定される禁止区域内にある場合、前記外挿物標の位置を、前記道路端と前記禁止区域との境界となる位置に変更する第1補正手段と、
を備えることを特徴とする車載レーダ装置。 - 前記道路形状推定手段は、前記物標認識手段が認識する物標の中から抽出した停止物に基づいて、道路形状を推定することを特徴とする請求項1に記載の車載レーダ装置。
- 前記道路形状推定手段は、外部より入力される車両の推定走行軌跡の曲率半径を示す推定R値に基づいて、道路形状を推定することを特徴とする請求項1に記載の車載レーダ装置。
- 前記道路形状推定手段は、外部より入力される当該装置を搭載した車両の位置と、該位置に対応した地図データとに基づいて、道路形状を推定することを特徴とする請求項1に記載の車載レーダ装置。
- 前記第1補正手段は、前記外挿物標の横位置のみを変更し、
更に、前記外挿手段にて設定された位置と前記第1補正手段により変更された位置との位置差が、予め設定された許容値より大きい場合、前記位置差が前記許容値以下となるように、前記外挿物標の縦位置を変更する縦位置変更手段を設けたことを特徴とする請求項1〜4のいずれかに記載の車載レーダ装置。 - 前記外挿手段による物標の外挿が連続した場合に、前記外挿手段が外挿する物標の位置の予測に使用するパラメータの値を、前サイクル物標の位置から、該パラメータによって予測される位置までの距離が抑制されるように補正する第2補正手段を備えることを特徴とする請求項1〜5のいずれかに記載の車載レーダ装置。
- 予め設定された測定サイクル毎に、レーダ波を送受信することで得られる情報に基づいて前記レーダ波を反射した物標を認識する物標認識手段と、
前回の測定サイクルで認識された物標を前サイクル物標、今回の測定サイクルで前記物標認識手段にて認識された物標を今サイクル物標とし、前記前サイクル物標から算出した該前サイクル物標に対応する今サイクル物標の予測位置,予測速度と、前記今サイクル物標の検出位置,検出速度との差分が、いずれも予め設定された上限値より小さい場合に履歴接続があるものとして、前記前サイクル物標が、前記今サイクル物標のいずれとも履歴接続がない場合、前記前サイクル物標から予測される物標を、実際に認識されたものとして外挿する外挿手段と、
前記外挿手段による物標の外挿が連続した場合に、前記外挿手段が外挿する物標の位置の予測に使用するパラメータの値を、前サイクル物標の位置から、該パラメータによって予測される位置までの距離が抑制されるように補正する第2補正手段を備えることを特徴とする車載レーダ装置。 - 前記第2補正手段が補正するパラメータには、少なくとも加速度が含まれていることを特徴とする請求項6又は請求項7に記載の車載レーダ装置。
- コンピュータを、請求項1〜8のいずれかに記載の車載レーダ装置を構成する各手段として機能させるためのプログラム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003018922A JP4075624B2 (ja) | 2003-01-28 | 2003-01-28 | 車載レーダ装置,プログラム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003018922A JP4075624B2 (ja) | 2003-01-28 | 2003-01-28 | 車載レーダ装置,プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004233085A JP2004233085A (ja) | 2004-08-19 |
JP4075624B2 true JP4075624B2 (ja) | 2008-04-16 |
Family
ID=32948928
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003018922A Expired - Lifetime JP4075624B2 (ja) | 2003-01-28 | 2003-01-28 | 車載レーダ装置,プログラム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4075624B2 (ja) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4529733B2 (ja) * | 2005-03-02 | 2010-08-25 | 株式会社デンソー | 車載レーダ装置 |
JP4163695B2 (ja) * | 2005-03-16 | 2008-10-08 | 本田技研工業株式会社 | 先行車認識装置 |
JP4385065B2 (ja) * | 2007-09-06 | 2009-12-16 | 本田技研工業株式会社 | 車両用物体検知装置 |
US7733266B2 (en) | 2007-09-06 | 2010-06-08 | Honda Motor Co., Ltd. | Control target recognition system and vehicle object detection system |
JP5034966B2 (ja) * | 2008-01-16 | 2012-09-26 | トヨタ自動車株式会社 | 物体速度検出装置 |
JP5078637B2 (ja) * | 2008-01-29 | 2012-11-21 | 富士通テン株式会社 | レーダ装置、及び物標検出方法 |
JP4843003B2 (ja) | 2008-08-05 | 2011-12-21 | 富士通テン株式会社 | 信号処理装置、レーダ装置、及び信号処理方法 |
JP5732098B2 (ja) * | 2013-04-08 | 2015-06-10 | 本田技研工業株式会社 | 物体検知装置 |
JP6828602B2 (ja) * | 2017-06-09 | 2021-02-10 | トヨタ自動車株式会社 | 物標検出装置 |
JP6828603B2 (ja) * | 2017-06-09 | 2021-02-10 | トヨタ自動車株式会社 | 物標検出装置 |
-
2003
- 2003-01-28 JP JP2003018922A patent/JP4075624B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JP2004233085A (ja) | 2004-08-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9618608B2 (en) | Target detection apparatus and vehicle control system | |
JP4905512B2 (ja) | 物標情報推定装置 | |
US6970129B2 (en) | Radar apparatus, and program therefor | |
JP6369035B2 (ja) | 物標検出装置 | |
JP3997837B2 (ja) | 車載レーダ装置、プログラム | |
JP5996878B2 (ja) | レーダ装置 | |
JP6009775B2 (ja) | レーダ装置 | |
US7439903B2 (en) | Method of preventing interference between radars and radar system having interference preventing function | |
JP5989353B2 (ja) | レーダ装置 | |
WO2016052744A1 (ja) | レーダ装置 | |
JP4561507B2 (ja) | 道路形状認識装置 | |
JP6443011B2 (ja) | 物標検出装置 | |
US20150175162A1 (en) | Inter-vehicle distance control apparatus | |
JP3960228B2 (ja) | レーダ装置,プログラム | |
JP6248778B2 (ja) | 物標検出装置 | |
JP3903856B2 (ja) | 車両制御装置,プログラム | |
JP4075624B2 (ja) | 車載レーダ装置,プログラム | |
JP4079739B2 (ja) | 車載用レーダ装置 | |
CN104483667A (zh) | 一种车载雷达装置 | |
JP3703756B2 (ja) | レーダ装置 | |
JP3966181B2 (ja) | レーダ装置,プログラム | |
JP5040406B2 (ja) | 走行支援制御システム、及び走行支援の制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050328 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20070208 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070220 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070410 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070703 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070824 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20071002 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20071127 |
|
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: 20080108 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20080121 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 4075624 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: 20110208 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120208 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130208 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140208 Year of fee payment: 6 |
|
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 |
|
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 |
|
EXPY | Cancellation because of completion of term |