JP2021060370A - 推定装置 - Google Patents

Abstract

【課題】自車のみによってレーダ装置の高さ方向におけるずれを推定できる技術を提供する。【解決手段】移動体に搭載された推定装置４は、取得部と、抽出部と、推定部と、を備える。取得部は、移動体に搭載されたレーダ装置により検出された複数の反射点のそれぞれについて、反射点情報を取得する。反射点情報は、反射点についての水平角度及び垂直角度と、レーダ装置から反射点迄の距離と、を少なくとも含む。抽出部は、反射点情報に基づいて、路面反射点を抽出する。推定部は、少なくともレーダ装置から路面反射点迄の距離である路面反射点距離に基づいて、移動体に搭載されたレーダ装置の高さである装置高さを推定する。【選択図】図１

Description

本開示は、推定装置に関する。

レーダ装置について高さ方向における位置のずれを推定する、という技術が知られている。例えば下記特許文献１では、対向車が互いにレーダ装置を有しており、対向車によって検出された自車のレーダ装置の高さと自車が予め記憶しているレーダ装置の高さとの乖離量に基づいて、高さ方向におけるずれを推定する、という技術が開示されている。

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

しかしながら、発明者の詳細な検討の結果、特許文献１に記載の技術では、自車のみによって高さ方向におけるずれを推定できない、という課題が見出された。
本開示の一態様は、自車のみによってレーダ装置の高さ方向におけるずれを推定できる技術を提供することにある。

本開示の一態様は、移動体に搭載された推定装置（４）であって、取得部（Ｓ１０）と、抽出部（Ｓ２０）と、推定部（Ｓ３０、Ｓ３５、Ｓ３９）と、を備える。取得部は、移動体に搭載されたレーダ装置により検出された複数の反射点のそれぞれについて、反射点情報を取得するように構成される。反射点情報は、反射点についての方位角であってレーダビームの中心軸に沿った方向であるビーム方向を基準として求められた水平角度及び垂直角度と、レーダ装置から反射点迄の距離と、を少なくとも含む。抽出部は、少なくとも反射点情報に基づいて、複数の反射点のうち路面での反射により検出された少なくとも１つの路面反射点を抽出するように構成される。推定部は、少なくともレーダ装置から路面反射点迄の距離である路面反射点距離に基づいて、移動体に搭載されたレーダ装置の高さである装置高さを推定する。

このような構成によれば、他車両による検出結果を用いることなく、自車のみによって装置高さを推定することができる。この結果、自車のみによってレーダ装置の高さ方向におけるずれを推定することができる。

車両制御システムの構成を示すブロック図。 レーダ波の水平方向における照射範囲を説明する説明図。 レーダ波の垂直方向における照射範囲を説明する説明図。 信号処理部の機能を説明するブロック図。 レーダ装置の高さ方向における位置のずれを説明する説明図。 第１実施形態の調整処理のフローチャート。 路面反射抽出処理のフローチャート。 第１実施形態の算出処理のフローチャート。 第１実施形態における高さずれ量の推定を説明する説明図。 第２実施形態の調整処理のフローチャート。 第２実施形態の抽出頻度処理のフローチャート。 抽出頻度が記憶される様子を説明する説明図。 対応情報の例を説明する説明図。 第２実施形態による装置高さの推定例を説明する説明図。 第２実施形態の変形例による装置高さの推定例を説明する説明図。 第３実施形態の調整処理のフローチャート。

以下、図面を参照しながら、本開示の例示的な実施形態を説明する。なお、以下でいう「垂直」とは、厳密な意味での「垂直」に限るものではなく、同様の効果を奏するのであれば厳密に「垂直」でなくてもよい。以下でいう「水平」、「一致」についても同様である。

［１．第１実施形態］
［１−１．構成］
図１に示す車両制御システム１は、移動体である車両ＶＨに搭載されるシステムである。車両制御システム１は、レーダ装置２と、車載センサ群３と、信号処理部４と、支援実行部５とを備える。又、車両制御システム１は、通知装置５１、搭載高さ調整装置５２を備えていてもよい。以下では、車両制御システム１を搭載する車両ＶＨを自車ＶＨともいう。また、自車ＶＨの車幅方向を水平方向、車高方向を垂直方向ともいう。

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

なお、レーダ装置２は、レーダ波としてミリ波帯の電磁波を使用するいわゆるミリ波レーダであってもよいし、レーダ波としてレーザー光を用いるレーザレーダ、レーダ波として音波を用いるソナーであってもよい。いずれにしても、レーダ波を送受信するアンテナ部は、水平方向及び垂直方向のいずれについても反射波の到来方向を検出できるように構成されている。アンテナ部は、水平方向及び垂直方向に並ぶアレイアンテナを備えていてもよい。

レーダ装置２は、本実施形態では、ビーム方向が、自車ＶＨの前後方向即ち進行方向と一致するように取り付けられ、自車ＶＨの前方に存在する各種物標を検出するために用いられる。ビーム方向とは、照射するレーダビームの中心軸ＣＡ方向に沿った方向をいう。レーダ装置２は反射点情報を生成する。

反射点情報とは、反射点に関する情報である。反射点情報には、反射点の方位角、反射点の距離（即ち、レーダ装置２と反射点との距離）、が少なくとも含まれる。なお、レーダ装置２は、反射点の自車ＶＨに対する相対速度、反射点により反射されたレーダビームの受信強度、を検出するように構成されてもよく、反射点情報には、反射点の相対速度、受信強度が含まれていてもよい。

反射点の方位角とは、図２、３に示すように、レーダビームの中心軸ＣＡに沿った方向であるビーム方向を基準として求められた、反射点が存在する水平方向の角度（以下、水平角度）Ｈｏｒ及び垂直方向の角度（以下、垂直角度）Ｖｅｒの少なくとも一方である。本実施形態では、垂直角度Ｖｅｒ及び水平角度Ｈｏｒの両方が反射点の方位角を表す情報として反射点情報に含まれる。

本実施形態では、レーダ装置２は、ＦＭＣＷ方式を採用しており、上り変調区間のレーダ波と下り変調区間のレーダ波を予め設定された変調周期で交互に送信し、反射したレーダ波を受信する。ＦＭＣＷは、Frequency Modulated Continuous Waveの略である。本実施形態では、レーダ装置２は、変調周期毎に、上述のように反射点の方位角である水平角度Ｈｏｒ及び垂直角度Ｖｅｒと、反射点までの距離と、反射点との相対速度と、受信したレーダ波の受信電力（以下、反射電力）と、を反射点情報として検出する。

車載センサ群３は、自車ＶＨの状態等を検出するために自車ＶＨに搭載された少なくとも１つのセンサである。車載センサ群３には、車速センサが含まれていてもよい。車速センサは、車輪の回転に基づいて車速を検出するセンサである。また、車載センサ群３には、カメラが含まれていてもよい。該カメラは、レーダ装置２によるレーダ波の照射範囲と同様の範囲を撮像する。また、車載センサ群３には、加速度センサが含まれていてもよい。加速度センサは、自車ＶＨの加速度を検出する。また、車載センサ群３には、ヨーレートセンサが含まれていてもよい。ヨーレートセンサは、自車ＶＨ前方に対する自車ＶＨの進行方向の傾きを表すヨー角の変化速度を検出する。

信号処理部４は、マイコン４０を備える。マイコン４０は、ＣＰＵ４１と、ＲＯＭ４３、ＲＡＭ４４、フラッシュメモリ等の半導体メモリ（以下、メモリ４２）と、を含む。ＣＰＵ４１はプログラムを実行する。ＲＯＭ４３は、ＣＰＵ４１が実行するプログラムや、該プログラムの実行時に参照されるデータ等が格納される。ＲＡＭ４４は、データを一時的に記憶する。

信号処理部４は、ＣＰＵ４１がプログラムを実行することで実現される機能の構成として、図４に示すように、認識部４５と推定部４６と、を少なくとも備える。
支援実行部５は、信号処理部４が備える認識部４５での処理結果に基づき、各種車載機器を制御して、所定の運転支援を実行する。制御対象となる各種車載機器には、画像を表示するモニタ、警報音や案内音声を出力する音響機器が含まれていてもよい。又、自車ＶＨの内燃機関、パワートレイン機構、ブレーキ機構等を制御する制御装置が含まれていてもよい。

通知装置５１は、車室内に設置された音声出力装置であり、自車ＶＨの乗員に対して、警告音を出力する。なお、支援実行部５が備える音響機器等が通知装置５１として用いられてもよい。

搭載高さ調整装置５２は、モータと、レーダ装置２に取り付けられた歯車とを備える。搭載高さ調整装置５２は、信号処理部４から出力される駆動信号に従ってモータを回転させる。これにより、モータの回転力が歯車に伝達され、レーダ装置２を垂直方向において上下させることができる。

［１−２．処理］
［認識部］
認識部４５は、物標認識の機能を実施する。物標認識の機能とは、レーダ装置２から得られる反射点情報や車載センサ群３から得られる各種情報に基づいて、自車ＶＨが走行する車線や、自車ＶＨと同一車線を走行する先行車両、その他の障害物等を検出する機能である。物標認識の結果は支援実行部５等に出力される。

［推定部］
レーダ装置２は、例えば工場からの出荷時のような初期状態においては、自車ＶＨに、正確に、予め定められた位置に取り付けられている。以下でいう初期高さとは、このときのレーダ装置２の路面からの高さをいう。例えば、初期高さはＲＯＭ４３といったメモリ４２に予め記憶されている。初期高さに設置されたレーダ装置２の検出結果に基づいて、上述の認識部４５では、物標認識の機能が精度良く実現される。

しかしながら、自車ＶＨにおいては、レーダ装置２に高さずれが生じ得る。高さずれの例を図５に示す。点線で示されているレーダ装置２００は、初期高さＦに設置されているときのレーダ装置を示す。高さずれは、例えば、ユーザが、自車ＶＨのタイヤを初期高さが記憶されたときとは異なるタイヤ径のタイヤに交換するときや、自車ＶＨのサスペンションを初期高さが記憶されたときとは異なるサスペンションに交換するとき等に生じ得る。

そこで、推定部４６は、後述する調整処理に基づいて、レーダ装置２の装置高さ、及び高さずれ量、を推定する機能を実施する。推定部４６は、これらの機能を調整処理によって実現する。装置高さとは、自車ＶＨに搭載されたレーダ装置２の高さであって、路面からの高さをいう。高さずれとは、垂直方向において、レーダ装置２の位置に、予め定められた高さである初期高さからのずれが生じている状態をいう。高さずれ量とは、このような高さずれの大きさを距離で表したものである。

ここで、自車ＶＨの座標軸とレーダ装置２の座標軸とについて説明する。自車ＶＨの座標軸とは、図２及び図３に示すように、鉛直方向に延びる軸である垂直軸Ｚｃ、水平方向に延びる軸である水平軸Ｙｃ、及び自車ＶＨの進行方向に延びる進行方向軸Ｘｃ、をいう。垂直軸Ｚｃ、水平軸Ｙｃ、及び進行方向軸Ｘｃは互いに直交する。

一方、レーダ装置２の座標軸とは、図５に示すように、自車ＶＨにレーダ装置２が取り付けられた状態において、レーダ装置２の上下に延びる上下軸Ｚｓ、レーダ装置２の左右に延びる左右軸Ｙｓ、及びレーダ装置２の前後に延びる前後軸Ｘｓ、をいう。上下軸Ｚｓ、左右軸Ｙｓ、及び前後軸Ｘｓは互いに直交する。装置系座標とは、レーダ装置２の座標軸に基づいて表される座標をいう。

自車ＶＨの前方にレーダ装置２が設置される本実施形態では、前後軸Ｘｓは中心軸ＣＡに等しい。つまり、高さずれ量は、進行方向軸Ｘｃとレーダ装置２の前後軸Ｘｓとの垂直方向の距離に相当する。

［１−２−１．調整処理］
推定部４６が実行する調整処理について、図６のフローチャートを用いて説明する。本処理は、イグニションスイッチがオンされたことをきっかけとして開始される。

推定部４６は、本処理が起動すると、Ｓ１０にて、レーダ装置２から上述の反射点情報を取得する。反射点情報とは、上述のように、自車ＶＨに搭載されたレーダ装置２により検出された複数の反射点のそれぞれについての情報であって、方位角としての水平角度及び垂直角度と、レーダ装置２から反射点迄の距離と、を少なくとも含む。以下では、反射点情報から特定される反射点を、取得反射点という。また、推定部４６は、車載センサ群３から、自車速Ｃｍを含む、各種検出結果を取得する。

推定部４６は、Ｓ２０では、路面反射抽出処理を実行する。路面反射抽出処理は、取得反射点のうちから、路面上の反射点である路面反射点を抽出するための処理である。路面反射点とは、路面での反射により検出された少なくとも１つの反射点をいう。路面反射抽出処理の詳細については後述する。

推定部４６は、Ｓ３０では、算出処理を実行する。算出処理は、少なくとも路面反射点距離に基づいて、装置高さを算術的に推定する処理である。路面反射点距離とは、レーダ装置２から路面反射点迄の距離である。

推定部４６は、Ｓ４０では、高さずれ量を特定する。本実施形態では、高さずれ量は、Ｓ３０にて推定された装置高さと初期高さとの差をいう。推定部４６は、特定した高さずれ量をメモリ４２に記憶する。

推定部４６は、Ｓ５０では、Ｓ３０にて推定された高さずれ量に基づいて、搭載高さ調整装置５２による調整が必要か否かを判断する。具体的には、推定部４６は、高さずれ量が予め定められた距離である閾値距離以上である場合に、調整を必要とすると判断する。つまり、閾値距離とは、搭載高さ調整装置５２による調整を必要とする、垂直方向におけるレーダ装置２のずれ量を表す。閾値距離は、予めメモリ４２に記憶されていてもよい。

推定部４６は、高さずれ量が閾値距離未満であり調整を必要としない場合に処理をＳ９０へ移行させ、高さずれ量が閾値距離以上であり調整を必要とする場合に処理をＳ６０へ移行させる。

推定部４６は、Ｓ６０では、Ｓ４０にて推定された高さずれ量が、搭載高さ調整装置５２による調整可能範囲内であるか否かを判断する。推定部４６は、Ｓ４０にて推定された高さずれ量が調整可能範囲内である場合に処理をＳ７０へ移行させ、調整可能範囲内でない場合には処理をＳ８０へ移行させる。調整可能範囲は、予めメモリ４２に記憶されていてもよい。

推定部４６は、Ｓ７０では、搭載高さ調整装置５２によって、Ｓ４０にて推定された高さずれ量ぶん装置高さを調整する。つまり、推定部４６は、レーダ装置２の前後軸Ｘｓを中心に車高方向にレーダ装置２を高さずれ量ぶん上下させて、装置高さを調整する。そして、推定部４６は、調整処理を終了する。

なお、推定部４６は、本調整処理とは別処理において、Ｓ１０にて取得された反射点の位置座標を算出し、算出した位置座標における高さをＳ４０にて推定された高さずれ量ぶん増減して、位置座標の補正を行ってもよい。そして、認識部４５は、補正後の反射点の位置座標に基づいて、上述の物標認識を実行してもよい。

推定部４６は、Ｓ８０では、レーダ装置２に高さずれが生じていることを示すダイアグ情報（以下、高さずれダイアグ）を推定部４６の外部装置に出力する。外部装置は通知装置５１であってもよい。推定部４６は、例えば、通知装置５１に高さずれダイアグを出力してもよい。通知装置５１は、高さずれダイアグに従って警告音を出力してもよい。

推定部４６は、Ｓ９０では、イグニションスイッチがオフされたか否かを判断する。ここで、推定部４６は、イグニションスイッチがオフされていない場合に処理をＳ１０へ移行させる。一方、推定部４６は、イグニションスイッチがオフされた場合に、以上で本調整処理を終了する。

［１−２−２．路面反射抽出処理］
次に、推定部４６が調整処理のＳ２０にて実行する路面反射抽出処理について、図７のフローチャートを用いて説明する。

推定部４６は、Ｓ１００では、車載センサ群３から各種センサによる自車ＶＨの状態等の検出結果を取得する。ここでいう検出結果には、自車ＶＨの車速、加速度、ヨー角、等が含まれ得る。

推定部４６は、Ｓ１１０では、車載センサ群３から取得した自車ＶＨの状態等の検出結果に基づいて、路面反射点を抽出するか否かを判断する。
具体的には、推定部４６は、自車ＶＨの状態等の検出結果に基づいて自車ＶＨの車体が路面に対して安定しているか否か判断し、自車ＶＨの車体が路面に対して安定している状態である場合に、路面反射点を抽出すると判断する。

自車ＶＨの車体が路面に対して安定している状態とは、自車ＶＨの車体が路面に対して傾いていない状態や、自車ＶＨの車体が路面に対して上下に移動していない状態で有り得る。換言すれば、自車ＶＨの車体が路面に対して安定している状態とは、曲率の大きいカーブ道路を走行していない状態や、凹凸の大きい路面を走行していない状態で有り得る。

ここで、凹凸の大きい路面を走行していないときとは、平坦な路面を走行しているときであるといえる。この場合は、凹凸の大きい路面を走行しているときよりも、速度及び加速度が大きいと考えられる。一方、曲率の大きいカーブ道路を走行していないときとは、直線道路を走行している状態に近いときであるといえる。この場合は、速度及び加速度が、曲率の大きいカーブ道路を走行しているときよりも大きく、曲率の大きいカーブ道路を走行しているときよりも、ヨー角の変化速度が小さい場合が多い。

そこで、推定部４６は、自車ＶＨの車速が予め定められた車速閾値以上である場合に、自車ＶＨの車体が路面に対して安定している状態であると判断し、路面反射点を抽出すると判断してもよい。つまり、推定部４６は、自車ＶＨの車速が車速閾値未満である場合、自車ＶＨの車体が路面に対して安定していない状態であると判断し、路面反射点を抽出しない、と判断してもよい。

同様に、推定部４６は、自車ＶＨの加速度が予め定められた加速度閾値以上である場合に、自車ＶＨの車体が路面に対して安定している状態であると判断し、路面反射点を抽出すると判断してもよい。また同様に、推定部４６は、自車ＶＨのヨー角の変化速度が予め定められた閾値未満である場合に、自車ＶＨの車体が路面に対して安定している状態であると判断し、路面反射点を抽出すると判断してもよい。

推定部４６は、路面反射点を抽出すると判断した場合に処理をＳ１２０へ移行させ、路面反射点を抽出しないと判断した場合に処理をＳ１８０へ移行させる。
推定部４６は、Ｓ１２０では、全ての取得反射点のうちから１つの取得反射点を選択する。推定部４６は、選択した取得反射点（以下、単に取得反射点という）について、Ｓ１３０−Ｓ１９５の処理を実行する。

推定部４６は、Ｓ１３０では、取得反射点が水平方向において中心軸ＣＡを含む所定の方位範囲である抽出範囲内に位置するか否かを判断する。推定部４６は、取得反射点が該方位範囲内に位置する場合に処理をＳ１４０へ移行させ、選択した取得反射点が該方位範囲内に位置しない場合に処理をＳ１９０へ移行させる。

つまり、推定部４６は、複数の取得反射点のうちから抽出範囲内に位置する取得反射点を抽出する。抽出範囲は、例えば、水平方向において中心軸ＣＡを含む±数°−数十°の範囲に定められていてもよい。換言すれば、抽出範囲は、自車ＶＨの前方にレーダ装置２が設置されている本実施形態では、自車ＶＨの進行方向付近の所定の範囲に定められていてもよい。抽出範囲は、実験等によって予め定められていてもよい。抽出範囲は、予めメモリ４２に記憶されている。

推定部４６は、Ｓ１４０では、選択した取得反射点についてのレーダ装置２からの距離が所定の距離閾値未満であるか否かを判断する。推定部４６は、選択した取得反射点についての距離が距離閾値未満である場合に処理をＳ１５０へ移行させ、選択した取得反射点についての距離が距離閾値以上である場合に処理をＳ１９０へ移行させる。

つまり、推定部４６は、レーダ装置２からの距離が距離閾値未満である取得反射点を抽出する。距離閾値は、予めメモリ４２に記憶されている。
推定部４６は、Ｓ１５０では、取得反射点が静止反射点であるか否かを判断する。推定部４６は、取得反射点が静止反射点である場合に処理をＳ１６０へ移行させ、取得反射点が静止反射点でない場合に処理をＳ１９０へ移行させる。静止反射点とは、静止物によってレーダ波が反射された反射点である。

つまり、推定部４６は、取得反射点のうち、静止反射点を抽出する。具体的には、推定部４６は、Ｓ１０にて取得した自車速Ｃｍを用い、反射点情報に含まれる相対速度をｑ、予め設定された下限の速度閾値をε₁、上限の速度閾値をε₂として、ε₁≦ｑ／Ｃｍ＜ε₂を満たす取得反射点を静止反射点として抽出してもよい。即ち、相対速度ｑに対する自車速Ｃｍの比が、ε₁以上ε₂未満といった予め定められた速度閾値範囲内となる取得反射点を静止反射点として抽出してもよい。

静止反射点からレーダ装置２に向かう方向とビーム方向とが一致している場合は、その自車速Ｃｍと反射点の相対速度ｑは同じ大きさとなり、かつ相対速度ｑの向きは自車速Ｃｍとは反対であるため、ｑ／Ｃｍ＝−１となる。このように、ｑ／Ｃｍ＝−１となる反射点は静止反射点であると考えられる。

但し、車載センサ群３から取得される自車速Ｃｍは、車輪のスリップ等によって実際の車速とは必ずしも一致しない。また、レーダ装置２にて検出される相対速度ｑにも誤差が含まれる。このため、静止反射点であったとしても、必ずしもｑ／Ｃｍ＝−１になるとは限らない場合がある。下限の速度閾値ε₁及び上限の速度閾値ε₂は、これらの影響を考慮して適宜設定された値を用いてもよい。

推定部４６は、Ｓ１６０では、取得反射点の反射電力が予め定められた電力閾値未満であるか否かを判断する。推定部４６は、取得反射点の反射電力が電力閾値未満である場合に処理をＳ１７０へ移行させ、取得反射点の反射電力が電力閾値以上である場合に処理をＳ１９０へ移行させる。

つまり、推定部４６は、反射電力が電力閾値未満である取得反射点を抽出する。路面からの反射電力は例えば他の車両からの反射電力よりも小さいと考えられる。電力閾値はこのような路面からの反射電力に基づいて適宜定められてもよい。例えば電力閾値は、実験等により予め定められていてもよい。電力閾値は、予めメモリ４２に記憶されている。

推定部４６は、Ｓ１７０では、取得反射点がカメラによる撮像画像において路面であると識別されているか否かを判断する。推定部４６は、取得反射点が撮像画像において路面であると推定されている場合に処理をＳ１８０へ移行させ、取得反射点が撮像画像において路面であると推定されていない場合に処理をＳ１９５へ移行させる。

つまり、推定部４６は、撮像画像において路面であると識別されている取得反射点を抽出する。なお、推定部４６は、本調整処理とは別処理において、カメラによる撮像画像を取得し、撮像画像において路面であると識別される方位範囲を推定するように構成されていてもよい。

推定部４６は、Ｓ１８０では、取得反射点を路面反射点であると判断して、該取得反射点の三次元座標を路面反射点としてメモリ４２に記憶し、処理をＳ１９５へ移行させる。
推定部４６は、Ｓ１９０では、取得反射点を路面反射点でないと判断して、メモリ４２に記憶すること無く、処理をＳ１９５へ移行させる。

推定部４６は、Ｓ１９５では、全ての取得反射点について路面反射点であるか否かの確認を終了したか、判断する。ここで、推定部４６は、確認を終了していない場合に処理をＳ１１０へ移行させ、Ｓ１１０−Ｓ１９５の処理を繰り返す。一方、推定部４６は、確認を終了した場合に、本路面反射抽出処理を終了する。

つまり、本実施形態の路面抽出処理では、取得反射点のうち、次の（ａ）−（ｄ）の全てを満たす取得反射点を路面反射点として抽出する。
（ａ）水平方向において中心軸ＣＡを含む抽出範囲内に位置すること。

（ｂ）レーダ装置２からの距離が距離閾値未満であること。
（ｃ）静止反射点であること。
（ｄ）反射電力が電力閾値未満であること。

（ｅ）カメラによる撮像画像において路面であると識別されていること。
なお、路面反射抽出処理は、上記（ａ）−（ｅ）のうち、少なくとも（ａ）を満たすように構成されてもよい。つまり、路面反射抽出処理は、（ａ）を満たし、且つ、（ｂ）−（ｅ）のうち少なくとも１つを更に満たすように構成されてもよい。又は、路面反射抽出処理は、（ａ）及び（ｂ）を少なくとも満たすように構成されてもよい。つまり、路面反射抽出処理は、（ａ）及び（ｂ）満たし、路面反射抽出処理は、（ｃ）−（ｅ）のうち少なくとも１つを更に満たすように構成されてもよい。

［１−２−３．算出処理］
次に、推定部４６が調整処理のＳ３０にて実行する算出処理について、図８のフローチャートを用いて説明する。

推定部４６は、Ｓ２１０では、Ｓ２０にて特定された少なくとも１つの路面反射点について、反射点情報に基づいて、路面反射点までの距離と、路面反射点の方位角としての垂直角度θ_Verと、を取得する。

推定部４６は、Ｓ２２０では、推定するレーダ装置２の高さ（即ち、装置高さ）を未知パラメータＨとして、該未知パラメータＨを算出する。図９に示すように、未知パラメータＨは、路面反射距離をＲと、垂直角度θとに基づいて、下記式（１）で表される。

推定部４６は、Ｓ２３０では、Ｓ２２０にて算出された未知パラメータＨを、装置高さとして推定する。なお、推定部４６は、路面反射点が複数である場合は、路面反射点毎に未知パラメータＨを算出し、これらの平均値を装置高さとして推定してもよい。推定部４６は、このように推定した装置高さをメモリ４２に記憶し、以上で本算出処理を終了する。

［１−３．効果］
（１ａ）信号処理部４は、Ｓ３０では、少なくとも路面反射点距離に基づいて、自車ＶＨに搭載されたレーダ装置２の高さである装置高さを推定する。この結果、他車両と通信を行うことなく、自車ＶＨのみによって装置高さを推定することができる。また、自車ＶＨのみによって高さずれを推定することが可能となる。

（１ｂ）信号処理部４は、Ｓ３０では、装置高さを未知パラメータＨとして、該未知パラメータＨと、路面反射点距離Ｒと、垂直角度θ_verと、の間に成立する関係式である式（１）に基づいて、未知パラメータＨである装置高さを算出してもよい。この結果、関係式に基づいて精度よく装置高さを算出することができる。

（１ｃ）信号処理部４は、Ｓ４０では、Ｓ３０にて推定された装置高さと初期高さとの差を、高さずれ量として推定してもよい。この結果、自車ＶＨのみによって高さずれ量を推定することができる。

［２．第２実施形態］
［２−１．構成］
第２実施形態は、基本的な構成は第１実施形態と同様であるため、相違点について以下に説明する。なお、第１実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。

上述した第１実施形態では、信号処理部４は、装置高さを式（１）に基づいて算術的に推定した。これに対し、第２実施形態では、信号処理部４は、装置高さを後述する対応情報に基づいて統計的に推定する点で、第１実施形態と相違する。

［２−２．処理］
［２−２−１．調整処理］
次に、第２実施形態の信号処理部４（即ち、推定部４６）が、第１実施形態の調整処理（即ち、図６）に代えて実行する、第２実施形態の調整処理について、図１０のフローチャートを用いて説明する。上述の相違点に伴って、第２実施形態の信号処理部４が実行する高さずれ量推定処理では、図６に示すＳ３０、Ｓ４０が図１０に示すＳ３５、Ｓ４２に置換され、図１０にＳ３７が追加される。なお、図１０におけるＳ１０−Ｓ２０、Ｓ５０−Ｓ９０の処理は、図６におけるＳ１０−Ｓ２０、Ｓ５０−Ｓ９０の処理と同様であるため、説明を一部簡略化する。

推定部４６は、Ｓ１０−Ｓ２０については、図６におけるＳ１０−Ｓ２０と同様の処理を実行する。
推定部４６は、Ｓ２０に続くＳ３５では、抽出頻度処理を実行する。抽出処理は、路面反射点毎に後述する抽出頻度を生成し、抽出頻度を用いて装置高さを推定する処理である。推定された装置高さは、メモリ４２に記憶される。なお、抽出頻度処理では、抽出頻度処理が実行された回数（以下、抽出回数）Ｋがカウントされ、メモリ４２に記憶されている。

推定部４６は、続くＳ３７では、抽出回数Ｋが予め定められた抽出閾値以上であるか否かを判断する。ここで、推定部４６は、抽出回数Ｋが抽出閾値以上であると判断された場合に処理をＳ４２へ移行させる。一方、推定部４６は、抽出回数Ｋが抽出閾値未満であると判断された場合に、処理をＳ１０へ移行させ、Ｓ１０−Ｓ３７の処理を繰り返す。

推定部４６は、Ｓ４２では、高さずれ量を特定する。第２実施形態では、高さずれ量とは、Ｓ３５にて推定された装置高さと初期高さとの差をいう。推定部４６は、特定した高さずれ量をメモリ４２に記憶する。

推定部４６は、続くＳ５０−Ｓ９０については、図６に示すＳ５０−Ｓ９０と同様の処理を実行する。
［２−２−２．抽出頻度処理］
次に、推定部４６が調整処理のＳ３５にて実行する、抽出頻度処理について、図１１のフローチャートを用いて説明する。

推定部４６は、Ｓ３１０では、路面反射点の装置系座標（ｘ_s、ｙ_s、ｚ_s）を取得する。推定部４６は、調整処理とは別の処理にて、少なくとも路面反射点について、反射点情報に基づいて該路面反射点の装置系座標を算出するように構成されていてもよい。

推定部４６は、続くＳ３２０では、抽出頻度を算出し、算出した抽出頻度をメモリ４２に記憶する。抽出頻度とは、路面反射点が抽出された回数を路面反射点の位置毎に加算した数値を表す。ここでいう路面反射点の位置とは、上述の装置系座標（ｘ_s、ｙ_s、ｚ_s）のうちの２つの要素（ｘ_s、ｙ_s）によって表される。つまり、ここでいう路面反射点の位置とは、路面を表す平面上の位置をいう。以下では、このような路面を表す平面上の位置（ｘ_s、ｙ_s）についての抽出頻度を、Ｐ（ｘ_s、ｙ_s）のように表す。

抽出頻度Ｐ（ｘ_s、ｙ_s）は、例えば図１２に示すように、路面を表す平面上の位置（ｘ_s、ｙ_s）毎にメモリ４２に記憶されていてもよい。推定部４６は、本ステップでは、抽出頻度Ｐ（ｘ_s、ｙ_s）を１増加させて新たな抽出頻度Ｐ（ｘ_s、ｙ_s）とし、該抽出頻度Ｐ（ｘ_s、ｙ_s）を上書きしてメモリ４２に記憶する。

推定部４６は、次にＳ３３０では、Ｓ２０にて抽出された全ての路面反射点について、抽出頻度Ｐ（ｘ_s、ｙ_s）を算出したか否かを判断する。推定部４６は、全ての路面反射点について抽出頻度Ｐ（ｘ_s、ｙ_s）を算出していない場合に処理をＳ３１０へ移行させ、全ての路面反射点について抽出頻度Ｐ（ｘ_s、ｙ_s）を算出している場合に処理をＳ３４０へ移行させる。

推定部４６は、Ｓ３４０では、抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい路面反射点の位置（ｘ_s、ｙ_s）を特定する。
推定部４６は、続いてＳ３５０では、Ｓ３４０にて特定された、抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい路面反射点が、１つであるか否かを判断する。推定部４６は、抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい路面反射点が１つである場合に処理をＳ３６０へ移行させ、抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい路面反射点が複数である場合に処理をＳ３７０へ移行させる。

推定部４６は、Ｓ３６０、Ｓ３７０では、算出位置を特定する。算出位置とは、抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい路面反射点の位置をいう。算出位置は、レーダ装置２の装置高さに応じて異なる位置となる。一般に、装置高さが低くなるほど、算出位置は自車ＶＨに近い位置となる。

ここで、推定部４６は、Ｓ３６０では、Ｓ３４０にて特定された、抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい路面反射点の位置（ｘ_s、ｙ_s）を、算出位置としてメモリ４２に記憶する。

一方、推定部４６は、Ｓ３７０では、Ｓ３４０にて特定された、複数の抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい路面反射点のうち、最も前後軸Ｘｓに近い路面反射点を、算出位置としてメモリ４２に記憶してもよい。つまり、複数の路面反射点のうち、路面反射点の位置（ｘ_s、ｙ_s）を表す要素においてｙ_sが最も０に近い路面反射点の位置を算出位置として特定してもよい。
なお、本開示はこれに限定されるものではない。例えば、推定部４６は、Ｓ３７０では、抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい複数の路面反射点の位置を平均した平均位置を算出し、該平均位置を算出位置として特定してもよい。又は、推定部４６は、Ｓ３７０では、抽出頻度Ｐ（ｘ_s、ｙ_s）の最も大きい路面反射点が３つ以上ある場合、これら複数の路面反射点の中央位置を算出し、該中央位置を算出位置として特定してもよい。

推定部４６は、Ｓ３８０では、対応情報を取得する。対応情報は、予めＲＯＭ４３に記憶されていてもよい。対応情報は、予め実験やシミュレーション等に基づいて生成され得る。

対応情報とは、実験等に基づく情報であって、予め定められたある測定高さに設置されたレーダ装置２によって最も大きい頻度で観測された路面の位置と、このときの測定高さとの対応を表す情報である。測定高さには、複数の高さが含まれ得る。また、上述の路面の位置は、少なくとも前後距離で表され得る。前後距離とは、レーダ装置２からの前後方向における距離である。つまり、前後距離は、前後軸Ｘｓに沿う方向における距離である。本実施形態では、上述の路面の位置は前後距離で表される。対応情報の例を図１３に示す。

例えば、実験によって、車量ＶＨに設置されるときと同様の条件で、ある測定高さに設置されたレーダ装置２によって、種々の状態の路面が複数回観測され得る。そして、最も高い頻度で路面として検出された位置（即ち、前後距離）と、このときの測定高さとが記録され得る。複数の測定高さについて観測が行われ、対応情報が生成され得る。

推定部４６は、Ｓ３９０では、対応情報に基づいて、算出位置に対応する測定高さを特定する。具体的には、対応情報に基づいて、算出位置（ｘ_s、ｙ_s）が表す前後距離であるｘ_sに対応する測定高さを特定する。そして、推定部４６は、該測定高さを装置高さとして推定する。推定部４６は、推定した装置高さをメモリ４２に記憶する。

ビーム方向が進行方向軸Ｘｃの方向に一致する本実施形態では、算出位置（ｘ_s、ｙ_s）が表す前後距離ｘ_sは、路面反射点距離Ｒと垂直角度θ_verによって、式（２）に基づいて算出され得る。つまり、頻度抽出処理は、少なくとも路面反射点距離に基づいて装置高さを推定しているといえる。

なお、推定部４６は、本ステップでは、抽出回数Ｋをインクリメントし、新たな抽出回数Ｋとしてメモリ４２に上書きして記憶する。以上で、推定部４６は、抽出頻度処理を終了する。

［２−２−３．作動］
図１４に、抽出頻度処理の結果を示す例であって、それぞれの路面反射点の位置（ｘ_s、ｙ_s）における抽出頻度Ｐ（ｘ_s、ｙ_s）をヒストグラムとして図示した例を示す。図１４の上段に示す例は、算出位置がＸａ［ｍ］と特定された例である。この場合、推定部４６は、図１３に示す対応情報に基づいて、装置高さをＹａ［ｍ］と推定する。また、図１４の下段に示す例は、算出位置がＸｂ［ｍ］と特定された例である（Ｘａ＞Ｘｂ）。この場合、推定部４６は、図１３に示す対応情報に基づいて、装置高さをＹｂ［ｍ］と推定する（Ｙａ＞Ｙｂ）。

［２−３．効果］
以上詳述した第２実施形態によれば、上述した第１実施形態の効果（１ａ）を奏し、さらに、以下の効果を奏する。

（２ａ）信号処理部４は、Ｓ３２０では、予め定められた取得期間において路面反射点が抽出された回数を路面反射点の位置毎に加算した値を表す抽出頻度を生成してもよい。取得期間は、上述の抽出処理を上述の抽出閾値に相当する回数繰り返す期間に相当する。信号処理部４は、Ｓ３８０では、メモリ４２から対応情報取得してもよい。信号処理部４は、Ｓ３９０では、対応情報に従って、抽出頻度が最も大きい路面反射点の位置である算出位置に対応する測定高さを特定し、該測定高さを装置高さとして推定してもよい。

この結果、信号処理部４は、対応情報に基づいて、統計的に、精度よく、装置高さ及び高さずれ量を推定することができる。
（２ｂ）推定部４６は、Ｓ３５では、抽出頻度が最も大きい路面反射点の位置が複数取得された場合、最も前後軸Ｘｓに近い路面反射点の位置を算出位置として特定してもよい。この結果、路面としてより正確に認識される路面反射点に基づいて、装置高さを推定することができる。

［２−４．変形例］
（変形例２ａ）
推定部４６は、Ｓ３７０では、Ｓ３４０にて特定された、複数の抽出頻度Ｐ（ｘs、ｙs）の最も大きい路面反射点について、中央の位置を算出位置として対応情報に基づいて装置高さを特定してもよい。又は、推定部４６は、Ｓ３７０では、Ｓ３４０にて特定された、複数の抽出頻度Ｐ（ｘs、ｙs）の最も大きい路面反射点について、ｘsの平均値を算出位置として対応情報に基づいて装置高さを推定してもよい。これにより、路面反射点の位置のばらつきが平均化され、装置高さを精度よく推定することができる。

（変形例２ｂ）
推定部４６は、抽出頻度処理では、二次元で表される路面反射点の位置に応じた抽出頻度Ｐ（ｘ_s、ｙ_s）ではなく、一次元で表される路面反射点の位置に応じた抽出頻度を算出してもよい。

つまり、抽出頻度は、路面反射点が抽出された回数を路面反射点の位置毎に加算した値であって、路面反射点の位置が装置系座標（ｘ_s、ｙ_s、ｚ_s）のうちの１つの要素（ｘ_s）によって表される位置であってもよい。ここでいう位置は、前後軸Ｘｓに沿う方向における距離であって、前後距離で表されている。以下では、位置（ｘ_s）における路面反射点の抽出頻度を、Ｐ（ｘ_s）のように表す。

具体的には、本変形例では、推定部４６は、上述の抽出頻度処理において、Ｓ３４０では、抽出頻度Ｐ（ｘ_s）の最も大きい路面反射点の位置（ｘ_s）を特定してもよい。なお、抽出頻度Ｐ（ｘ_s）の最も大きい路面反射点が複数検出された場合に移行するＳ３７０では、推定部４６は、これらの複数の路面反射点の位置（ｘ_s）の平均値を算出位置として特定してもよい。

図１５に、抽出頻度処理の結果を示す例であって、それぞれの路面反射点の位置（ｘ_s）における抽出頻度Ｐ（ｘ_s）をヒストグラムとして図示した例を示す。図１５の上段に示す例は、算出位置がＸａ［ｍ］と特定された例である。この場合、推定部４６は、図１３に示す対応情報に基づいて、装置高さをＹａ［ｍ］と推定する。また、図１５の下段に示す例は、算出位置がＸｂ［ｍ］と特定された例である（Ｘａ＞Ｘｂ）。この場合、推定部４６は、図１３に示す対応情報に基づいて、装置高さをＹｂ［ｍ］と推定する（Ｙａ＞Ｙｂ）。

［３．第３実施形態］
［３−１．構成］
第３実施形態は、基本的な構成は第１実施形態と同様であるため、相違点について以下に説明する。なお、第１実施形態と同じ符号は、同一の構成を示すものであって、先行する説明を参照する。

第３実施形態は、信号処理部４が、第１実施形態と同様に式（１）により装置高さを推定すると共に、第２実施形態と同様に対応情報に基づいて装置高さを推定し、これらの推定結果に基づいて最終的な装置高さを推定する点で、第１実施形態と相違する。

以下では、第１実施形態と同様に式（１）に基づいて算術的に推定された装置高さを第１高さという。また、第２実施形態と同様に対応情報に基づいて統計的に推定された装置高さを第２高さという。

［３−２．処理］
次に、第３実施形態の信号処理部４（即ち、推定部４６）が、第１実施形態の調整処理（即ち、図６）に代えて実行する、第３実施形態の調整処理について、図１６のフローチャートを用いて説明する。上述の相違点に伴って、第３実施形態の信号処理部４が実行する調整処理では、図６に示すＳ４０が図１６に示すＳ４４に置換され、図１６にＳ３５、Ｓ３７、Ｓ３９が追加される。なお、図１６におけるＳ１０−Ｓ３０、Ｓ５０−Ｓ９０の処理は、図６におけるＳ１０−Ｓ３０、Ｓ５０−Ｓ９０の処理と同様であり、図１６におけるＳ３５、Ｓ３７の処理は、図１０におけるＳ３５、Ｓ３７の処理と同様であるため、説明を一部簡略化する。

推定部４６は、Ｓ１０−Ｓ２０については、図６におけるＳ１０−Ｓ２０と同様の処理を実行する。
推定部４６は、次にＳ３０では、図６におけるＳ３０と同様の算出処理を実行する。但し、第３実施形態では、Ｓ３０は抽出閾値に相当する回数繰り返し実行される。推定部４６は、Ｓ３０を実行する毎に、算出処理のＳ２３０では、メモリ４２に記憶されている第１高さと、算出された第１高さとの平均値を算出し、該平均値を新たな第１高さとしてメモリ４２に上書きして記憶してもよい。

推定部４６は、続くＳ３５では、図１０のＳ３５と同様の抽出頻度処理を実行し、処理をＳ３７に移行させる。但し、推定部４６は、Ｓ３５では、推定された装置高さを、第２高さとしてメモリ４２に記憶してもよい。

推定部４６は、次にＳ３７では、図１０のＳ３７と同様の処理を実行する。
推定部４６は、続くＳ３９では、Ｓ３０で推定された第１高さと、Ｓ３５にて推定された第２高さとの平均値を算出し、該平均値を、最終的な装置高さとして推定する。推定部４６は、該最終的な装置高さをメモリ４２に記憶してもよい。

推定部４６は、続くＳ４４では、高さずれ量を特定する。第３実施形態では、高さずれ量とは、Ｓ４４にて特定された最終的な装置高さと初期高さとの差をいう。推定部４６は、推定した高さずれ量をメモリ４２に記憶してもよい。

推定部４６は、続くＳ５０−Ｓ９０については、図６のＳ５０−Ｓ９０と同様の処理を実行する。
［３−３．効果］
（３ａ）推定部４６は、Ｓ３９では、Ｓ３０によって算出された装置高さである第１高さと、Ｓ３５によって特定された装置高さである第２高さとに基づいて、最終的な装置高さを推定する。この結果、異なる複数の方法に基づいて装置高さが推定されるので、推定された装置高さの精度をより向上させることができる。

（３ｂ）推定部４６は、報知を行う通知装置５１に、Ｓ４４にて推定された高さずれ量が上述の閾値距離以上であり且つ上述の調整可能範囲外である場合に、上述の高さずれダイアグを出力してもよい。この結果、異なる複数の方法に基づいてロバストに推定された装置高さに基づいて、報知を適切に行うことができる。つまり、不要な報知により乗員に煩わしさを与えること、を軽減することができる。

［３−４．変形例］
（変形例３ａ）
推定部４６は、例えば（変形例２ａ）と同様に、抽出頻度処理におけるＳ３７０では、複数の抽出頻度Ｐ（ｘs、ｙs）の最も大きい路面反射点について、中央の位置を算出位置として対応情報とに基づいて装置高さを推定してもよい。

（変形例３ｂ）
推定部４６は、例えば（変形例２ｂ）と同様に、抽出頻度処理では、位置（ｘ_s）における路面反射点の抽出頻度Ｐ（ｘ_s）と対応情報とに基づいて、装置高さを推定してもよい。

（変形例３ｃ）
推定部４６は、第１高さによる高さずれ量が調整可能範囲内でないこと（以下、第１報知条件）、及び、第２高さによる高さずれ量が調整可能範囲内でないこと（以下、第２報知条件）、の少なくとも一方が満たされる場合に、報知を行ってもよい。

この場合、推定部４６は、例えば図１６に示すＳ６０において、第１報知条件及び第２報知条件のうち少なくとも一方が満たされているか否かを判断してもよい。ここで、推定部４６は、第１報知条件及び第２報知条件のうち少なくとも一方が満たされている場合に、処理をＳ８０へ移行させて、高さずれダイアグを出力してもよい。一方、推定部４６は、第１報知条件が満たされておらず且つ第２報知条件が満たされていない場合に、処理をＳ７０へ移行させて、搭載高さ調整を行ってもよい。

（変形例３ｄ）
推定部４６は、第１報知条件及び第２報知条件の両方が満たされる場合にのみ、報知を行ってもよい。この場合、推定部４６は、例えば図１６に示すＳ６０において、第１報知条件及び第２報知条件の両方が満たされているか否かを判断してもよい。ここで、推定部４６は、第１報知条件及び第２報知条件の両方が満たされている場合に、処理をＳ８０へ移行させて、高さずれダイアグを出力してもよい。一方、推定部４６は、第１報知条件及び第２報知条件のうち少なくとも一方が満たされていない場合に、処理をＳ７０へ移行させて、搭載高さ調整を行ってもよい。

［４．他の実施形態］
以上、本開示の実施形態について説明したが、本開示は上述の実施形態に限定されることなく、種々変形して実施することができる。

（３ａ）上記実施形態では、レーダ装置２は、ビーム方向が、自車ＶＨの進行方向と一致するように設置されていたが、本開示はこれに限定されるものではない。例えば、レーダ装置２は、ビーム方向が垂直方向又は水平方向に予め定められた角度傾くように、設置されていてもよい。なお、ビーム方向の傾きを表す予め定められた角度は、予めメモリ４２に記憶されていてもよい。

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

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

（３ｄ）上述した信号処理部４の他、車両制御システム１、当該信号処理部４を機能させるためのプログラム、このプログラムを記録した半導体メモリ等の非遷移的実態的記録媒体、高さずれ推定方法など、種々の形態で本開示を実現することもできる。

なお、上記実施形態において、自車ＶＨが移動体に相当し、信号処理部４が推定装置に相当し、メモリ４２が記憶装置に相当する。また、Ｓ１０が取得部としての処理に相当し、Ｓ２０が抽出部としての処理に相当し、Ｓ３０が推定部、算出部としての処理に相当し、Ｓ３５が推定部、特定部としての処理に相当し、Ｓ３９が推定部、複合部としての処理に相当し、Ｓ４０、Ｓ４２、Ｓ４４がずれ量特定部としての処理に相当し、Ｓ３８０が対応取得部としての処理に相当する。また、高さずれ量がずれ量に相当する。

２ レーダ装置、４ 信号処理部。

Claims (6)

1. 移動体に搭載された推定装置（４）であって、
   前記移動体に搭載されたレーダ装置により検出された複数の反射点のそれぞれについて、前記反射点についての方位角であってレーダビームの中心軸に沿った方向であるビーム方向を基準として求められた水平角度及び垂直角度と、前記レーダ装置から前記反射点迄の距離と、を少なくとも含む反射点情報を取得するように構成された取得部（Ｓ１０）と、
   少なくとも前記反射点情報に基づいて、前記複数の反射点のうち路面での反射により検出された少なくとも１つの路面反射点を抽出するように構成された抽出部（Ｓ２０）と、
   少なくとも前記レーダ装置から前記路面反射点迄の距離である路面反射点距離に基づいて、前記移動体に搭載された前記レーダ装置の高さである装置高さを推定する推定部（Ｓ３０、Ｓ３５、Ｓ３９）と、
   を備える推定装置。
2. 請求項１に記載の推定装置であって、
   前記推定部は、
   前記装置高さを未知パラメータとして、該未知パラメータと、前記路面反射点距離と、前記垂直角度と、の間に成立する関係式に基づいて、前記未知パラメータである前記装置高さを算出するように構成された算出部（Ｓ３０）
   を備える推定装置。
3. 請求項１に記載の推定装置であって、
   予め定められた複数の高さである測定高さに設置された前記レーダ装置によって最も大きい頻度で観測された路面の位置と前記測定高さとの対応を表す対応情報を記憶する記憶装置から、前記対応情報を取得するように構成された対応取得部（Ｓ３８０）
   を更に備え、
   前記推定部は、
   予め定められた取得期間において前記路面反射点が抽出された回数を前記路面反射点の位置毎に加算した値を表す抽出頻度を取得し、前記抽出頻度が最も大きい前記路面反射点の位置を表す算出位置を特定し、前記対応情報に従って前記算出位置に対応する前記測定高さを前記装置高さとして特定するように構成された特定部（Ｓ３５）
   を備える推定装置。
4. 請求項２に記載の推定装置であって、
   予め定められた複数の高さである測定高さに設置された前記レーダ装置によって最も大きい頻度で観測された路面の位置と前記測定高さとの対応を表す対応情報を記憶する記憶装置から、前記対応情報を取得するように構成された対応取得部（Ｓ３８０）
   を更に備え、
   前記推定部は、
   予め定められた取得期間において前記路面反射点が抽出された回数を前記路面反射点の位置毎に加算した値を表す抽出頻度を取得し、前記抽出頻度が最も大きい前記路面反射点の位置を表す算出位置を特定し、前記対応情報に従って前記算出位置に対応する前記測定高さを前記装置高さとして特定するように構成された特定部（Ｓ３５）と、
   前記算出部によって算出された前記装置高さである第１高さと、前記特定部によって特定された前記装置高さである第２高さと、に基づいて前記装置高さを推定する複合部（Ｓ３９）と、
   を更に備える推定装置。
5. 請求項１から請求項４のいずれか一項に記載の推定装置であって、
   前記レーダ装置に生じた高さ方向におけるずれの大きさを表すずれ量を特定するように構成されたずれ量特定部（Ｓ４０、Ｓ４２、Ｓ４４）、
   を備える推定装置。
6. 請求項５に記載の推定装置であって、
   前記ずれ量特定部は、前記レーダ装置が前記移動体に搭載されたときの予め定められた高さである初期高さを取得し、前記初期高さと前記推定高さとの差を前記ずれ量として特定する
   推定装置。

Images