レーダの軸ずれ量決定装置
【課題】 静止物標の分布に基づくレーダの水平方向軸ずれ量決定において、直線走行からカーブ走行に移行する際にも正確に軸ずれ量を決定する。
【解決手段】 検出された静止物標の２次元的な分布のデータおよび直線走行かカーブ走行かを示すフラグを現在から所定時間前まで時系列的に保持することによって（ステップ１００２〜１０１８）、所定時間前の分布データおよびフラグをそれぞれＴ＿Ｍａｐ（４）およびＴ＿Ｆｌａｇ（４）として保持する。現在および所定時間前のいずれにおいても直線走行していたと判定されるときのみ（ステップ１０２０）所定時間前の分布データＴ＿Ｍａｐ（４）をＡ＿Ｍａｐに積算し（ステップ１０２２）、積算値Ａ＿Ｍａｐに基いて軸ずれ量を演算する（ステップ１０２６）。
【解決手段】 検出された静止物標の２次元的な分布のデータおよび直線走行かカーブ走行かを示すフラグを現在から所定時間前まで時系列的に保持することによって（ステップ１００２〜１０１８）、所定時間前の分布データおよびフラグをそれぞれＴ＿Ｍａｐ（４）およびＴ＿Ｆｌａｇ（４）として保持する。現在および所定時間前のいずれにおいても直線走行していたと判定されるときのみ（ステップ１０２０）所定時間前の分布データＴ＿Ｍａｐ（４）をＡ＿Ｍａｐに積算し（ステップ１０２２）、積算値Ａ＿Ｍａｐに基いて軸ずれ量を演算する（ステップ１０２６）。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、車輌に搭載されたレーダの水平方向の軸ずれ量を決定する装置に関する。
【背景技術】
【０００２】
車載用レーダには、ターゲットとの距離Ｒ、ターゲットの相対速度Ｖのほかに、電波の発射方向を電子的または機械的に走査することによってターゲットの方位角度θを検出し、Ｘ＝Ｒ・ｓｉｎθによりターゲットの横位置Ｘを検出し得るものがある。横位置Ｘを検出することにより、自車の進行方向前方を走行する車輌の距離および相対速度に基いて車間距離を制御することが可能になる。
【０００３】
この様な車載用レーダが車輌に設置された後、何らかの原因で加わった外力により水平方向の軸ずれが発生すると、レーダが認識する車輌の進行方向と車輌の実際の進行方向にずれを生じる。このため、レーダが検出するターゲットの方位角度θに実際の方位角度からのずれを生じることになり、車間制御の対象となるターゲットの位置を誤って認識することになる。
【０００４】
下記特許文献１には、道路の両側に設けられているガードレールなどの多数の静止物体の検出位置が道路の左右の仮想的な直線に沿って分布することを利用して、静止していると認識された物体の位置の分布から最小２乗法により仮想直線を求め、この仮想直線の傾きを水平方向軸ずれ量とする手法が開示されている。
【０００５】
レーダを搭載している車輌がカーブを走行しているときは、前方のガードレール等の静止物体の並ぶ方向が自車の進行方向に対して傾斜しているため軸ずれ量の誤認識を起こすことになる。特許文献１には、これを避けるため、ヨートレートセンサの出力に基いて自車が直線走行しているかどうかを検出し、直線走行しているときのみ軸ずれ角θを検出することが開示されている。
【０００６】
しかしながら、図１に示すように、車輌２０が直線走行からカーブ走行に移行する直前においては、センサの出力が直線走行を示しているにもかかわらず、前方の静止物体２２の分布から得られる仮想直線２４が車輌の進行方向２６に対して傾斜する状況が生じ、このため、軸ずれ量を誤って認識するという問題を生じる。
【０００７】
【特許文献１】特開２００１−１６６０５１号公報
【発明の開示】
【発明が解決しようとする課題】
【０００８】
したがって本発明の目的は、軸ずれ量を正確に決定することの可能な軸ずれ量決定装置を提供することにある。
【課題を解決するための手段】
【０００９】
本発明によれば、検出された静止物標の２次元的な分布のデータを現在から所定時間前まで時系列的に保持することによって所定時間前の分布データを保持する保持手段と、該保持手段が保持する所定時間前の分布データを積算する積算手段と、該積算された分布データに基いて軸ずれ量を算出する軸ずれ量算出手段とを具備し、前記積算手段は、現在または所定時間前においてレーダを搭載する車輌の回転半径が所定値以下であるとき、前記所定時間前の分布データに所定の比率を乗じて積算するレーダの軸ずれ量決定装置が提供される。
本発明によれば、検出された静止物標の分布のデータを現在から所定時間前まで時系列的に保持する保持手段と、該保持手段が保持する所定時間前の分布データを積算する積算手段と、該積算された分布データに基いて軸ずれ量を算出する軸ずれ量算出手段とを具備し、前記積算手段は、現在または該所定時間前においてレーダを搭載する車輌の回転半径が所定値以下であるとき、該所定時間前の分布データを前記積算に使用しないレーダの軸ずれ量決定装置もまた提供される。
【００１０】
上記の構成において、積算手段は通常は所定時間前に得られた分布データを積算しており、それに基いて軸ずれ量が算出される。レーダを搭載する車輌がカーブに差し掛かって回転半径が所定値以下になると、それ以降は所定時間前の分布データに所定の比率、好ましくはゼロを乗じたものが積算されるので、カーブに入る所定時間前からの分布データの寄与は小さくなるかまたはゼロになり、図１を参照して述べた問題は解消される。
【００１１】
一方、カーブを曲がり終わって直線走行に移った直後では、所定時間前の分布データはカーブ走行中の分布データであるということになるので、これをそのまま積算すると不正確な軸ずれ量が得られることになる。そこで、「現在または所定時間前において」回転半径が所定値以下であるとき分布データに所定の比率、好ましくはゼロを乗じて積算する構成とすることでこの問題を回避することができる。
【発明を実施するための最良の形態】
【００１２】
図２は本発明が適用されるレーダの一例としての、車間制御用レーダの構成を示す。
【００１３】
図２において、ＥＣＵ１０はヨーレートセンサ１２からの信号および車速センサ１４からの信号に基づき自車の回転半径を算出し、車速のデータと共にＦＭ−ＣＷレーダ１６へ送る。ヨーレートセンサ１２の出力の代わりにステアリングセンサ（図示せず）の出力を用いても回転半径を算出することができる。ＦＭ−ＣＷレーダ１６は、三角波で周波数変調されたミリ波帯の電波を自車の前方へ発射し、反射波を解析することにより、前方に存在する物標との距離および物標の相対速度を算出する。ＦＭ−ＣＷレーダ１６はまた、前述したように、電波の発射方向を走査し、そのときの反射波のパワーの分布に基いて物標の横位置を算出し、距離および相対速度のデータとともにＥＣＵ１０へ送る。ＥＣＵ１０はそれらのデータに基づき、前方を走行する車輌との距離を一定に保つための制御信号を生成して出力する。
【００１４】
本発明の一実施形態では、水平方向の軸ずれ量を算出するため、ＥＣＵ１０はまずＦＭ−ＣＷレーダ１６が検出した物標の中で相対速度が車速に実質的に一致するものを静止物標として特定する。そして、横軸を静止物標の横位置、たて軸を静止物標の距離とする２次元平面を横軸およびたて軸に平行な等間隔の直線で区切り、区切られた各区域に入る静止物標の数をカウントすることによって、図３に示すような分布データを作成する。以下この分布データをＴｅｍｐ＿ＭａｐあるいはＴ＿Ｍａｐと称することとする。図３に示した例は、１００msec周期で得られた静止物標のデータを１０回加算して得られたものである。
【００１５】
このようなＴ＿Ｍａｐを一定周期（例えば１００sec×１０＝１sec周期）で作成し、所定時間前（例えば４sec前）のＴ＿Ｍａｐを保持するために、現在から所定時間前までのＴ＿Ｍａｐを例えばＴ＿Ｍａｐ（Ｉ）（Ｉ＝０，１…４）として時系列的に保持する。ここでＴ＿Ｍａｐ（Ｉ）は例えばＩ秒前のＴ＿Ｍａｐを意味するものとする。
【００１６】
自車の回転半径が所定値（例えば２０００ｍ）よりも大きくて直線走行していると判断される間はこの所定時間前の分布データ（例えばＴ＿Ｍａｐ（４））を積算していくことにより水平方向軸ずれ量の計算に必要な分布データを得る。この積算された分布データを以下Ａ＿Ｍａｐと称することとする。Ａ＿Ｍａｐからの水平方向軸ずれ量の計算は、例えば前述の特許文献１に記載されているように、最小２乗法によって求められた仮想直線の傾きを軸ずれ量とする。
【００１７】
自車の回転半径が所定値よりも小さくなってカーブに進入したと判断されるときは直ちにＴ＿Ｍａｐ（４）のＡ＿Ｍａｐへの積算を停止する。これによって、カーブに進入するよりも所定時間前からの分布データはＡ＿Ｍａｐへの積算から除外され、軸ずれ量の精度を向上させることができる。
【００１８】
一方、カーブ走行から直線走行に移行した直後においては所定時間前の分布データはカーブによる傾斜を含むことになる。そこで、回転半径が所定値以上であったか否かを示すフラグＴ＿Ｆｌａｇ（Ｉ）をＴ＿Ｍａｐ（Ｉ）とともに時系列的に保持することによって所定時間前の分布データが直線走行中のものであったか否かを示す情報を保持する。Ｔ＿Ｍａｐ（４）をＡ＿Ｍａｐに積算する際には、現在および所定時間前の双方において直線走行中であるときのみ積算することとすれば、この問題を回避することができる。
【００１９】
図４はＥＣＵ１０のプログラムにより実現される軸ずれ量決定処理の第１の例を示すフローチャートである。図４に示す処理は一定周期、例えば１秒周期で起動される。最初にレーダを搭載する車輌の速度Ｖが所定値Ｖ0（例えば３６km／ｈ）を超えているかが判定され、車速ＶがＶ0以上であるときのみこの処理が実行される。
【００２０】
ステップ１００２，１００４，１００６および１００８において、時系列的に格納されている過去の分布データＴ＿Ｍａｐ（Ｉ）およびフラグＴ＿Ｆｌａｇ（Ｉ）（Ｉ＝１，２…４）を更新するため、Ｉ＝４，３，２，１について、Ｔ＿Ｍａｐ（Ｉ−１）のデータがＴ＿Ｍａｐ（Ｉ）に移され、Ｔ＿Ｆｌａｇ（Ｉ−１）の値がＴ＿Ｆｌａｇ（Ｉ）に移される。
【００２１】
次に、ＦＭ−ＣＷレーダ１６が検出した物標の中で相対速度が自車の速度に実質的に一致するものが静止物標と特定され（ステップ１０１０）、その２次元的な分布がＴ＿Ｍａｐ（０）に保存される（ステップ１０１２）。前述したように、例えば１００msec周期で分布を決定し、その１０回分を加算してＴ＿Ｍａｐ（０）としても良い。ステップ１０１４において、ヨートレートセンサ１２の出力から決定される自車の回転半径Ｒの絶対値が所定値Ｒ0（例えば２０００ｍ）と比較され、ＲがＲ0以上であるときはＴ＿Ｆｌａｇ（０）をゼロに（ステップ１０１６）、ＲがＲ0以下であるときはＴ＿Ｆｌａｇ（０）が１に設定される（ステップ１０１８）。そして、Ｔ＿Ｆｌａｇ（０）またはＴ＿Ｆｌａｇ（４）がゼロであるか否かが判定され（ステップ１０２０）、両者がいずれもゼロであるときはＴ＿Ｍａｐ（４）がＡ＿Ｍａｐに積算され（ステップ１０２２）、少なくとも一方がゼロでないときは、この処理はバイパスされる。最後に、ステップ１０２４において軸ずれ値の演算条件、例えばＡ＿Ｍａｐに値が１００を超える領域が１０ヶ所以上存在するか、が判定され、演算条件が成立しないときはステップ１０００の処理に戻り、演算条件が成立するときは、Ａ＿Ｍａｐから軸ずれ量が計算され（ステップ１０２６）、Ａ＿Ｍａｐの値がクリアされる（ステップ１０２８）。
図５はＡ＿Ｍａｐの一例を示す。例えば値が１５０を超えた領域が縦に（距離方向に）４箇所以上並んだとき、この縦の各エリアについての直線を最小２乗法により演算して１８０／πで近似することによりその傾きを求める。傾きと進行方向とのなす角度が軸ずれ量となる。すなわち、４つの領域（図中、四角で囲んで示す）の横方向の位置をｘi（ｉ＝１〜４）、たて方向の値をｙiとして、軸ずれ角θは、式
θ＝（４＊Σｘiｙi−Σｙi）／（４＊Σｘi2−（Σｘi）2）＊（１８０／π）
により算出される。算出された軸ずれ量が例えば５°以上のとき異常と判定され、５°未満のとき正常と判定される。
【００２２】
図６は本発明の軸ずれ量演算処理の第２の例を示すフローチャートである。図４の例と異なる点は、Ｔ＿Ｆｌａｇ（０）またはＴ＿Ｆｌａｇ（４）が１であるとき、Ｔ＿Ｍａｐ（４）に所定の比率、例えば０．５を乗じたものをＡ＿Ｍａｐに加算する（ステップ１０２３）点である。レーダを搭載する車輌が一般道路を走行する際には直線走行時のデータがなかなか得られないので、このようにすることで早期に軸ずれ量を算出することができる。
【００２３】
積算に使用する分布データ（ステップ１０２２，１０２３）を前述したように「所定時間」という固定時間前の分布データとする代わりにこれを車速に応じて変更することにより「所定の距離」だけ前のデータを積算するようにしても良い。また、前述の「所定の比率」を車輌の回転半径に応じて変更するようにしても良い。
【図面の簡単な説明】
【００２４】
【図１】本発明の課題を説明するための図である。
【図２】本発明が適用されるレーダの一例の構成を示すブロック図である。
【図３】Ｔ＿Ｍａｐの一例を示す図である。
【図４】本発明の軸ずれ量決定処理の一例のフローチャートである。
【図５】Ａ＿Ｍａｐの一例を示す図である。
【図６】本発明の軸ずれ量決定処理の他の例のフローチャートである。
【技術分野】
【０００１】
本発明は、車輌に搭載されたレーダの水平方向の軸ずれ量を決定する装置に関する。
【背景技術】
【０００２】
車載用レーダには、ターゲットとの距離Ｒ、ターゲットの相対速度Ｖのほかに、電波の発射方向を電子的または機械的に走査することによってターゲットの方位角度θを検出し、Ｘ＝Ｒ・ｓｉｎθによりターゲットの横位置Ｘを検出し得るものがある。横位置Ｘを検出することにより、自車の進行方向前方を走行する車輌の距離および相対速度に基いて車間距離を制御することが可能になる。
【０００３】
この様な車載用レーダが車輌に設置された後、何らかの原因で加わった外力により水平方向の軸ずれが発生すると、レーダが認識する車輌の進行方向と車輌の実際の進行方向にずれを生じる。このため、レーダが検出するターゲットの方位角度θに実際の方位角度からのずれを生じることになり、車間制御の対象となるターゲットの位置を誤って認識することになる。
【０００４】
下記特許文献１には、道路の両側に設けられているガードレールなどの多数の静止物体の検出位置が道路の左右の仮想的な直線に沿って分布することを利用して、静止していると認識された物体の位置の分布から最小２乗法により仮想直線を求め、この仮想直線の傾きを水平方向軸ずれ量とする手法が開示されている。
【０００５】
レーダを搭載している車輌がカーブを走行しているときは、前方のガードレール等の静止物体の並ぶ方向が自車の進行方向に対して傾斜しているため軸ずれ量の誤認識を起こすことになる。特許文献１には、これを避けるため、ヨートレートセンサの出力に基いて自車が直線走行しているかどうかを検出し、直線走行しているときのみ軸ずれ角θを検出することが開示されている。
【０００６】
しかしながら、図１に示すように、車輌２０が直線走行からカーブ走行に移行する直前においては、センサの出力が直線走行を示しているにもかかわらず、前方の静止物体２２の分布から得られる仮想直線２４が車輌の進行方向２６に対して傾斜する状況が生じ、このため、軸ずれ量を誤って認識するという問題を生じる。
【０００７】
【特許文献１】特開２００１−１６６０５１号公報
【発明の開示】
【発明が解決しようとする課題】
【０００８】
したがって本発明の目的は、軸ずれ量を正確に決定することの可能な軸ずれ量決定装置を提供することにある。
【課題を解決するための手段】
【０００９】
本発明によれば、検出された静止物標の２次元的な分布のデータを現在から所定時間前まで時系列的に保持することによって所定時間前の分布データを保持する保持手段と、該保持手段が保持する所定時間前の分布データを積算する積算手段と、該積算された分布データに基いて軸ずれ量を算出する軸ずれ量算出手段とを具備し、前記積算手段は、現在または所定時間前においてレーダを搭載する車輌の回転半径が所定値以下であるとき、前記所定時間前の分布データに所定の比率を乗じて積算するレーダの軸ずれ量決定装置が提供される。
本発明によれば、検出された静止物標の分布のデータを現在から所定時間前まで時系列的に保持する保持手段と、該保持手段が保持する所定時間前の分布データを積算する積算手段と、該積算された分布データに基いて軸ずれ量を算出する軸ずれ量算出手段とを具備し、前記積算手段は、現在または該所定時間前においてレーダを搭載する車輌の回転半径が所定値以下であるとき、該所定時間前の分布データを前記積算に使用しないレーダの軸ずれ量決定装置もまた提供される。
【００１０】
上記の構成において、積算手段は通常は所定時間前に得られた分布データを積算しており、それに基いて軸ずれ量が算出される。レーダを搭載する車輌がカーブに差し掛かって回転半径が所定値以下になると、それ以降は所定時間前の分布データに所定の比率、好ましくはゼロを乗じたものが積算されるので、カーブに入る所定時間前からの分布データの寄与は小さくなるかまたはゼロになり、図１を参照して述べた問題は解消される。
【００１１】
一方、カーブを曲がり終わって直線走行に移った直後では、所定時間前の分布データはカーブ走行中の分布データであるということになるので、これをそのまま積算すると不正確な軸ずれ量が得られることになる。そこで、「現在または所定時間前において」回転半径が所定値以下であるとき分布データに所定の比率、好ましくはゼロを乗じて積算する構成とすることでこの問題を回避することができる。
【発明を実施するための最良の形態】
【００１２】
図２は本発明が適用されるレーダの一例としての、車間制御用レーダの構成を示す。
【００１３】
図２において、ＥＣＵ１０はヨーレートセンサ１２からの信号および車速センサ１４からの信号に基づき自車の回転半径を算出し、車速のデータと共にＦＭ−ＣＷレーダ１６へ送る。ヨーレートセンサ１２の出力の代わりにステアリングセンサ（図示せず）の出力を用いても回転半径を算出することができる。ＦＭ−ＣＷレーダ１６は、三角波で周波数変調されたミリ波帯の電波を自車の前方へ発射し、反射波を解析することにより、前方に存在する物標との距離および物標の相対速度を算出する。ＦＭ−ＣＷレーダ１６はまた、前述したように、電波の発射方向を走査し、そのときの反射波のパワーの分布に基いて物標の横位置を算出し、距離および相対速度のデータとともにＥＣＵ１０へ送る。ＥＣＵ１０はそれらのデータに基づき、前方を走行する車輌との距離を一定に保つための制御信号を生成して出力する。
【００１４】
本発明の一実施形態では、水平方向の軸ずれ量を算出するため、ＥＣＵ１０はまずＦＭ−ＣＷレーダ１６が検出した物標の中で相対速度が車速に実質的に一致するものを静止物標として特定する。そして、横軸を静止物標の横位置、たて軸を静止物標の距離とする２次元平面を横軸およびたて軸に平行な等間隔の直線で区切り、区切られた各区域に入る静止物標の数をカウントすることによって、図３に示すような分布データを作成する。以下この分布データをＴｅｍｐ＿ＭａｐあるいはＴ＿Ｍａｐと称することとする。図３に示した例は、１００msec周期で得られた静止物標のデータを１０回加算して得られたものである。
【００１５】
このようなＴ＿Ｍａｐを一定周期（例えば１００sec×１０＝１sec周期）で作成し、所定時間前（例えば４sec前）のＴ＿Ｍａｐを保持するために、現在から所定時間前までのＴ＿Ｍａｐを例えばＴ＿Ｍａｐ（Ｉ）（Ｉ＝０，１…４）として時系列的に保持する。ここでＴ＿Ｍａｐ（Ｉ）は例えばＩ秒前のＴ＿Ｍａｐを意味するものとする。
【００１６】
自車の回転半径が所定値（例えば２０００ｍ）よりも大きくて直線走行していると判断される間はこの所定時間前の分布データ（例えばＴ＿Ｍａｐ（４））を積算していくことにより水平方向軸ずれ量の計算に必要な分布データを得る。この積算された分布データを以下Ａ＿Ｍａｐと称することとする。Ａ＿Ｍａｐからの水平方向軸ずれ量の計算は、例えば前述の特許文献１に記載されているように、最小２乗法によって求められた仮想直線の傾きを軸ずれ量とする。
【００１７】
自車の回転半径が所定値よりも小さくなってカーブに進入したと判断されるときは直ちにＴ＿Ｍａｐ（４）のＡ＿Ｍａｐへの積算を停止する。これによって、カーブに進入するよりも所定時間前からの分布データはＡ＿Ｍａｐへの積算から除外され、軸ずれ量の精度を向上させることができる。
【００１８】
一方、カーブ走行から直線走行に移行した直後においては所定時間前の分布データはカーブによる傾斜を含むことになる。そこで、回転半径が所定値以上であったか否かを示すフラグＴ＿Ｆｌａｇ（Ｉ）をＴ＿Ｍａｐ（Ｉ）とともに時系列的に保持することによって所定時間前の分布データが直線走行中のものであったか否かを示す情報を保持する。Ｔ＿Ｍａｐ（４）をＡ＿Ｍａｐに積算する際には、現在および所定時間前の双方において直線走行中であるときのみ積算することとすれば、この問題を回避することができる。
【００１９】
図４はＥＣＵ１０のプログラムにより実現される軸ずれ量決定処理の第１の例を示すフローチャートである。図４に示す処理は一定周期、例えば１秒周期で起動される。最初にレーダを搭載する車輌の速度Ｖが所定値Ｖ0（例えば３６km／ｈ）を超えているかが判定され、車速ＶがＶ0以上であるときのみこの処理が実行される。
【００２０】
ステップ１００２，１００４，１００６および１００８において、時系列的に格納されている過去の分布データＴ＿Ｍａｐ（Ｉ）およびフラグＴ＿Ｆｌａｇ（Ｉ）（Ｉ＝１，２…４）を更新するため、Ｉ＝４，３，２，１について、Ｔ＿Ｍａｐ（Ｉ−１）のデータがＴ＿Ｍａｐ（Ｉ）に移され、Ｔ＿Ｆｌａｇ（Ｉ−１）の値がＴ＿Ｆｌａｇ（Ｉ）に移される。
【００２１】
次に、ＦＭ−ＣＷレーダ１６が検出した物標の中で相対速度が自車の速度に実質的に一致するものが静止物標と特定され（ステップ１０１０）、その２次元的な分布がＴ＿Ｍａｐ（０）に保存される（ステップ１０１２）。前述したように、例えば１００msec周期で分布を決定し、その１０回分を加算してＴ＿Ｍａｐ（０）としても良い。ステップ１０１４において、ヨートレートセンサ１２の出力から決定される自車の回転半径Ｒの絶対値が所定値Ｒ0（例えば２０００ｍ）と比較され、ＲがＲ0以上であるときはＴ＿Ｆｌａｇ（０）をゼロに（ステップ１０１６）、ＲがＲ0以下であるときはＴ＿Ｆｌａｇ（０）が１に設定される（ステップ１０１８）。そして、Ｔ＿Ｆｌａｇ（０）またはＴ＿Ｆｌａｇ（４）がゼロであるか否かが判定され（ステップ１０２０）、両者がいずれもゼロであるときはＴ＿Ｍａｐ（４）がＡ＿Ｍａｐに積算され（ステップ１０２２）、少なくとも一方がゼロでないときは、この処理はバイパスされる。最後に、ステップ１０２４において軸ずれ値の演算条件、例えばＡ＿Ｍａｐに値が１００を超える領域が１０ヶ所以上存在するか、が判定され、演算条件が成立しないときはステップ１０００の処理に戻り、演算条件が成立するときは、Ａ＿Ｍａｐから軸ずれ量が計算され（ステップ１０２６）、Ａ＿Ｍａｐの値がクリアされる（ステップ１０２８）。
図５はＡ＿Ｍａｐの一例を示す。例えば値が１５０を超えた領域が縦に（距離方向に）４箇所以上並んだとき、この縦の各エリアについての直線を最小２乗法により演算して１８０／πで近似することによりその傾きを求める。傾きと進行方向とのなす角度が軸ずれ量となる。すなわち、４つの領域（図中、四角で囲んで示す）の横方向の位置をｘi（ｉ＝１〜４）、たて方向の値をｙiとして、軸ずれ角θは、式
θ＝（４＊Σｘiｙi−Σｙi）／（４＊Σｘi2−（Σｘi）2）＊（１８０／π）
により算出される。算出された軸ずれ量が例えば５°以上のとき異常と判定され、５°未満のとき正常と判定される。
【００２２】
図６は本発明の軸ずれ量演算処理の第２の例を示すフローチャートである。図４の例と異なる点は、Ｔ＿Ｆｌａｇ（０）またはＴ＿Ｆｌａｇ（４）が１であるとき、Ｔ＿Ｍａｐ（４）に所定の比率、例えば０．５を乗じたものをＡ＿Ｍａｐに加算する（ステップ１０２３）点である。レーダを搭載する車輌が一般道路を走行する際には直線走行時のデータがなかなか得られないので、このようにすることで早期に軸ずれ量を算出することができる。
【００２３】
積算に使用する分布データ（ステップ１０２２，１０２３）を前述したように「所定時間」という固定時間前の分布データとする代わりにこれを車速に応じて変更することにより「所定の距離」だけ前のデータを積算するようにしても良い。また、前述の「所定の比率」を車輌の回転半径に応じて変更するようにしても良い。
【図面の簡単な説明】
【００２４】
【図１】本発明の課題を説明するための図である。
【図２】本発明が適用されるレーダの一例の構成を示すブロック図である。
【図３】Ｔ＿Ｍａｐの一例を示す図である。
【図４】本発明の軸ずれ量決定処理の一例のフローチャートである。
【図５】Ａ＿Ｍａｐの一例を示す図である。
【図６】本発明の軸ずれ量決定処理の他の例のフローチャートである。
【特許請求の範囲】
【請求項１】
検出された静止物標の分布のデータを現在から所定時間前まで時系列的に保持する保持手段と、
該保持手段が保持する所定時間前の分布データを積算する積算手段と、
該積算された分布データに基いて軸ずれ量を算出する軸ずれ量算出手段とを具備し、
前記積算手段は、現在または該所定時間前においてレーダを搭載する車輌の回転半径が所定値以下であるとき、該所定時間前の分布データに所定の比率を乗じて積算するレーダの軸ずれ量決定装置。
【請求項２】
前記所定の比率はゼロである請求項１記載のレーダの軸ずれ量決定装置。
【請求項３】
前記所定の比率は前記車輌の回転半径に応じて変更される請求項１のレーダの軸ずれ量決定装置。
【請求項４】
検出された静止物標の分布のデータを現在から所定時間前まで時系列的に保持する保持手段と、
該保持手段が保持する所定時間前の分布データを積算する積算手段と、
該積算された分布データに基いて軸ずれ量を算出する軸ずれ量算出手段とを具備し、
前記積算手段は、現在または該所定時間前においてレーダを搭載する車輌の回転半径が所定値以下であるとき、該所定時間前の分布データを前記積算に使用しないレーダの軸ずれ量決定装置。
【請求項５】
前記所定時間は前記車輌の速度に応じて変更される請求項１〜４のいずれか１項記載のレーダの軸ずれ量決定装置。
【請求項６】
前記車輌の速度が所定値以下のとき、前記保持手段が保持する分布データの更新および前記積算手段による分布データの積算が停止される請求項１〜５のいずれか１項記載のレーダの軸ずれ量決定装置。
【請求項１】
検出された静止物標の分布のデータを現在から所定時間前まで時系列的に保持する保持手段と、
該保持手段が保持する所定時間前の分布データを積算する積算手段と、
該積算された分布データに基いて軸ずれ量を算出する軸ずれ量算出手段とを具備し、
前記積算手段は、現在または該所定時間前においてレーダを搭載する車輌の回転半径が所定値以下であるとき、該所定時間前の分布データに所定の比率を乗じて積算するレーダの軸ずれ量決定装置。
【請求項２】
前記所定の比率はゼロである請求項１記載のレーダの軸ずれ量決定装置。
【請求項３】
前記所定の比率は前記車輌の回転半径に応じて変更される請求項１のレーダの軸ずれ量決定装置。
【請求項４】
検出された静止物標の分布のデータを現在から所定時間前まで時系列的に保持する保持手段と、
該保持手段が保持する所定時間前の分布データを積算する積算手段と、
該積算された分布データに基いて軸ずれ量を算出する軸ずれ量算出手段とを具備し、
前記積算手段は、現在または該所定時間前においてレーダを搭載する車輌の回転半径が所定値以下であるとき、該所定時間前の分布データを前記積算に使用しないレーダの軸ずれ量決定装置。
【請求項５】
前記所定時間は前記車輌の速度に応じて変更される請求項１〜４のいずれか１項記載のレーダの軸ずれ量決定装置。
【請求項６】
前記車輌の速度が所定値以下のとき、前記保持手段が保持する分布データの更新および前記積算手段による分布データの積算が停止される請求項１〜５のいずれか１項記載のレーダの軸ずれ量決定装置。
【図１】
【図２】
【図３】
【図４】
【図５】
【図６】
【図２】
【図３】
【図４】
【図５】
【図６】
【公開番号】特開２００６−２７５７４８（Ｐ２００６−２７５７４８Ａ）
【公開日】平成１８年１０月１２日（２００６．１０．１２）
【国際特許分類】
【出願番号】特願２００５−９４８４８（Ｐ２００５−９４８４８）
【出願日】平成１７年３月２９日（２００５．３．２９）
【出願人】（０００２３７５９２）富士通テン株式会社 (3,383)
【Ｆターム（参考）】
【公開日】平成１８年１０月１２日（２００６．１０．１２）
【国際特許分類】
【出願日】平成１７年３月２９日（２００５．３．２９）
【出願人】（０００２３７５９２）富士通テン株式会社 (3,383)
【Ｆターム（参考）】
[ Back to top ]