JP2012008011A - 到来方向標定装置および位置標定装置 - Google Patents

Abstract

【目的】本発明は、複数のアンテナで受信波の到来方向を求める到来方向標定装置と、複数の到来方向に所定の航法を適用することにより受信波が送信された位置を求める位置標定装置とに関し、構成の大幅な複雑化を生じることなく、柔軟に精度よく到来方向を求めることができる到来方向標定装置と、位置標定装置とを提供することを目的とする。
【解決手段】送信源から複数の位置に到来した受信波に基づいて受信波の到来方向を求める到来方向取得手段と、複数の位置と、到来方向と、所定の航法とに基づき受信波の送信源の推定方位を求める方位推定手段と、推定方位に対する到来方向の偏差と規定の範囲とに基づいて、到来方向毎に規定の範囲の内外を判別する判別手段とを備える。
【選択図】図１

Description

本発明は、複数のアンテナで受信波の到来方向を求める到来方向標定装置と、その到来方向標定装置によって求められた複数の到来方向に所定の航法を適用することにより受信波が送信された地点の位置を求める位置標定装置とに関する。

水面下の音を無線伝送するソノブイは、水面上の位置が航空機等の移動体（以下、単に「航空機」という。）に搭載された位置標定装置によって予め特定されなければならない。
従来の位置標定装置では、以下のような前提の下で、ソノブイの位置の標定が実現されていた。

(1) 到来方向標定装置で求められた到来方向は制限なしに、ソノブイ位置を求めるために使用される。
(2) 複数の到来方向からソノブイ位置を求める。

なお、本発明に関連性がある先行技術としては、以下に列記する先行技術がある。
(1) 「航空機のマルチパス誤差を補償したデータを有するマルチパス誤差補償テーブル６と、航法装置２０から出力される航法信号による航法データの誤差を補償したデータを有する航法データ誤差補償テーブル７と、ソノブイからの発信信号が受信変換されたソノブイ信号に関する位相差誤差を補償したデータを有する位相差誤差補償テーブル８と、測角演算器４からの角度信号及び航法信号に基づいて到来角を算出する際、各誤差補償テーブル６，７，８から各誤差補償データを参照して誤差補償した到来角を用いてソノブイの設定位置を算出する誤差補償／位置評定演算器５とを備えることにより、簡易な構成で位相差検出誤差や移動体（航空機）固有の移動状態付随誤差（航法誤差）を抑制できると共に、ソノブイの位置評定を安定的に正確にして迅速に行い得る」点に特徴があるソノブイ位置評定装置…特許文献１

(2) 「受信した信号から基準位置を受信復調部２４で復調し、また電波到来角検出部２３で移動体から見た基準位置送信用ブイの方位を受信した信号から移動体の２つの位置において検出し、２つの位置における基準位置送信用ブイの方位を基に、三角測量の原理を用いて基準位置送信用ブイの位置を評定処理部２６で評定し、位置補正データ作成部２５で基準位置送信用ブイの評定位置と復調した基準位置との誤差を表す位置補正データを作成すると共に、ソノブイからの電波を同様に電波到来角検出部２３及び評定処理部２６で処理しソノブイの位置を評定し、これを位置補正部２７で位置補正データにより補正することにより、ソノブイの位置を短時間で高精度で安価に検出できる」点に特徴があるソノブイ位置検出方式…特許文献２

(3) 「移動体用装置１０４に、送信時刻情報を移動体用拡散符号でスペクトラム拡散した信号を送信する装置２及び３を備え、ソノブイ用装置には、前記信号を受信し、移動体用拡散符号で逆拡散して送信時刻情報を復調した後、送信時刻情報をソノブイ用拡散符号で再びスペクトラム拡散して移動体用装置１０４に送信する機能を備え、移動体用装置１０４には、更に、ソノブイ用装置から送信される信号を受信して、ソノブイ用拡散符号で逆拡散して送信時刻情報を復調し、この送信時刻情報と受信時刻情報との差を演算する装置６、７、及び８を備えることによって、移動体においてソノブイの位置を高精度で検出することができる」点に特徴があるソノブイ位置検出方式…特許文献３

特開平８−１１０３７３号公報 特開平８−１１４６６４号公報 特開平８−１１４６６５号公報

しかし、上述した従来例では、航空機の姿勢によっては、受信波が一部のアンテナを介しては受信されなかった場合、受信波の到来方向を正しく求めることができず、ソノブイ位置も正しく求めることができなかった。

本発明は、構成の大幅な複雑化を生じることなく、柔軟に精度よく受信波の到来方向を求めることができる到来方向標定装置と、位置標定装置とを提供することを目的とする。

請求項１に記載の発明では、到来方向取得手段は、送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向θ_１〜θ_Ｎを求める。方位推定手段は、前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の推定方位Θ_１〜Θ_Ｎを求める。判別手段は、前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する前記到来方向θ_ｉ（ｉ＝１〜Ｎ）の偏差と規定の範囲とに基づいて、前記到来方向θ_ｉ毎に前記規定の範囲の内外を判別する。

すなわち、複数Ｎの位置で受信波を取得し、到来方向θを求める。一方、受信波を取得した複数Ｎの位置と求めた到来方向θとを平均、三角測量、多角測量等の処理をして送信源の推定方位Θを求める。受信波を取得した位置毎で到来方向θと推定方位Θとの偏差を求め、規定の範囲内外の判別をする。
したがって、求められた受信波の到来方向θは、規定の範囲内の到来方向であるか判定することが可能となる。

請求項２に記載の発明では、請求項１に記載の到来方向標定装置において、前記判別手段は、前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記偏差が前記規定の範囲内のときに、前記到来方向θ_ｉを前記送信源の方位とする。

したがって、受信波を取得した位置毎に偏差が規定範囲内のときに、送信源の方位として求めた受信波の到来方向θを選択することが可能となる。

請求項３に記載の発明では、請求項１に記載の到来方向標定装置において、前記判別手段は、前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記偏差が前記規定の範囲外のときに、前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）を前記送信源の方位とする。

すなわち、受信波を取得した位置毎に偏差が規定範囲外のときに、送信源の方位として求めた受信波の到来方向θの替わりに推定方位Θを選択することが可能となる。
したがって、求めた受信波の到来方向θに含まれる誤差に起因して精度が低下することがあっても、推定方位Θを選択することにより、送信源の方位は安定に確度高く求められる。

請求項４に記載の発明では、到来方向取得手段は、送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向θ_１〜θ_Ｎを求める。方位推定手段は、前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の推定方位Θ_１〜Θ_Ｎを求める。重み算出手段は、前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する偏差が大きいほど値が小さく、かつ前記偏差にそれぞれ対応した重みＷ_ｉ（ｉ＝１〜Ｎ）を求める。到来方向算出手段は、前記到来方向θ_ｉ毎に前記重みＷ_ｉとの積和として、前記送信源の方位を求める。

すなわち、送信源の方位は受信波の到来方向θの偏差に対応した重みＷを積和することで求められる。
したがって、求めた受信波の到来方向θに含まれる誤差に起因して精度が低下することがあっても、偏差が大きいほど値が小さい重みＷによって到来方向θを修正することで、送信源の方位は安定に確度高く求められる。

請求項５に記載の発明では、請求項４に記載の到来方向標定装置において、前記重み算出手段は、前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する偏差の評価関数が最小となる値として前記重みＷ_ｉ（ｉ＝１〜Ｎ）を求める。

すなわち、重みは、受信波の到来方向θと推定方位Θとの偏差で求めた評価関数が最小となるとして求められる。
したがって、求めた受信波の到来方向θに含まれる誤差に起因して精度が低下することがあっても、重みＷによって到来方向θを修正することで、送信源の方位は安定に確度高く求められる。

本発明によれば、従来例で生じていた到来方向θに含まれる誤差に起因して精度が低下することによる不安定性は、ハードウェアの構成や処理量が大幅に増加することなく、しかも、精度が低下することなく安定に求められる。

また、送信源の位置は、上記不安定性に制約されることなく、しかも、個々の受信波の到来方向に含まれる誤差に起因して精度が低下することなく、その送信源の位置の変位に柔軟に追従しつつ求められる。
したがって、本発明は、送信源の位置の標定にかかわる制約が大幅に緩和され、その標定の精度が安定に高く維持されると共に、多様な分野への柔軟な応用が可能となる。

本発明の第一および第二の実施形態を示す図である。 本発明の第一および第二の実施形態における到来方向算出部の動作フローチャートである。 本発明の第一および第二の実施形態における到来方向測定原理を示す図である。 本発明の第一実施形態における到来方向判別部の動作フローチャートである。 本発明の第一および第二の実施形態における推定方位算出原理を示す図である。 本発明の第一および第二の実施形態における位置標定算出原理を示す図である。 本発明の第二実施形態における到来方向判別部の動作フローチャートである。

以下、図面に基づいて本発明の実施形態について詳細に説明する。
図１は、本発明の第一および第二の実施形態を示す図である。

図において、位置標定装置１０は、例えば、航空機３０に搭載され、以下の通りに構成される。なお、航空機３０はソノブイ２０−１〜２０−ｋが投下された海面上を飛行し、その航空機３０の機体上には、アンテナ３１−１〜３１−ｎが取り付けられる。

上記アンテナ３１−１〜３１−ｎの給電点は、複数の受信器１１−１〜１１−ｎの入力にそれぞれ接続される。これらの受信器１１−１〜１１−ｎの出力は到来方向算出部１２の対応する入力に接続され、その到来方向算出部１２の出力は到来方向判別部１３の入力に接続される。さらに、その到来方向判別部１３の出力は位置標定部１４の第一の入力に接続される。位置標定部１４の第二の入力には、航空機３０の航法系（図示されない。）によってその航空機３０の位置や姿勢が与えられ、この位置標定部１４の出力には、ソノブイ２０−１〜２０−ｋに関して標定された個々の位置（標定結果）が出力される。

〔第一の実施形態〕
図２は、本発明の第一の実施形態における到来方向算出部の動作フローチャートである。
図３は、本発明の第一の実施形態における到来方向測定原理を示す図である。
図４は、本発明の第一の実施形態における到来方向判別部の動作フローチャートである。
図５は、本発明の第一の実施形態における推定方位算出原理を示す図である。
図６は、本発明の第一の実施形態における位置標定算出原理を示す図である。

以下、図１〜図６を参照して本発明の第一の実施形態の動作を説明する。なお、以下では、ソノブイ２０−１〜２０−ｋの内、位置の標定対象となる特定のソノブイについては、添え番号「１」〜「ｋ」の何れも含まない符号「２０」を付与して表記する。

受信器１１−１〜１１−ｎは、ソノブイ２０からアンテナ３１−１〜３１−ｎに到来した受信波ｒ_１〜ｒ_ｎを取り込み、例えば、所定の中間周波信号またはベースバンド信号として到来方向算出部１２に引き渡す。

到来方向算出部１２は、以下の処理（以下、「到来方向算出処理」という。）を行う。
(1) 既述の航法系から与えられる航空機３０の位置および姿勢と、これらの受信波ｒ_１〜ｒ_ｎが到来したアンテナ３１−１〜３１−ｎの航空機３０上の取り付け位置とに基づいて、既定の座標系（以下、「測位座標系」という。）におけるこれらのアンテナ３１−１〜３１−ｎの絶対的な位置を求める（図２ステップＳ１）。

(2) 受信波ｒ_１〜ｒ_ｎをディジタル信号に変換し（図２ステップＳ２）、これらのディジタル信号に併せて、上記アンテナ３１−１〜３１−ｎの絶対的な位置を記憶する（図２ステップＳ３）。

(3) このようにして記憶された受信波ｒ_１〜ｒ_ｎから、それぞれ異なる２つの受信波の対（以下、「受信波対」という。）を選択する（図２ステップＳ４）。ここでは、受信波対として、例えば、ｒ_１とｒ_２とを選択する。

(4) 受信波対の位相差φを求める（図２ステップＳ５）。なお、このような位相差φは、受信波対の伝搬路長の差(図３)に起因して生じる。

(5) 受信波対の位相差φと、受信波の波長λと、アンテナ３１−１、３１−２の間隔ｄとに対して下式で示される到来方向θを求める（図２ステップＳ６)。
θ＝ｃｏｓ^−１（λ・φ／(２πｄ))

到来方向算出処理はいかなる方法を適用してもよい。受信波対を選択せずに、ＭＵＳＩＣ（Ｍｕｌｔｉｐｌｅ
Ｓｉｇｎａｌ Ｃｌａｓｓｉｆｉｃａｔｉｏｎ）といった高分解能アルゴリズムを用いてもよい。

到来方向判別部１３は、以下の処理（以下、「到来方向判別処理」という。）を行う。
(1) 既述の到来方向算出処理から到来方向θを求める（図４ステップＳ１）。例えば、図５の航空機３０の位置Ｐ(Ｎ)での到来方向θ(Ｎ)を求める。

(2) 到来方向θ(Ｎ)と、測位座標系における到来方向θ(Ｎ)を測位した航空機の位置Ｐ(Ｎ)とを記憶する（図４ステップＳ２）。

(3) 複数の到来方向θ(１)、θ(２)と航空機の位置Ｐ(１)、Ｐ(２)とを記憶していた場合、三角測量でθ(１)とθ(２)との交点位置を求める。航空機の位置Ｐ(Ｎ)と交点位置とから推定方位Θ(Ｎ)を求める（図４ステップＳ３）。ここでは、三角測量を取り上げたが、平均処理や多角測量等、交点位置を求める処理ならいかなる方法を適用してもよい。

(4) 図４ステップＳ１で求めた到来方向θ(Ｎ)と図４ステップＳ３で求めた推定方位Θ(Ｎ)との差を求める（図４ステップＳ４）。

(5) この差（θ(Ｎ)−Θ(Ｎ)）が規定値より小さい場合、送信源の方位として、図４ステップＳ１で求めた到来方向θ(Ｎ)を選択する（図４ステップＳ５−１）。

(6) この差（θ(Ｎ)−Θ(Ｎ)）が規定値より大きい場合、送信源の方位として、図４ステップＳ３で求めた推定方位Θ(Ｎ)を選択する（図４ステップＳ５−２）。

位置標定部１４は、例えば、三角測量で送信源の方位として、選択したθ(Ｎ)とθ(２)との交点位置(図６)を求める。その交点がソノブイ２０の位置と特定する。

位置標定部１４の処理はいかなる方法を適用してもよい。航空機の位置と到来方向とを用いて、カルマンフィルタ（Ｋａｌｍａｎ
Ｆｉｌｔｅｒ）でソノブイ２０の位置を特定してもよい。

従来例で生じていた到来方向θに含まれる誤差に起因して精度が低下することによる不安定性は、ハードウェアの構成や処理量の大幅な増加を伴うことなく容易に排除される。

したがって、本実施形態によれば、従来例に比べて、ソノブイの位置の標定にかかわる制約が大幅に緩和され、その標定の精度が安定に高く維持される。

〔第二の実施形態〕
次に、本発明の第二の実施の形態について説明する。この実施の形態では、位置標定装置の構成、到来方向算出処理、位置標定部１４の処理は第一の実施の形態と同じであるが、到来方向判別処理で重みを算出し、到来方向を補正することを特徴とする。以下に、詳細に説明をする。

図５は、本発明の第二の実施形態における推定方位算出原理を示す図である。
図７は、本発明の第二の実施形態における到来方向判別部の動作フローチャートである。

以下、図１、図５、図７を参照して本発明の第二の実施形態の動作を説明する。
ここでは、第一の実施形態と異なる到来方向判別処理について説明する。

到来方向判別部１３は、以下の到来方向判別処理を行う。
(1) 既述の到来方向算出処理から到来方向θを求める（図７ステップＳ１）。例えば、図５の航空機３０の位置Ｐ(Ｎ)での到来方向θ(Ｎ)を求める。

(2) 到来方向θ(Ｎ)と、測位座標系における到来方向θ(Ｎ)を測位した航空機の位置Ｐ(Ｎ)とを記憶する（図７ステップＳ２）。

(3) 複数の到来方向θ(１)、θ(２)と航空機の位置Ｐ(１)、Ｐ(２)とを記憶していた場合、三角測量でθ(１)とθ(２)との交点位置を求める。航空機の位置Ｐ(Ｎ)と交点位置とから推定方位Θ(Ｎ)を求める（図７ステップＳ３）。ここでは、三角測量を取り上げたが、平均や多角測量等、交点位置を求める処理ならいかなる方法を適用してもよい。

(4) 図７ステップＳ１で求めた到来方向θ(Ｎ)と図７ステップＳ３で求めた推定方位Θ(Ｎ)との差を求める（図７ステップＳ４）。

(5) この差（θ(Ｎ)−Θ(Ｎ)）の符号に応じた重みＫを求める（図７ステップＳ５）。例えば、（θ(Ｎ)−Θ(Ｎ)）が負の場合は、重みＫを−１とする。（θ(Ｎ)−Θ(Ｎ)）が正の場合は、重みＫを＋１とする。

また、重みＫは、評価関数（θ(Ｎ)−Θ(Ｎ)）^２を最小にする値として求めてもよい。さらに、この評価関数は、到来方向θ(Ｎ)と、航空機の位置Ｐ(Ｎ)と交点位置との距離や推定方位Θ(Ｎ)との関係を表現する式ならいかなる関数を適用してもよい。重みＫは、評価関数が最小となるとして求められる。また、重みＫは、評価関数によっては最大、傾き、平均値、規定を超えた回数等いかなる評価を適用してもよい。したがって、到来方向θ(Ｎ)が推定方位Θ(Ｎ)に近づく重みＫを求められる評価関数ならいかなる関数を適用してもよい。

(6) 図７ステップＳ４で求めた差（θ(Ｎ)−Θ(Ｎ)）に重みＫを乗算し、その結果を図７ステップＳ１で求めた到来方向θ(Ｎ)に加算する（図７ステップＳ６）。

すなわち、従来例で生じていた到来方向θに含まれる誤差に起因して精度が低下することによる不安定性は、ハードウェアの構成や処理量の大幅な増加を伴うことなく容易に排除される。

したがって、本実施形態によれば、従来例に比べて、ソノブイの位置の標定にかかわる制約が大幅に緩和され、その標定の精度が安定に高く維持される。

なお、第一および第二の実施形態では、到来方向算出処理および位置標定処理は、ディジタル領域の処理として実現されている。
しかし、これらの処理は、例えば、アンテナ３１−１〜３１−ｎに到来した受信波の何れも、記憶されることなく、既述の処理に等価であるアナログ領域の処理が並行して施されてもよい。

また、第一および第二の実施形態では、本発明は、受信波の到来方向に基づいてそのソノブイ２０の位置を標定する位置標定装置に適用されている。
しかし、本発明は、このようなソノブイ２０の位置の標定に限定されず、多様な無線周波信号の送信源の方位角や位置を標定するためにも適用可能である。

さらに、第一および第二の実施形態では、ソノブイ２０−１〜２０−ｋの何れか１つから複数のアンテナに個別に到来した受信波の到来方向を求め、これらの到来方向に基づいてその１つのソノブイの位置を標定するために、本発明が適用されている。
しかし、本発明は、このような用途に限定されず、例えば、所定の多元接続方式が適用されることによって上記複数のソノブイとの間に異なる無線伝送路が形成されるならば、これらの複数のソノブイの個々の到来方向や位置の標定にも、同様に適用可能である。

さらに、第一および第二の実施形態では、上記到来方向（方位角）および位置については、航空機３０の航法系が与える航法座標系の下で求められる。なお、本発明は、本実施形態のような構成に限定されず、このような到来方向（方位角）が上記航法座標系の下では求められない場合には、航空機３０の異なる位置でそれぞれ求められた到来方向（方位角）は、共通の航法座標系へマッピングされた後に位置の標定に供されてもよい。

また、第一および第二の実施形態では、アンテナ３１−１〜３１−ｎが航空機３０に取り付けられ、これらのアンテナ３１−1〜３１−ｎに到来した受信波の位相差に基づいてソノブイ２０の方位および位置の標定が実現されている。
しかし、本発明はソノブイ２０以外の送信機や送信源の方位・位置の標定にも適用可能であり、かつアンテナ３１−１〜３１−ｎは航空機２０以外の移動体に取り付けられてもよい。

さらに、本発明は、既述の実施形態に限定されず、本発明の範囲において多様な実施形態の構成が可能であり、構成要素の全てまたは一部に如何なる改良が施されてもよい。

以下、本願に開示された発明を整理し、「特許請求の範囲」および「課題を解決するための手段」の欄の記載に準じた様式により列記する。

［請求項１］ 送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向θ₁〜θ_Ｎを求める到来方向取得手段と、
前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の推定方位Θ_１〜Θ_Ｎを求める方位推定手段と、
前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する前記到来方向θ_ｉ（ｉ＝１〜Ｎ）の偏差と規定の範囲とに基づいて、前記到来方向θ_ｉ毎に前記規定の範囲の内外を判別する判別手段と
を備えたことを特徴とする到来方向標定装置。

請求項１に記載の発明では、到来方向取得手段は、送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向θ_１〜θ_Ｎを求める。方位推定手段は、前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の推定方位Θ_１〜Θ_Ｎを求める。判別手段は、前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する前記到来方向θ_ｉ（ｉ＝１〜Ｎ）の偏差と規定の範囲とに基づいて、前記到来方向θ_ｉ毎に前記規定の範囲の内外を判別する。

すなわち、複数Ｎの位置で受信波を取得し、到来方向θを求める。一方、受信波を取得した複数Ｎの位置と求めた到来方向θとを平均、三角測量、多角測量等の処理をして送信源の推定方位Θを求める。受信波を取得した位置毎で到来方向θと推定方位Θとの偏差を求め、規定の範囲内外の判別をする。
したがって、求められた受信波の到来方向θは、規定の範囲内の到来方向であるか判定することが可能となる。

［請求項２］ 請求項１に記載の到来方向標定装置において、
前記判別手段は、
前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記偏差が前記規定の範囲内のときに、前記到来方向θ_ｉを前記送信源の方位とする
ことを特徴とする到来方向標定装置。

請求項２に記載の発明では、請求項１に記載の到来方向標定装置において、前記判別手段は、前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記偏差が前記規定の範囲内のときに、前記到来方向θ_ｉを前記送信源の方位とする。

したがって、受信波を取得した位置毎に偏差が規定範囲内のときに、送信源の方位として求めた受信波の到来方向θを選択することが可能となる。

［請求項３］ 請求項１に記載の到来方向標定装置において、
前記判別手段は、
前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記偏差が前記規定の範囲外のときに、前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）を前記送信源の方位とする
ことを特徴とする到来方向標定装置。

請求項３に記載の発明では、請求項１に記載の到来方向標定装置において、前記判別手段は、前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記偏差が前記規定の範囲外のときに、前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）を前記送信源の方位とする。

すなわち、受信波を取得した位置毎に偏差が規定範囲外のときに、送信源の方位として求めた受信波の到来方向θの替わりに推定方位Θを選択することが可能となる。
したがって、求めた受信波の到来方向θに含まれる誤差に起因して精度が低下することがあっても、推定方位Θを選択することにより、送信源の方位は安定に確度高く求められる。

［請求項４］ 送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向θ_１〜θ_Ｎを求める到来方向取得手段と、
前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の推定方位Θ_１〜Θ_Ｎを求める方位推定手段と、
前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する偏差が大きいほど値が小さく、かつ前記偏差にそれぞれ対応した重みＷ_ｉ（ｉ＝１〜Ｎ）を求める重み算出手段と、
前記到来方向θ_ｉ毎に前記重みＷ_ｉとの積和として、前記送信源の方位を求める到来方向算出手段と
を備えたことを特徴とする到来方向標定装置。

請求項４に記載の発明では、到来方向取得手段は、送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向θ_１〜θ_Ｎを求める。方位推定手段は、前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の推定方位Θ_１〜Θ_Ｎを求める。重み算出手段は、前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する偏差が大きいほど値が小さく、かつ前記偏差にそれぞれ対応した重みＷ_ｉ（ｉ＝１〜Ｎ）を求める。到来方向算出手段は、前記到来方向θ_ｉ毎に前記重みＷ_ｉとの積和として、前記送信源の方位を求める。

すなわち、送信源の方位は受信波の到来方向θの偏差に対応した重みＷを積和することで求められる。
したがって、求めた受信波の到来方向θに含まれる誤差に起因して精度が低下することがあっても、偏差が大きいほど値が小さい重みＷによって到来方向θを修正することで、送信源の方位は安定に確度高く求められる。

［請求項５］ 請求項４に記載の到来方向標定装置において、
前記重み算出手段は、
前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する偏差の評価関数が最小となる値として前記重みＷ_ｉ（ｉ＝１〜Ｎ）を求める
ことを特徴とする到来方向標定装置。

請求項５に記載の発明では、請求項４に記載の到来方向標定装置において、前記重み算出手段は、前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する偏差の評価関数が最小となる値として前記重みＷ_ｉ（ｉ＝１〜Ｎ）を求める。

すなわち、重みは、受信波の到来方向θと推定方位Θとの偏差で求めた評価関数が最小となるとして求められる。
したがって、求めた受信波の到来方向θに含まれる誤差に起因して精度が低下することがあっても、重みＷによって到来方向θを修正することで、送信源の方位は安定に確度高く求められる。

［請求項６］ 送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向を求める到来方向標定装置と、
前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の位置を求める測位手段とを備え、
前記到来方向標定装置は、
請求項１ないし請求項５の何れか１項に記載の到来方向標定装置である
ことを特徴とする位置標定装置。

到来方向標定装置は送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向を求める。測位手段は、前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の位置を求める。前記到来方向標定装置は、請求項１ないし請求項５の何れか１項に記載の到来方向標定装置である。

すなわち、受信波の送信源の位置は、請求項１ないし請求項５の何れか１項に記載の到来方向標定装置によって安定に確度高く求められた到来方向に基づいて求められる。
したがって、受信波の送信源の位置は、精度よく求められる。

１０ 位置標定装置
１１ 受信器
１２ 到来方向算出部
１３ 到来方向判別部
１４ 位置標定部
２０ ソノブイ
３０ 航空機
３１ アンテナ

Claims (5)

1. 送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向θ_１〜θ_Ｎを求める到来方向取得手段と、
   前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の推定方位Θ_１〜Θ_Ｎを求める方位推定手段と、
   前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する前記到来方向θ_ｉ（ｉ＝１〜Ｎ）の偏差と規定の範囲とに基づいて、前記到来方向θ_ｉ毎に前記規定の範囲の内外を判別する判別手段と
   を備えたことを特徴とする到来方向標定装置。
2. 請求項１に記載の到来方向標定装置において、
   前記判別手段は、
   前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記偏差が前記規定の範囲内のときに、前記到来方向θ_ｉを前記送信源の方位とする
   ことを特徴とする到来方向標定装置。
3. 請求項１に記載の到来方向標定装置において、
   前記判別手段は、
   前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記偏差が前記規定の範囲外のときに、前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）を前記送信源の方位とする
   ことを特徴とする到来方向標定装置。
4. 送信源から複数Ｎの位置に到来した受信波に基づいて前記受信波の到来方向θ_１〜θ_Ｎを求める到来方向取得手段と、
   前記複数Ｎの位置と、前記到来方向θ_１〜θ_Ｎと、所定の航法とに基づき前記受信波の送信源の推定方位Θ_１〜Θ_Ｎを求める方位推定手段と、
   前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する偏差が大きいほど値が小さく、かつ前記偏差にそれぞれ対応した重みＷ_ｉ（ｉ＝１〜Ｎ）を求める重み算出手段と、
   前記到来方向θ_ｉ毎に前記重みＷ_ｉとの積和として、前記送信源の方位を求める到来方向算出手段と
   を備えたことを特徴とする到来方向標定装置。
5. 請求項４に記載の到来方向標定装置において、
   前記重み算出手段は、
   前記到来方向θ_ｉ（ｉ＝１〜Ｎ）毎に前記推定方位Θ_ｉ（ｉ＝１〜Ｎ）に対する偏差の評価関数が最小となる値として前記重みＷ_ｉ（ｉ＝１〜Ｎ）を求める
   ことを特徴とする到来方向標定装置。