JP2022134598A - 軸ずれ推定装置 - Google Patents

Abstract

【課題】レーダ装置の軸ずれ角を推定する軸ずれ推定装置において、レーダ装置で物体からの反射波の位相の折り返しが発生しても、軸ずれ角を正確に推定できるようにする。【解決手段】軸ずれ推定装置は、レーダ装置から反射点情報を取得する情報取得部３１、その取得された情報に基づいて軸ずれ角を推定する軸ずれ角推定部３３、軸ずれ角の推定値を所定期間平滑化して区間軸ずれ角を算出する区間推定値算出部３７、区間軸ずれ角を出力軸ずれ角の過去値と平滑化することで出力軸ずれ角を算出する出力推定値算出部３９、及び、折り返し判定部４１を備える。折り返し判定部は、所定期間内の反射点情報に含まれている方位の分布から折り返しが発生しているか否かを判定し、その判定結果に基づいて、出力推定値算出部が区間軸ずれ角を平滑化する際の割合を変化させる。【選択図】図５

Description

本開示は、レーダ装置の軸ずれを推定する技術に関する。

車両に搭載されたレーダ装置では、何らの原因で設置状態が変化することで、レーダビームの中心軸がずれることがある。このような軸ずれが発生すると、レーダ装置の検出対象である物体の検出精度が低下する。

そこで、レーダ装置においては、特許文献１に記載のように、レーダ装置に入射する反射波の強度に基づき、レーダビームの方向を推定して、レーダ装置の軸ずれ状態を検出することが提案されている。

特許第６３２１４４８号公報

ところで、レーダ装置では、物体からの反射波をアレーアンテナで受信し、各アンテナからの受信信号間に生じる位相差Δθを利用して、物標の方位を検出することから、位相の周期性により、Δθ＝θ０と、Δθ＝θ０±２ｎπとを区別することができない。

このため、例えば、位相差Δθが－π＜Δθ≦＋π［ｒａｄ］となる検出範囲から外れた位置に物標が存在し、位相差Δθが、Δθ≦－π又はΔθ＞πとなる、反射波の位相の折り返しが発生すると、その物標を、検出範囲内にあるものとして誤検出してしまう。

そして、発明者の詳細な検討の結果、このような位相の折り返しが発生すると、反射波の強度の分布も変化することから、レーダ装置の軸ずれ状態を正確に検出することができなくなる、という課題が見出された。

本開示の１つの局面は、レーダ装置の軸ずれ角を推定する軸ずれ推定装置において、レーダ装置で物体からの反射波の位相の折り返しが発生しても、軸ずれ角を正確に推定できるようにすることを目的としている。

本開示の１つの態様による軸ずれ推定装置（７）は、移動体周囲にレーダ波を照射し、その反射波を複数のアンテナで受信することで、移動体周囲の物体を検出するよう構成されたレーダ装置（３）の、軸ずれ角を推定する装置である。

本開示の軸ずれ推定装置には、情報取得部（３１）、軸ずれ角推定部（３３）、区間推定値算出部（３７）、出力推定値算出部（３９）、及び、折り返し判定部（４１）、が備えられている。

情報取得部は、レーダ装置において検出された物体の反射点のそれぞれについて、少なくとも距離、相対速度及び方位を表す情報を取得し、軸ずれ角推定部は、情報取得部にて取得された情報に基づいて、レーダ装置の軸ずれ角を推定する。

また、区間推定値算出部は、軸ずれ角推定部にて推定された軸ずれ角の推定値を所定期間平滑化した区間軸ずれ角を算出する。
そして、出力推定値算出部は、区間推定値算出部にて算出された区間軸ずれ角を、出力軸ずれ角の過去値と平滑化することで、出力軸ずれ角を算出する。なお、出力軸ずれ角は、軸ずれ推定装置から軸ずれ角の推定結果として出力される。

ところで、レーダ装置は、アレーアンテナを構成する各アンテナからの受信信号に生じる位相差から物体の方位を検出する。このため、例えばトンネルの天井等、物体の検出範囲から外れた位置に存在する物標からの反射波が受信された場合に、反射波の位相の折り返しにより、その物標が、検出範囲内の物標であると誤検出され、その検出結果から軸ずれ角も誤検出されることがある。

折り返し判定部は、こうした反射波の位相の折り返しが発生しているか否かを判定するために備えられている。つまり、折り返し判定部は、区間推定値算出部にて区間軸ずれ角を算出するのに用いられた所定期間内の各反射点の情報に含まれている方位の分布から、レーダ装置において反射波の位相の折り返しが発生しているか否かを判定する。

これは、折り返し発生時には、レーダ装置にて所定期間内に検出される反射点の方位の分布が、複数の領域に分かれるためである。
そして、折り返し判定部は、折り返しの判定結果に基づいて、出力軸ずれ角が折り返しの影響を受けることのないよう、出力推定値算出部が区間軸ずれ角を平滑化する際の割合を変化させる。

この結果、本開示の軸ずれ推定装置によれば、レーダ装置において反射波の位相の折り返しが発生しても、その折り返しの影響を受けることのないよう、レーダ装置の軸ずれ角を適正に推定し、出力軸ずれ角として出力することができる。

実施形態の車両制御システム全体の構成を表すブロック図である。 レーダ波の垂直方向における照射範囲を説明する説明図である。 レーダ波の水平方向における照射範囲を説明する説明図である。 レーダ装置にて検出される反射点の方位を説明する説明図である。 軸ずれ推定装置の機能構成を表すブロック図である。 レーダ装置における反射点の方位の検出方法を説明する説明図である。 反射波の位相の折り返しを説明する説明図である。 軸ずれ推定装置にて実行されるメイン処理を表すフローチャートである。 図８に示す軸ずれ角推定処理の詳細を表すフローチャートである。 図９に示す路面反射点抽出処理の詳細を表すフローチャートである。 軸ずれ角の推定方法を説明する説明図である。 図８に示す折り返し判定処理の詳細を表すフローチャートである。 図８に示す出力推定値算出処理の詳細を表すフローチャートである。 折り返し発生時に検出される方位の分散の一例を表す説明図である。 第２実施形態の折り返し判定処理を表すフローチャートである。 第３実施形態の折り返し判定処理を表すフローチャートである。 第４実施形態の折り返し判定処理を表すフローチャートである。 図１７の折り返し判定処理で算出されるピークの確率Ｐ１，Ｐ２を説明する説明図である。

以下に、本開示の実施形態を、図面を参照しながら説明する。
なお、以下でいう「垂直」とは、厳密な意味での「垂直」に限るものではなく、同様の効果を奏するのであれば厳密に「垂直」でなくてもよい。以下でいう「水平」、「一致」についても同様である。
［第１実施形態］
［構成］
図１に示す車両制御システム１は、移動体である車両に搭載されるシステムであり、レーダ装置３、車載センサ群５、信号処理部７、支援実行部９、軸ずれ通知装置１１、及び、搭載角調整装置１３、を備える。なお、信号処理部７は、本開示の軸ずれ推定装置としての機能を有する。

以下の説明では、車両制御システム１を搭載する車両を自車ＶＨ、自車ＶＨの周囲の車両を他車、他車のうち自車ＶＨより前方の車両を先行車、ともいう。また、自車ＶＨの車高方向を垂直方向、自車の車幅方向を水平方向ともいう。

レーダ装置３は、レーダ波を送受信して自車ＶＨの周辺を監視する探知装置である。このレーダ装置３は、レーダ波としてミリ波帯の電磁波を使用するいわゆるミリ波レーダであってもよい。また、レーダ波としてレーザー光を用いるレーザレーダ、レーダ波として音波を用いるソナーであってもよい。

レーダ装置３において、レーダ波を送受信するアンテナ部は、水平方向及び垂直方向のいずれについても反射波の到来方向を検出できるように構成されている。本実施形態では、アンテナ部は、垂直方向及び水平方向に並ぶ複数のアンテナを備える、アレイアンテナである。

図２，図３に示すように、レーダ装置３は、自車ＶＨの前側に搭載され、自車ＶＨ前方の所定の角度範囲である照射範囲にレーダ波を照射する。具体的には、レーダ装置３は、垂直方向における照射範囲Ｒｖ及び水平方向における照射範囲Ｒｈに、レーダ波を照射する。レーダ装置３は、照射したレーダ波の反射波を受信することで、レーダ波を反射した反射点に関する反射点情報を生成する。

レーダ装置３は、照射するレーダビームの中心軸の方向に沿った方向であるビーム方向が、自車ＶＨの前後方向（すなわち、進行方向）と一致するように取り付けられ、自車ＶＨの前方に存在する各種物標を検出するために用いられる。

レーダ装置３が生成する反射点情報には、レーダ装置３と反射点との相対速度、反射点の方位（すなわち、方位角）、及び、レーダ装置３と反射点との距離が含まれる。
反射点の方位角とは、図４に示すように、レーダ装置３（詳しくは、レーダビーム）の基準方向Ａを基準として求められた反射点の方位角のうち垂直方向の角度（以下、垂直角度）Ｖｅｒ及び水平方向の角度（以下、水平角度）Ｈｏｒの少なくとも一方である。

本実施形態では、垂直角度Ｖｅｒ及び水平角度Ｈｏｒの両方が反射点の方位を表す情報として反射点情報に含まれる。
垂直角度Ｖｅｒは、自車ＶＨを右側面から見た場合において、レーダ装置３の基準方向Ａを基準（すなわち、０°）として、レーダ装置３の基準方向Ａから右回りをプラス、左回りをマイナスとする角度で表す。水平角度Ｈｏｒは、自車ＶＨを上空から見た場合において、レーダ装置３の基準方向Ａを基準として、レーダ装置３の基準方向Ａから右回りをプラス、左回りをマイナスとする角度で表す。

レーダ装置３の基準方向Ａとは、基準として設計上定められたレーダ装置３の方向である。本実施形態では、照射範囲の中心軸の方向がレーダ装置３の基準方向Ａとして設定される。

レーダ装置３は、レーダ装置３の基準方向Ａが車両の基準方向と一致するように自車ＶＨに搭載される。車両の基準方向とは、基準として設計上定められた車両の方向であり、自車ＶＨの進行方向Ｂが車両の基準方向として設定される。

レーダ装置３の基準方向Ａと自車ＶＨの進行方向Ｂとが一致するように、レーダ装置３が自車ＶＨに搭載されると、検出された反射点の方位角と、自車ＶＨの進行方向Ｂに対する反射点の角度と、が一致する。このため、レーダ装置３の基準方向Ａと自車ＶＨの進行方向Ｂとの間にずれが生じると、自車ＶＨの進行方向Ｂに対する反射点の角度を表す情報が正しく得られないことになる。

図４は、レーダ装置３に、垂直方向における軸ずれ、すなわち垂直面であるｘ－ｚ平面内における軸ずれが生じている様子を示している。軸ずれとは、レーダ装置３の基準方向Ａが、車両の基準方向（例えば、自車ＶＨの進行方向Ｂ）とずれている状態をいう。また、軸ずれ角（すなわち、軸ずれ角度）とは、レーダ装置３の基準方向Ａと車両の基準方向（例えば、自車ＶＨの進行方向Ｂ）とのずれの大きさを示す角度をいう。

なお、以下では、軸ずれとして垂直方向の軸ずれを例に挙げて説明するが、水平方向の軸ずれについても同様なことが言える。
本実施形態では、レーダ装置３は、公知のＦＭＣＷ方式を採用しており、上り変調区間のレーダ波と下り変調区間のレーダ波をあらかじめ設定された変調周期で交互に送信し、反射したレーダ波を受信する。ＦＭＣＷは、Frequency Modulated Continuous Waveの略である。

これにより、レーダ装置３は、変調周期ごとに、反射点との相対速度と、反射点の方位を表す垂直角度Ｖｅｒ及び水平角度Ｈｏｒとを、反射点情報として検出する。なお、レーダ装置３は、反射点までの距離、及び、受信したレーダ波の受信電力についても、反射点情報として検出する。

図１に戻り、車載センサ群５は、自車ＶＨの状態等を検出するために自車ＶＨに搭載された各種センサである。このセンサには、車速を検出する車速センサ、車両の操舵角を検出する操舵角センサ、車両周囲を撮像するカメラ、等が含まれる。

支援実行部９は、信号処理部７が実行する各種の処理結果に基づき、各種車載機器を制御して、所定の運転支援を実行する。制御対象となる車載機器には、各種画像を表示するモニタ、警報音や案内音声を出力する音響機器が含まれる他、自車ＶＨの内燃機関、パワートレイン機構、ブレーキ機構等を制御する制御装置が含まれていてもよい。

軸ずれ通知装置１１は、車室内に設置された音声出力装置である。軸ずれ通知装置１１は、信号処理部７から出力される情報に基づき、自車ＶＨの乗員に対して、警告音を出力し、レーダ装置３の軸ずれを通知する。

搭載角調整装置１３は、モータと、レーダ装置３に取り付けられた歯車とを備える。搭載角調整装置１３は、信号処理部７から出力される駆動信号に従ってモータを回転させる。これにより、モータの回転力が歯車に伝達され、垂直方向に沿った軸及び水平方向に沿った軸を中心にレーダ装置３を回転させることができる。

信号処理部７は、ＣＰＵ２１と、ＲＯＭ２３、ＲＡＭ２５、フラッシュメモリ等の半導体メモリ（以下、メモリ２７）と、を有するマイクロコンピュータ（以下、マイコン）を中心に構成される。

信号処理部７の各種機能は、ＣＰＵ２１が非遷移的実体的記録媒体に格納されたプログラムを実行することにより実現される。この例では、メモリ２７が、プログラムを格納した非遷移的実体的記録媒体に該当する。また、このプログラムが実行されることで、プログラムに対応する方法が実行される。なお、メモリ２７には、例えば、レーダ装置３によって得られた各種の測定データや演算結果等が記憶される。

図５に示すように、信号処理部７は、本開示の軸ずれ推定装置として動作できるように、情報取得部３１、軸ずれ角推定部３３、信頼度算出部３５、区間推定値算出部３７、出力推定値算出部３９、及び、折り返し判定部４１を備える。

これら各部は、信号処理部７における軸ずれ推定装置としての機能を表しており、本実施形態では、ＣＰＵ２１が、これら各部に対応するプログラムを実行することにより、軸ずれ推定装置としての機能が実現される。

ここで、情報取得部３１は、レーダ装置３がレーダ波を送信することにより検出した反射点情報を取得する。軸ずれ角推定部３３は、情報取得部３１にて取得された反射点情報に基づいて、レーダ装置３の軸ずれ角を推定する。信頼度算出部３５は、軸ずれ角推定部３３によって推定された軸ずれ角に対して、信頼性の程度を示す信頼度を算出する。

また、区間推定値算出部３７は、軸ずれ角推定部３３及び信頼度算出部３５にて求められる軸ずれ角及び信頼度を、所定期間平滑化することで、区間軸ずれ角及び区間信頼度を算出する。

また、出力推定値算出部３９は、区間推定値算出部３７にて算出された区間軸ずれ角及び区間信頼度を、出力軸ずれ角及び出力信頼度の過去値と平滑化することで、出力軸ずれ角及び出力信頼度を算出する。

なお、出力軸ずれ角及び出力信頼度の過去値は、出力推定値算出部３９にて前回算出された出力軸ずれ角及び出力信頼度のことであり、その初期値には、例えば、出力軸ずれ角：０deg 、出力信頼度：１００％が設定される。

従って、出力軸ずれ角及び出力信頼度は、区間推定値算出部３７にて区間軸ずれ角及び区間信頼度が算出される度に、その最新値を用いて更新されることになる。そして、その更新された出力軸ずれ角及び出力信頼度は、メモリ２７に記憶され、軸ずれ通知装置１１を介してレーダ装置３の軸ずれを使用者に通知したり、搭載角調整装置１３に対しレーダ装置３の搭載角度を調整させたりするのに利用される。

次に、折り返し判定部４１は、区間軸ずれ角を算出するのに用いられた所定期間内の反射点情報に含まれている方位の分布から、レーダ装置３において反射波の位相の折り返しが発生しているか否かを判定するよう構成されている。

そして、折り返し判定部４１は、折り返しの判定結果に基づいて、出力推定値算出部３９が区間軸ずれ角及び区間信頼度をそれぞれ平滑化する際の、最新値と過去値との割合を変化させる。

つまり、レーダ装置３において、反射点の方位は、図６に示すように、アレイアンテナを構成する複数のアンテナ３Ａが受信する受信信号間の反射波の位相差Δθを利用して検出される。

従って、図７に示すように、アンテナ３Ａごとの受信信号間に生じる反射波の位相差Δθが－π＜Δθ≦＋π［rad］ となる範囲を測角範囲ＲＡとすると、測角範囲ＲＡの外に存在する反射点は、位相の折り返しにより測角範囲ＲＡ内にあるものとして検出される。

具体的には、測角範囲ＲＡの範囲外に存在する反射点Ｐａは、レーダ装置３の測角範囲ＲＡの方位角度の幅である折り返し角度ＦＯＶ分ずれた位置Ｐｂにあるものとして検出される。なお、測角範囲ＲＡは、レーダ装置３が備える複数のアンテナ３Ａの素子間隔ｄ等によって決定される。

このように反射波の位相の折り返しが発生すると、レーダ装置３において検出される反射点情報の一部が誤った情報となってしまうため、軸ずれ角推定部３３及び信頼度算出部３５で算出される軸ずれ角及び信頼度に誤差が生じる。

そして、軸ずれ角及び信頼度に誤差が生じると、区間推定値算出部３７及び出力推定値算出部３９において、軸ずれ角及び信頼度を順次平滑化しても、その誤差を充分吸収することができない。

そこで、本実施形態では、折り返し判定部４１において、反射波の位相の折り返しが発生しているか否かを判定し、折り返しが発生しているときには、出力推定値算出部３９が区間軸ずれ角及び信頼度の平滑化する際の最新値の割合を小さくする。

この結果、出力推定値算出部３９において最終的に得られる出力軸ずれ角及び出力信頼度は、極めて誤差が少ない高精度なものとなり、レーダ装置３の搭載角度を適正に調整することができるようになる。
［処理］
次に、信号処理部７を本開示の軸ずれ推定装置として機能させるために、ＣＰＵ２１にて実行される処理について説明する。

図８に示すフローチャートは、車両のイグニションスイッチがオン状態であるとき、ＣＰＵ２１において繰り返し実行されるメイン処理を表している。なお、以下の説明では、垂直方向における軸ずれ角βを推定する場合について説明するが、水平方向の軸ずれ角αについても同様に推定することができる。

図８に示すように、ＣＰＵ２１は、メイン処理を開始すると、まずＳ１００にて、レーダ装置３から反射点情報を取得する、反射点情報取得処理を実行する。
反射点情報取得処理は、情報取得部３１としての機能を実現する処理であり、この処理では、レーダ装置３がレーダ波を送信して物標からの反射点を検出する、１サイクル内に検出された複数の反射点情報を取得する。

Ｓ１００にて、複数の反射点情報が取得されると、ＣＰＵ２１は、Ｓ１１０に移行し、その複数の反射点情報に基づき、レーダ装置３の軸ずれ角βを推定する、軸ずれ角推定処理を実行する。

軸ずれ角推定処理は、軸ずれ角推定部３３としての機能を実現する処理であり、本実施形態では、図９，図１０に示す手順で実行される。
すなわち、ＣＰＵ２１は、軸ずれ角推定処理を開始すると、まず図９に示すＳ２１０にて、Ｓ１００にて取得された複数の反射点情報の中から、路面からの反射波に対応した路面反射点の情報を抽出する。

この路面反射点の抽出処理は、レーダ装置３にて検出された反射点ごとに、路面反射点の抽出条件が成立しているか否かを判定することにより行われる。
すなわち、図１０に示すように、路面反射点抽出処理において、ＣＰＵ２１は、まずＳ３１０にて、判定対象となる反射点と自車ＶＨとの距離が、予め設定された所定距離範囲内にあるか否かを判定する。そして、反射点との距離が所定距離範囲内になければ、Ｓ３８０に移行して、反射点は路面上の反射点ではない、非路面反射点であると判定し、路面反射点抽出力を終了する。

Ｓ３１０にて、反射点との距離は所定距離範囲内にあると判定されると、ＣＰＵ２１は、Ｓ３２０に移行して、判定対象となる反射点の方位は、予め設定された所定方位角度範囲内にあるか否かを判定する。そして、反射点の方位が所定方位角度範囲内になければ、Ｓ３８０にて、反射点は非路面反射点であると判定し、路面反射点抽出力を終了する。

Ｓ３２０にて、反射点の方位は所定方位角度範囲内にあると判定されると、ＣＰＵ２１は、Ｓ３３０に移行して、判定対象となる反射点からの反射波の受信電力は、予め設定された下限電力以上であるか否かを判定する。そして、受信電力が下限電力に達していなければ、３８０にて、反射点は非路面反射点であると判定し、路面反射点抽出力を終了する。

Ｓ３３０にて、受信電力は下限電力以上であると判定されると、ＣＰＵ２１は、Ｓ３４０に移行して、自車ＶＨと反射点との相対速度に基づき、反射点は静止しているか否かを判定する。そして、反射点は静止していない、換言すれば移動していると判定すると、３８０にて、反射点は非路面反射点であると判定し、路面反射点抽出力を終了する。

Ｓ３４０にて、反射点は静止していると判定されると、ＣＰＵ２１は、Ｓ３５０に移行し、車両状態は、路面反射点の抽出条件を満足しているか否かを判定する。例えば、Ｓ３５０では、自車ＶＨが直進走行していて、車速が所定車速範囲内にあるときに、車両状態は、路面反射点の抽出条件を満足していると判定する。

そして、Ｓ３５０にて、車両状態は、路面反射点の抽出条件を満足していないと判定すると、３８０にて、反射点は非路面反射点であると判定して、路面反射点抽出力を終了する。

また、Ｓ３５０にて、車両状態は、路面反射点の抽出条件を満足していると判定されると、ＣＰＵ２１は、Ｓ３６０に移行し、カメラにより撮像された自車ＶＨ周囲の撮像画像から、路面反射点の抽出条件が成立しているか否かを判定する。

Ｓ３６０では、例えば、撮像画像から、自車ＶＨ前方の道路状態を認識し、道路が坂道ではなく、路面に凹凸がないときに、路面反射点の抽出条件が成立していると判定する。
そして、Ｓ３６０にて、自車ＶＨ前方の道路状態は、路面反射点の抽出条件を満足していないと判定すると、３８０にて、反射点は非路面反射点であると判定して、路面反射点抽出力を終了する。

また、Ｓ３６０にて、自車ＶＨ前方の道路状態は、路面反射点の抽出条件を満足していると判定されると、ＣＰＵ２１は、Ｓ３７０に移行し、反射点は路面反射点であると判定し、路面反射点抽出処理を実行する。

なお、Ｓ３１０～３８０の一連の処理は、レーダ装置３にて１サイクル内に検出された全ての反射点に対し実施され、その検出された反射点の中から、路面反射点が抽出される。

こうして、Ｓ２１０にて路面反射点が抽出されると、ＣＰＵ２１は、Ｓ２２０に移行し、Ｓ２１０にて抽出された路面反射点ごとに、反射点情報に含まれる距離と方位角とから、路面反射点の位置（ｘ、ｙ、ｚ）を算出する。

そして、続くＳ２３０では、Ｓ２２０にて算出した各路面反射点の位置に基づき、レーダ装置３の軸ずれ角を算出する。具体的には、図１１に示すように、各路面反射点の位置に基づき、レーダ座標系で、自車ＶＨの進行方向Ｘｃに沿った路面の直線Ｚｓを「Ｚｓ＝β・Ｘｓ＋ｃ」として近似推定し、その直線Ｚｓの傾きβを、軸ずれ角として算出する。

なお、図１１において、レーダ座標系は、レーダ装置３からのレーダビームの方向をＸｓ軸、レーダビームに直交する垂直方向をＺｓ軸とするＸｓ－Ｚｓ平面上の座標である。そして、傾きβが「０」であれば、レーダ座標は車両座標と一致しているので、軸ずれなしと判定される。

図８に戻り、Ｓ１１０にて、レーダ装置３から取得した反射点情報から、軸ずれ角βが推定されると、ＣＰＵ２１は、Ｓ１２０に移行し、Ｓ１１０にて算出した軸ずれ角βの信頼度を算出する、信頼度算出処理を実行する。

この信頼度算出処理は、信頼度算出部３５としての機能を実現する処理であり、例えば、Ｓ１１０にて軸ずれ角βを推定するのに用いた路面反射点の方位の分散を求め、方位の分散が小さいほど信頼度が高くなるよう、軸ずれ角βの信頼度を設定する。

次に、ＣＰＵ２１は、Ｓ１３０に移行し、Ｓ１１０にて軸ずれ角βを推定するのに用いた路面反射点の方位の情報から、所定区間内の方位情報を算出する、区間方位情報算出処理を実行する。

この区間方位情報算出処理では、後述のＳ１７０にて折り返し判定を行うために、Ｓ１００～Ｓ１２０の処理が所定回数実行される所定期間を１区間として、その区間内に軸ずれ角βの推定に用いられた全路面反射点の方位の分散値を求める。

具体的には、例えば、区間の１サイクル目の方位の分散値Varを初期値VarIniとして、２サイクル目以降、分散値Varを、次式を用いて、逐次更新する。
Var＝(1-k)・VarPre＋k・(1-k)・(Ave-AvePre)^２
但し、Var：今回分散値、VarPre：前回分散値、Ave：方位の今回平均値、AvePre：前回平均値、k：平滑化係数（１区間が１０００サイクルなら１／１０００）。

なお、本実施形態では、Ｓ１３０にて、１区間内の方位の分散値を、１サイクル毎に逐次更新するが、全路面反射点の方位情報を蓄積するようにしてもよい。この場合には、後述のＳ１７０において、その蓄積した方位情報に基づき、１区間内の方位の分散値Varを算出するようにすればよい。

Ｓ１３０の処理を実行すると、ＣＰＵ２１は、Ｓ１４０に移行し、区間推定値算出処理を実行する。この区間推定値算出処理は、区間推定値算出部３７としての機能を実現する処理であり、Ｓ１１０及びＳ１２０にて１区間内に算出される軸ずれ角β及び信頼度を平滑化することで、区間軸ずれ角ｍ及び区間信頼度ｗを算出する。

具体的には、例えば、周知の移動平均により、軸ずれ角β及び信頼度の最新値と過去値との平均値を逐次算出することで、１区間内の軸ずれ角及び信頼度の平均値である、区間軸ずれ角ｍ及び区間信頼度ｗを算出する。

次に、ＣＰＵ２１は、Ｓ１５０に移行して、Ｓ１００～Ｓ１４０の一連の処理の実施回数n_estが、所定回数N_maxに達したか否かを判定することで、所定サイクル期間（換言すれば１区間）が経過したか否かを判定する。そして、実施回数n_estが所定回数N_maxに達していなければ、Ｓ１６０にて、実施回数n_estをインクリメント（＋１）した後、Ｓ１００に移行する。

一方、Ｓ１５０にて、実施回数n_estが所定回数N_maxに達していると判定されると、ＣＰＵ２１は、Ｓ１７０に移行し、上記Ｓ１３０にて算出された１区間内の方位の分散値Varに基づき、折り返し判定処理を実行する。

この折り返し判定処理は、折り返し判定部４１としての機能を実現する処理であり、本実施形態では、図１２に示す手順で実施される。
すなわち、折り返し判定処理において、ＣＰＵ２１は、まずＳ４１０にて、Ｓ１３０にて算出された分散値Varを読み込み、続くＳ４２０にて、その読み込んだ分散値Varが、予め設定された閾値ＴＨよりも大きいか否かを判定する。

Ｓ４２０において、分散値Varが閾値ＴＨよりも大きいと判定された場合には、反射波の位相の折り返しが発生しているものと判定して、Ｓ４３０に移行する。そして、Ｓ４３０では、続くＳ１８０にて出力軸ずれ角Ｍ及び出力信頼度Ｗを算出する際に用いられる係数ｋに、値の小さいＫ１を設定し、折り返し判定処理を終了する。

また、Ｓ４２０において、分散値Varが閾値ＴＨ以下であると判定された場合には、反射波の位相の折り返しは発生していないと判定して、Ｓ４４０に移行する。そして、Ｓ４４０では、係数ｋに、Ｋ１よりも値が大きいＫ２を設定し、折り返し判定処理を終了する。

このように、本実施形態では、１区間内に検出された路面反射点の方位の分散値に基づき反射波の位相の折り返しを判定する。この理由は、発明者の実験により、路面反射点の検出を所定期間実施すると、折り返し発生時には、図１４に例示するように、路面反射点の数が多くなる領域が、Ａ１、Ａ２…と、複数に分散することが判明したためである。

図８に戻り、Ｓ１７０にて、上記手順で折り返し判定処理が実行されると、ＣＰＵ２１は、Ｓ１８０に移行し、出力推定値算出処理を実行する。この出力推定値算出処理は、出力推定値算出部３９としての機能を実現する処理であり、例えば、図１３に示す手順で実施される。

すなわち、出力推定値算出処理においては、まずＳ４１０にて、Ｓ１００～Ｓ１６０の処理を所定サイクル実行することにより得られる最新の区間軸ずれ角ｍ(n)及び区間信頼度ｗ(n)と、前回算出した出力軸ずれ角Ｍ(n-1)及び出力信頼度Ｗ(n-1)を読み込む。なお、ｍ，Ｍ，ｗ，Ｗに付与された添え字(n)，(n-1)は、最新値及び過去値を表す。

そして、続くＳ５２０では、折り返し判定処理で設定された係数ｋと、Ｓ５１０にて読み込んだ区間軸ずれ角ｍ(n)と、前回求めた出力軸ずれ角Ｍ(n-1)とに基づき、次式を用いて、出力軸ずれ角Ｍ(n)を算出する。

Ｍ(n) ＝ｋ・ｍ(n) ＋（１－ｋ）・Ｍ(n-1)
また、続くＳ５３０では、折り返し判定処理で設定された係数ｋと、Ｓ５１０にて読み込んだ区間信頼度ｗ(n)と、前回求めた出力信頼度Ｗ(k+1)とに基づき、次式を用いて、出力信頼度Ｗ(n)を算出し、出力推定値算出処理を終了する。

Ｗ(n) ＝ｋ・ｗ(n) ＋（１－ｋ）・Ｗ(n-1)
つまり、出力推定値算出処理では、最新の区間推定値を前回の出力推定値を用いて平滑化することで、出力推定値を更新する。そして、その平滑化時には、最新の区間推定値に係数ｋを乗じ、前回の出力推定値に「１－ｋ」を乗じることで、周知の重み付け移動平均を行う。

この係数ｋは、折り返し判定処理において、反射波の位相の折り返しがあると判定された場合には小さい値Ｋ１が設定され、折り返しがないと判定された場合には大きい値Ｋ２が設定される。

従って、出力推定値算出処理において求められる出力推定値、つまり、出力軸ずれ角Ｍ(n)及び出力信頼度Ｗ(n)には、反射波の位相の折り返しがあると判定された区間内に算出された区間軸ずれ角ｍ(n)及び区間信頼度ｗ(n)が反映され難くなる。

よって、本実施形態によれば、反射波の位相の折り返しにより、出力軸ずれ角Ｍ及び出力信頼度Ｗに誤差が生じるのを抑制することができる。なお、反射波の位相の折り返しがあるときに係数ｋとして設定される値Ｋ１は、値０として、最新の区間推定値が出力推定値に反映されないようにしてもよい。

そして、このように、Ｓ１８０にて出力推定値、つまり、出力軸ずれ角Ｍ及び出力信頼度Ｗが算出されると、ＣＰＵ２１は、Ｓ１９０に移行して、Ｓ１００～Ｓ１４０の一連の処理の実施回数n_est に初期値０を設定し、Ｓ２００に移行する。

Ｓ２００では、自車ＶＨのイグニッションスイッチがオフされたか否かを判定することにより、当該メイン処理を終了するか否かを判定する。そして、イグニッションスイッチがオフされていなければ、再度Ｓ１００に移行して、上記一連の処理を実施し、イグニッションスイッチがオフされていれば、当該メイン処理を終了する。
［効果］
以上説明したように、本実施形態において、軸ずれ推定装置としての信号処理部７は、レーダ装置３がレーダ波を送信してその反射波から反射点を検出する１サイクル毎に、レーダ装置３から反射点情報を取得する。そして、その取得した反射点情報の中から、路面上の反射点に対応する路面反射点情報を抽出して、レーダ装置３の軸ずれ角βを推定すると共に、その軸ずれ角βの信頼度を算出する。また、所定サイクル期間の間、軸ずれ角β及び信頼度を平滑化することで、区間推定値（ｍ，ｗ）を求め、更に、この区間推定値を出力推定値の過去値と平滑化することで、出力推定値（Ｍ，Ｗ）を更新する。

また、区間推定値（ｍ，ｗ）を求めるのに用いられた反射点情報に、反射波の位相の折り返しによる反射点情報が含まれていると、出力推定値（Ｍ，Ｗ）に誤差が含まれることになるので、その反射点情報から折り返しを判定する。そして、反射波の位相の折り返しがあると判定すると、区間推定値（ｍ，ｗ）を出力推定値（Ｍ，Ｗ）の過去値と平滑化する際の割合を、区間推定値（ｍ，ｗ）の比率が小さくなるように設定する。

この結果、本実施形態の信号処理部７によれば、出力推定値、つまり、出力軸ずれ角Ｍ及び出力信頼度Ｗを、反射波の位相の折り返しの影響を受けることのないよう、適正に推定することができるようになる。
［第２実施形態］
第１実施形態では、図１２に示す折り返し判定処理において、路面反射点の方位の分布の特徴量である分散値Varに基づき、反射波の位相の折り返しが発生しているか否かを判定し、その判定結果に応じて係数ｋをＫ１又はＫ２に設定するものとして説明した。

これに対し、本実施形態では、折り返し判定部４１としての折り返し判定処理を、図１５に示す手順で実行する。なお、図１５において、Ｓ４１０～Ｓ４３０は、第１実施形態と同様の処理であり、第１実施形態と異なる点は、Ｓ４４０の処理に代えて、Ｓ４５０の処理を実行する点である。

すなわち、本実施形態では、折り返し判定処理において、ＣＰＵ２１は、Ｓ４１０にて、路面反射点の方位の分散値Varを読み込み、Ｓ４２０にて、その分散値Varは閾値ＴＨ以下であると判定すると、Ｓ４５０に移行する。

そして、Ｓ４５０では、Ｓ４３０にて折り返し判定時に係数ｋとして設定される値Ｋ１と、分散値Varと、閾値ＴＨをパラメータとに基づき、次式
ｋ＝（ＴＨ／Var）・Ｋ１
を用いて、係数ｋを算出し、折り返し判定処理を終了する。

このため、本実施形態では、路面反射点の方位の分散値Varから反射波の位相の折り返しを判定できないときには、その分散値Varに応じて、分散値Varが閾値ＴＨよりも小さいほど、大きい値となるように、係数ｋが設定されることになる。

従って、第２実施形態では、路面反射点の方位の分散が大きくなるにつれて、最新の区間推定値の割合が小さくなるように、出力推定値が算出されることになり、出力軸ずれ角及び出力信頼度をより精度よく求めることができるようになる。
［第３実施形態］
第１，第２実施形態では、折り返し判定処理において、路面反射点の方位の分布の特徴量である分散値Varが、閾値ＶＨよりも大きい場合（Ｓ４２０：ＹＥＳ）に、反射波の位相の折り返しが発生していると判定する、ものとして説明した。

しかし、図１４に例示したように、折り返し発生時には、路面反射点の分布確率が高くなる領域が複数存在する。このため、路面反射点の分布から、分布確率が所定値以上となるピーク領域Ａ１，Ａ２…を抽出し、そのピーク領域が複数存在する場合に、反射波の位相の折り返しが発生していると判定することもできる。

そこで、本実施形態では、折り返し判定部４１としての折り返し判定処理を、図１６に示す手順で実行する。なお、本実施形態の折り返し判定処理を実行するに当たって、Ｓ１３０の区間方位情報算出処理においては、１区間内に検出された全路面反射点の方位情報を、メモリ２７に記憶するものとする。

図１６に示すように、本実施形態の折り返し判定処理では、ＣＰＵ２１は、まずＳ６１０にて、メモリ２７から１区間分の路面反射点の方位情報（すなわち方位分布）を読み込む。そして、続くＳ６２０では、Ｓ６１０にて、その読み込んだ方位情報に基づき、路面反射点の分布確率が所定値以上となるピーク領域を抽出する。

次に、ＣＰＵ２１は、Ｓ６３０にて、Ｓ６２０にて抽出されたピーク領域が、図１４に示す領域Ａ１，Ａ２のように、複数存在するか否かを判定することで、反射波の位相の折り返しが発生しているか否かを判定する。

そして、ピーク領域が複数存在し、反射波の位相の折り返しが発生していると判定すると、ＣＰＵ２１は、Ｓ６４０に移行し、上述したＳ４３０と同様、係数ｋとして値Ｋ１を設定し、折り返し判定処理を終了する。

一方、Ｓ６３０にて、ピーク領域は複数存在しないと判定されると、Ｓ６５０にて、ピーク領域は１個であるか否かを判定する。そして、ピーク領域が１個である場合には、ＣＰＵ２１は、反射波の位相の折り返しは発生していないと判定して、Ｓ６６０に移行する。

Ｓ６６０では、上述したＳ４４０と同様、係数ｋとして、Ｋ１よりも値が大きいＫ２を設定し、折り返し判定処理を終了する。
また、Ｓ６５０にてピーク領域は１個ではない、つまり、Ｓ６２０にてピーク領域が抽出されていないと判定すると、ＣＰＵ２１は、Ｓ６７０に移行し、係数ｋとしてＫ３を設定し、折り返し判定処理を終了する。なお、Ｋ３は、Ｋ１以上で、Ｋ２よりも小さい値である。

つまり、路面反射点の分布のピークの高さが小さく、分布がなだらかである場合、Ｓ６２０では、ピーク領域が抽出されない。そして、この場合には、反射波の位相の折り返しが発生している可能性があるので、Ｓ６７０にて、係数ｋにＫ３（＜Ｋ２、≧Ｋ１）を設定するのである。

このように折り返し判定処理を実行しても、反射波の位相の折り返しを判定することができる。このため、本実施形態においても、第１実施形態の信号処理部７と同様、出力軸ずれ角及び出力信頼度を、反射波の位相の折り返しの影響を受けることのないよう、適正に推定することができるようになる。
［第４実施形態］
第３実施形態では、折り返し判定処理において、路面反射点の方位の分布確率が所定値以上となるピーク領域を検出し、ピーク領域が複数である場合に、係数ｋにＫ１を設定し、そうでなければ、係数ｋにＫ２又はＫ３を設定するものとした。

これに対し、本実施形態では、図１７に示すように、折り返し判定処理において、ピーク領域が複数存在すると判定した場合（Ｓ６３０：ＹＥＳ）には、Ｓ６８０に移行して、各ピーク領域での分布確率のピーク値Ｐ１，Ｐ２を求める。

なお、ピーク値Ｐ１，Ｐ２は、図１８に示すように、２つのピーク領域で最大となる分布確率であり、各ピーク領域で最大となる分布確率のうち、大きい方がＰ１、小さい方がＰ２として設定される。

また、Ｓ６２０にて３つ以上のピーク領域が抽出された場合には、分布確率が高い２つのピーク領域が選択され、その選択された各ピーク領域におけるピーク値が算出される。
そして、このようにＳ６８０にてピーク値Ｐ１，Ｐ２が算出されると、ＣＰＵ２１は、Ｓ６９０にて、その算出されたピーク値Ｐ１，Ｐ２と、Ｓ６６０にて係数ｋとして設定される値Ｋ２をパラメータとする次式
ｋ＝（１－Ｐ２／Ｐ１）・Ｋ２
を用いて、係数ｋを算出し、折り返し判定処理を終了する。

なお、図１７の折り返し判定処理において、Ｓ６１０～Ｓ６３０，Ｓ６５０の処理は、第３実施形態と同様に実施され、第３実施形態と異なる点は、Ｓ６４０の処理に代えて、Ｓ６８０，Ｓ６９０の処理が実施される点である。ただし、Ｓ６７０にて、係数ｋとして設定される値Ｋ３には、Ｋ２よりも小さい任意の値（０≦Ｋ３＜Ｋ２）が設定される。

このように、本実施形態では、路面反射点の方位の分布確率が所定値上となるピーク領域が複数ある場合に、その複数のピーク領域のうち、分布確率が高い２つのピーク領域での分布確率のピーク値Ｐ１，Ｐ２に基づき、係数ｋを設定する。そして、係数ｋは、ピーク値Ｐ１，Ｐ２の差が小さく、その比率Ｐ２／Ｐ１が１に近いほど、値が小さくなる。

この結果、本実施形態によれば、路面反射点の方位の分散が大きい程、最新の区間推定値の割合が小さくなるように、出力推定値が算出されることになり、出力軸ずれ角及び出力信頼度をより精度よく求めることができるようになる。
［他の実施形態］
以上、本開示の実施形態について説明したが、本開示は上述の実施形態に限定されることなく、種々変形して実施することができる。

例えば、上記実施形態では、垂直方向の軸ずれ角βを推定する例を挙げて説明したが、本開示はこれに限定されるものではない。つまり、垂直方向の軸ずれ角β及び水平方向の軸ずれ角αのいずれか一方を推定するように構成されてもよい。

また、上記実施形態では、軸ずれ角は、路面反射点を抽出し、ｘ－ｚ平面上で路面反射点を結ぶ直線を求め、その直線の傾きβを、垂直方向の軸ずれ角とするものとして説明したが、水平方向の軸ずれ角についても、同様に求めることができる。

つまり、例えば、ｘ－ｙ平面上で路面反射点を結ぶ直線を求め、その直線の傾きを水平方向の軸ずれ量とするようにすれば、水平方向の軸ずれ角αを求めることができる。
また、軸ずれ角は、必ずしも路面反射点を抽出して求める必要はなく、全ての反射点情報を用いて推定するようにしてもよい。

例えば、特許文献１に記載のように、各反射点の反射波の強度から、反射強度が高くなるビームの中心をレーダ装置の方向として検出して、自車ＶＨの進行方向とのずれを軸ずれ角として推定するようにしてもよい。

そして、この場合でも、反射波の位相の折り返しが発生すると、レーダ装置の方向を正確に検出することができなくなる。
従って、この場合にも、反射波の方位の分布の特徴量である分散値やピーク領域の数から、反射波の位相の折り返しの有無を判定して、出力軸ずれ角や出力信頼度を算出する際に用いる係数ｋを変更するようすれば、上記実施形態と同様の効果を得ることができる。なお、この場合、路面反射点の方位の分布ではなく、全反射点の方位の分布から折り返しを判定するようにしてもよい。

次に、上記実施形態では、レーダ装置がレーダ波を車両の前方に向けて送信する形態を示したが、レーダ波の送信方向は車両の前方に限定されるものではない。例えば、レーダ装置は、車両の前方、右前方、左前方、後方、右後方、左後方、右側方及び左側方の少なくとも一方に向けてレーダ波を送信するように構成されてもよい。

また、上記実施形態では、レーダ装置がＦＭＣＷ方式を採用している例を示したが、レーダ装置のレーダ方式は、ＦＭＣＷに限定されるものではなく、例えば、２周波ＣＷ、ＦＣＭ又はパルスを採用するように構成されてもよい。ＦＣＭは、Fast-Chirp Modulationの略である。

また、上記実施形態では、軸ずれ推定装置としての機能は、レーダ装置３から反射点情報を取得する信号処理部７にて実現されるものとして説明したが、信号処理部７は、レーダ装置３が有する一機能として、レーダ装置３に設けられていてもよい。

また、上記実施形態では、信号処理部７はマイコンにて構成され、軸ずれ推定装置としての機能は、マイコンがプログラムを実行することにより実現されるものとして説明したが、信号処理部７を構成するマイコンの数は１つでも複数でもよい。

また、信号処理部７が有する各種機能を実現する手法はソフトウェアに限るものではなく、その一部又は全部の要素について、一つあるいは複数のハードウェアを用いて実現されてもよい。例えば、上記機能がハードウェアである電子回路によって実現される場合、その電子回路は多数の論理回路を含むデジタル回路、又はアナログ回路、あるいはこれらの組合せによって実現してもよい。

つまり、本開示の軸ずれ推定装置及びその手法は、コンピュータプログラムにより具体化された一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリを構成することによって提供された専用コンピュータにより、実現されてもよい。あるいは、本開示の軸ずれ推定装置及びその手法は、一つ以上の専用ハードウェア論理回路によってプロセッサを構成することによって提供された専用コンピュータにより、実現されてもよい。また、本開示の軸ずれ推定装置及びその手法は、一つ乃至は複数の機能を実行するようにプログラムされたプロセッサ及びメモリと一つ以上のハードウェア論理回路によって構成されたプロセッサとの組み合わせにより構成された一つ以上の専用コンピュータにより、実現されてもよい。また、コンピュータプログラムは、コンピュータにより実行されるインストラクションとして、コンピュータ読み取り可能な非遷移有形記録媒体に記憶されてもよい。また、信号処理部７に含まれる各部の機能を実現する手法には、必ずしもソフトウェアが含まれている必要はなく、その全部の機能が、一つあるいは複数のハードウェアを用いて実現されてもよい。

また、上記実施形態における１つの構成要素が有する複数の機能を、複数の構成要素によって実現したり、１つの構成要素が有する１つの機能を、複数の構成要素によって実現したりしてもよい。また、複数の構成要素が有する複数の機能を、１つの構成要素によって実現したり、複数の構成要素によって実現される１つの機能を、１つの構成要素によって実現したりしてもよい。また、上記実施形態の構成の一部を省略してもよい。また、上記実施形態の構成の少なくとも一部を、他の上記実施形態の構成に対して付加又は置換してもよい。

また、本開示の技術は、軸ずれ推定装置の他、軸ずれ推定装置を構成要素とするシステム、軸ずれ推定装置のコンピュータを機能させるためのプログラム、このプログラムを記録した半導体メモリ等の非遷移有形記録媒体、軸ずれ推定方法など、種々の形態で本開示を実現することもできる。

３…レーダ装置、７…信号処理部、３１…情報取得部、３３…軸ずれ角推定部、３５…信頼度算出部、３７…区間推定値算出部、３９…出力推定値算出部、４１…折り返し判定部。

Claims (7)

1. 移動体周囲にレーダ波を照射し、その反射波を複数のアンテナで受信することで、移動体周囲の物体を検出するよう構成されたレーダ装置（３）の、軸ずれ角を推定する軸ずれ推定装置（７）であって、
   前記レーダ装置にて検出された前記反射波の反射点のそれぞれについて、少なくとも距離、相対速度及び方位を表す情報を取得するよう構成された情報取得部（３１）と、
   前記情報取得部にて取得された情報に基づいて前記軸ずれ角を推定するよう構成された軸ずれ角推定部（３３）と、
   前記軸ずれ角推定部にて推定された前記軸ずれ角の推定値を所定期間平滑化することで、区間軸ずれ角を算出するよう構成された区間推定値算出部（３７）と、
   前記区間推定値算出部にて算出された前記区間軸ずれ角を、出力軸ずれ角の過去値と平滑化することで、前記出力軸ずれ角を算出するよう構成された出力推定値算出部（３９）と、
   前記区間推定値算出部にて前記区間軸ずれ角を算出するのに用いられた前記所定期間内の各反射点の情報に含まれている前記方位の分布から、前記レーダ装置において前記反射波の位相の折り返しが発生しているか否かを判定するよう構成された折り返し判定部（４１）と、
   を備え、
   前記折り返し判定部は、前記折り返しの判定結果に基づいて、前記出力軸ずれ角が前記折り返しの影響を受けることのないよう、前記出力推定値算出部が前記区間軸ずれ角を平滑化する際の割合を変化させるように構成されている、軸ずれ推定装置。
2. 請求項１に記載の軸ずれ推定装置であって、
   前記軸ずれ角推定部にて推定された前記軸ずれ角の信頼度を算出する信頼度算出部（３５）を備え、
   前記区間推定値算出部は、前記区間軸ずれ角に加えて、前記信頼度算出部にて算出された信頼度を所定期間平滑化した区間信頼度を算出するよう構成され、
   前記出力推定値算出部は、前記区間推定値算出部にて算出された前記区間信頼度を、出力信頼度の過去値と平滑化することで、前記出力軸ずれ角に加えて、前記出力信頼度を算出するよう構成され、
   前記折り返し判定部は、前記折り返しの判定結果に基づいて、前記出力推定値算出部が前記区間軸ずれ角及び前記区間信頼度を前記過去値と平滑化する際の割合を変化させるように構成されている、軸ずれ推定装置。
3. 請求項１又は請求項２に記載の軸ずれ推定装置であって、
   前記軸ずれ角推定部は、前記情報取得部にて取得される情報のうち、路面からの反射点の情報を用いて前記軸ずれ角を推定するよう構成され、
   前記折り返し判定部は、前記路面からの反射点の情報に含まれている前記各反射点の前記方位の分布に基づき、前記折り返しが発生しているか否かを判定するよう構成されている、軸ずれ推定装置。
4. 請求項１～請求項３の何れか１項に記載の軸ずれ推定装置であって、
   前記折り返し判定部は、前記各反射点の前記方位の分散が予め設定された閾値よりも大きいときに、前記折り返しが発生していると判定するよう構成されている、軸ずれ推定装置。
5. 請求項４に記載の軸ずれ推定装置であって、
   前記折り返し判定部は、前記各反射点の前記方位の分散が大きいときほど、前記区間推定値算出部にて算出された最新値の割合が小さくなるよう、前記出力推定値算出部が該最新値を前記過去値と平滑化する際の割合を設定するよう構成されている、軸ずれ推定装置。
6. 請求項１～請求項３の何れか１項に記載の軸ずれ推定装置であって、
   前記折り返し判定部は、前記各反射点の前記方位の分布において、分布確率が高くなるピーク領域を抽出し、該ピーク領域が複数ある場合に、前記折り返しが発生していると判定するよう構成されている、軸ずれ推定装置。
7. 請求項６に記載の軸ずれ推定装置において、
   前記折り返し判定部は、前記ピーク領域が複数ある場合に、各ピーク領域での前記分布確率のピーク値が近いときほど、前記区間推定値算出部にて算出された最新値の割合が小さくなるよう、前記出力推定値算出部が該最新値を前記過去値と平滑化する際の割合を設定するよう構成されている、軸ずれ推定装置。

Images