JP4108424B2

JP4108424B2 - Target position determination method for sensor bias error estimation

Info

Publication number: JP4108424B2
Application number: JP2002276850A
Authority: JP
Inventors: 武網嶋; 正義系; 義夫小菅
Original assignee: Mitsubishi Electric Corp
Current assignee: Mitsubishi Electric Corp
Priority date: 2002-09-24
Filing date: 2002-09-24
Publication date: 2008-06-25
Anticipated expiration: 2022-09-24
Also published as: JP2004117017A

Description

【０００１】
【発明の属する技術分野】
この発明は、複数のセンサ（レーダなど）を用いた目標の検知（捜索および追尾などを含む）に際し、各センサの距離、仰角および方位角のアライメント誤差（設置誤差）による目標検知性能の劣化を回避するために、事前に各センサの設置誤差をバイアス誤差として推定する方法に関し、特に、目標の位置（移動経路）によって推定精度が劣化する問題点に鑑み、目標位置（および目標移動経路）を決定可能にして推定精度を向上させたセンサバイアス誤差推定用の目標位置決定方法に関するものである。
【０００２】
【従来の技術】
一般に、複数のセンサ（レーダなど）を用いて目標の探知（追尾など）を行う場合、各センサに設置誤差が生じると検知性能の劣化につながる可能性があるので、各センサの設置誤差（アライメント誤差）をバイアス誤差としてあらかじめ推定し、各センサの観測データをバイアス誤差に基づいて補正演算する必要がある。なお、各センサの設置誤差は、短時間の間では一定値と見なされるので、補正演算用のバイアス誤差と称されている。
また、このようなバイアス誤差推定アルゴリズムを実行するためには、複数の目標を空中に配置し、これらの目標を観測して得られる観測データを用いて、各センサの設置誤差を推定する必要がある。
たとえば、図５および図６は従来のセンサの設置誤差補正処理およびバイアス誤差推定方法を示す説明図である（たとえば、非特許文献１参照）。
【０００３】
【非特許文献１】
小菅義夫、岡田隆光による、「三次元レーダのデータ融合におけるレーダバイアス誤差推定」、計測自動制御学会論文集、Ｖｏｌ．３５、Ｎｏ．７、第８２３〜８３１頁、Ｆｉｇ．１
【０００４】
図５においては、２つのセンサ（レーダ１、２）の表示画面（観測値）Ｂ１、Ｂ２を重ね合わせて統合し、目標Ｃ１〜Ｃ３（○印、□印、△印参照）の三次元位置を認識する際に、両センサが真の北方向を誤認識して設置された場合の誤認識を補正する方法を示している。
図５において、レーダ１、２（センサ）は、二次元位置検出器（ＰＰＩ：ＰｌａｎＰｏｓｉｔｉｏｎＩｎｄｉｃａｔｏｒ）からなり、それぞれ、複数の目標Ｃ１〜Ｃ３を検知する。
各レーダ１、２の表示例において、破線は、上方向が「北」、右方向が「東」とする正しい直交座標系であり、実線はバイアス誤差の影響を受けた直交座標系である。ここでは、各レーダ１、２は、方位角に対してバイアス誤差を有しており、真北を誤認識した状態で設置されているものとする。
【０００５】
この場合、２つのレーダ１、２からの観測値データＢ１、Ｂ２を重ね合わせて統合すると、実際には各１つの目標Ｃ１〜Ｃ３が、それぞれ複数の目標として誤認識されてしまう。しかし、各レーダ１、２の設置誤差（バイアス誤差）の推定値を用いて、各観測値Ｂ１、Ｂ２を補正して統合すると、補正後のデータのように、単一の目標位置を正確に検知することができる。
したがって、上記のような各目標Ｃ１〜Ｃ３の誤認識を回避するためには、事前に各レーダ１、２の設置誤差を推定しておくことが重要となる。各レーダ１、２の設置誤差を推定するアルゴリズムは、上記文献に記載されており、図６のように表すことができる。
【０００６】
図６において、各レーダ１、２は、同一の複数（たとえば、２個）の目標Ｃ１、Ｃ２（この場合、飛行機）を同期観測して、観測値Ｂ１、Ｂ２を取得する。
続いて、推定アルゴリズム（拡張カルマン）１０は、カルマンフィルタを用いて、各観測値Ｂ１、Ｂ２を照合して両者のずれ量を検出し、各レーダ１、２のバイアス誤差推定値１０ａを演算する。
ただし、バイアス誤差推定値１０ａの推定精度は、各目標Ｃ１、Ｃ２と各レーダ１、２との相対位置によっては、大きく劣化する可能性がある。
【０００７】
すなわち、バイアス誤差推定値１０ａを算出するための推定アルゴリズム１０を実行するためには、複数の目標（たとえば、Ｃ１、Ｃ２）を空間に配置することが必要となるが、目標の配置に関して、以下の２つの問題が生じる。
（１）各目標と各レーダ１、２との相対配置によってはバイアス誤差推定値１０ａが発散するおそれがあるが、通常、相対配置を事前に知ることは困難である。
（２）上記相対配置とバイアス誤差推定値１０ａの推定精度との関係についても、未知である。
【０００８】
上記問題（１）、（２）に鑑みて、バイアス誤差推定値が発散せずに、且つ、推定精度の高い目標配置を事前に決定する方法が要求されている。
そこで、たとえば問題（１）の解決策として、バイアス誤差推定値１０ａの発散可能性が高い目標配置を事前に検出して回避することのできる新規なアルゴリズムが考えられる。
図７は上記新規なアルゴリズムによるバイアス誤差推定処理用の目標位置決定方法を示すフローチャートであり、バイアス誤差推定値の発散が生じる可能性の高い目標配置を事前に回避するための処理ルーチンを示している。
【０００９】
図７において、まず、各目標の配置が可能な三次元領域（可能配置領域）を設定し（ステップＳ１）、三次元ベクトルの集合を算出するために、可能配置領域をグリッド化（マトリクス化）する（ステップＳ２）。
次に、グリッド化された各目標の配置可能領域の集合から、１ベクトルずつ選出して組合せを生成するとともに、これを繰り返し実行して、全ての目標位置の組合せを生成する（ステップＳ３）。
また、全ての目標位置の組合せについて、観測行列およびその最小特異値を算出し（ステップＳ４）、全ての最小特異値の集合から、「０」または「０付近の値」を示す目標位置の組合せを選出し（ステップＳ５）、図７の処理ルーチンを終了する。
【００１０】
以下、図７に示した目標位置決定方法について、数式を参照しながら、さらに具体的に説明する。
図７の処理ルーチンは、全ての目標が任意の静止位置に配置可能であることを前提条件として、各目標の配置位置範囲が与えられた場合に、バイアス誤差推定値の発散可能性が高い配置位置を事前に決定する場合を示している。
まず、ステップＳ１において、Ｌ個の目標ｌ（ｌ＝１、２、…、Ｌ）に対し、各目標ｌを配置することのできる三次元位置の空間Ｑ_ｌ（ｌ＝１、２、…、Ｌ）を設定する。たとえば、三次元空間の各軸（ｘ_１、ｙ_１、ｚ_１）の最小値ｘ_ｌｍｉｎ、ｙ_ｌｍｉｎ、ｚ_ｌｍｉｎおよび最大値ｘ_ｌｍａｘ、ｙ_ｌｍａｘ、ｚ_ｌｍａｘを、それぞれ以下の式（１）のように与える。
【００１１】
【数１】

【００１２】
次に、ステップＳ２において、各目標を配置可能な三次元位置の空間Ｑ_ｌ（ｌ＝１、２、…、Ｌ）をグリッド化し、三次元の位置ベクトルの集合Ｄ_ｌ（ｌ＝１、２、…、Ｌ）を生成する。
たとえば、三次元位置の空間Ｑ_ｌ（ｌ＝１、２、…、Ｌ）に対して、グリッドの間隔Δｘ_ｌ、Δｙ_ｌ、Δｚ_ｌ（ｌ＝１、２、…、Ｌ）を設定し、三次元空間の各軸（ｘ、ｙ、ｚ）を、以下の式（２）のように分割する。
【００１３】
【数２】

【００１４】
そして、上記のように分割された各軸ｘ、ｙ、ｚの一次元の点の集合から１点ずつ選出し、三次元のベクトルを構成するような全ての組合せを生成する。この組合せを、上記の三次元位置ベクトル集合Ｄ_ｌ（ｌ＝１、…、Ｌ）と称する。
次に、ステップＳ３において、三次元位置ベクトル集合Ｄ_ｌ（ｌ＝１、２、…、Ｌ）から、１つずつ三次元ベクトルを選出し、全ての組合せを生成する。すなわち、１つの組合せは、Ｌ個の三次元ベクトルから構成される。ここで、一組の組合せをｅと呼び、また、この組合せの集合をＥ_ａｌｌと呼ぶ。
続いて、ステップＳ４において、組合せ集合Ｅ_ａｌｌの全ての組合せに対し、まず、観測行列Ｈを算出する。このとき、観測行列Ｈの算出式は、各レーダｉ（ｉ＝１、２）から見た目標ｌ（ｌ＝１、…、Ｌ）の真位置を、以下の式（３）のように、
【数３】

と置くと、以下の式（４）〜（７）のように表される。
【００１５】
【数４】

【数５】

【数６】

【数７】

【００１６】
そして、組合せ集合Ｅ_ａｌｌ内の全ての要素に対して、観測行列Ｈの最小特異値
【数８】

を算出する。ここで、算出された最小特異値の集合をΛ_ａｌｌと呼ぶ。
最後に、ステップＳ５において、最小特異値集合Λ_ａｌｌの中で、集合Λ_ａｌｌが「０」の（または、「０」に近い）目標配置が、発散の可能性の高い目標配置であることを示すので、「０」（または、「０に近い」）目標配置を除いた組合せから、目標配置を選択する。これにより、発散の可能性の高い目標配置の組合せを回避することができる。
また、発散の可能性の最も少ない配置を選択するためには、最小特異値が最大値を示す目標位置の組合せを選出する。
すなわち、以下の式（８）を満たすように、組合せｅ_ｍａｘを選出する。
【００１７】
【数９】

【００１８】
この組合せｅ_ｍａｘが、最も発散の可能性の少ない目標配置である。
上記のように、図７の目標位置決定方法は、目標を自由に静止配置できる場合には、バイアス誤差推定値の発散が起こる可能性の高い（または、低い）目標配置を事前に調べることにより、最小特異値が最大になる（すなわち、発散の最も起こりにくい）目標配置パターンを事前に生成し、目標位置を事前に決定することができる。
しかしながら、推定精度については依然として不明であり、発散の生じにくい目標配置が、必ずしも推定精度の優れた目標配置と一致するとは限らないので、仮に、発散しない目標配置を選出したとしても、十分な推定精度が得られるとは限らない。
【００１９】
【発明が解決しようとする課題】
従来のセンサバイアス誤差推定用の目標位置決定方法は以上のように、新規なアルゴリズムを用いて、センサ設置のバイアス誤差推定値が発散するような目標配置を事前に検出し、発散の生じない目標位置を事前に決定するとともに、飛行中の目標に対してリアルタイムで飛行経路を決定しているが、バイアス誤差推定値の推定精度については未知であることから、推定精度の優れた目標配置（または、目標移動経路）を決定することができないという問題点があった。
【００２０】
この発明は上記のような問題点を解決するためになされたもので、バイアス誤差推定値の推定誤差指標値を事前に計算して、推定精度の高い（すなわち、推定誤差が小さい）目標配置を決定することのできるセンサバイアス誤差推定用の目標位置決定方法を得ることを目的とする。
【００２１】
また、この発明は、バイアス誤差推定値の推定誤差指標値をリアルタイムに計算して、推定精度の高い（すなわち、推定誤差が小さい）目標配置を決定することにより、飛行中の目標に対しても推定精度の高い移動経路をリアルタイムに決定することのできるセンサバイアス誤差推定用の目標位置決定方法を得ることを目的とする。
【００２２】
【課題を解決するための手段】
この発明に係るセンサバイアス誤差推定用の目標位置決定方法は、三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、複数の目標が配置され得る三次元領域を可能配置領域として指定する配置領域設定ステップと、可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、可能配置領域集合から目標毎に、三次元位置ベクトルのうちの１ベクトルずつ選出して組合せを生成するとともに、組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、推定誤差指標値が最小値を示す目標位置の組合せを、各目標の最適な配置位置の組合せとして決定する目標位置選出ステップとを備え、各目標が配置される前に各目標の配置位置を決定するものである。
【００２３】
また、この発明に係るセンサバイアス誤差推定用の目標位置決定方法は、三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、各目標の現時刻における運動諸元を取り込む運動諸元入力ステップと、運動諸元に基づいて各目標が次の時刻に到達可能な位置領域を可能配置領域として算出する可能配置領域算出ステップと、可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、可能配置領域集合から目標毎に、三次元位置ベクトルのうちの１ベクトルずつ選出して組合せを生成するとともに、組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、推定誤差指標値が最小値を示す目標位置の組合せを、各目標の最適な配置位置の組合せとして決定する目標位置選出ステップと、処理終了条件を満たすか否かを判定する終了判定ステップと、処理終了条件が満たされない場合に、現時刻から次の時刻に更新するとともに、決定された目標位置に目標を移動飛行させる時刻更新および目標移動ステップとを備え、各目標の移動経路を現時刻毎にリアルタイムに決定するものである。
【００２４】
【発明の実施の形態】
実施の形態１．
以下、図面を参照しながら、この発明の実施の形態１について詳細に説明する。
図１はこの発明の実施の形態１による処理手順を示すフローチャートであり、センサ設置誤差推定における目標位置決定方法の処理ルーチンを示している。
図１において、ステップＳ１〜Ｓ３は、前述（図７参照）と同様の処理を示している。
【００２５】
まず、前述と同様に、各目標の可能配置領域（三次元位置の空間Ｑ_ｌ）の設定（ステップＳ１）、可能配置領域のグリッド化（ステップＳ２）および目標位置の組合せ（ステップＳ３）を実行する。
続いて、各バイアス誤差推定値に対する推定誤差指標値を算出し（ステップＳ１１）、各バイアス誤差推定値に対する推定誤差指標値を重み付け統合し（ステップＳ１２）、各推定値に対する推定誤差指標値に対して、最適な推定精度を得るような目標位置の組合せを選出し（ステップＳ１３）、図１の処理ルーチンを終了する。
【００２６】
以下、図１に示したこの発明の実施の形態１について、数式を参照しながら、さらに具体的に説明する。
図１に示した目標位置決定方法の場合、全ての目標を自由に静止位置に配置することができ、目標の配置位置範囲が与えられた場合に、事前に静止配置位置を決定することができる。
【００２７】
まず、前述と同様に、ステップＳ１〜Ｓ３において、各目標（Ｌ個）の配置可能な三次元位置の空間Ｑ_ｌ（ｌ＝１、２、…、Ｌ）をグリッド化し、これらの三次元位置ベクトル集合Ｄ_ｌ（ｌ＝１、…、Ｌ）の組合せ集合Ｅ_ａｌｌを得る。
【００２８】
次に、ステップＳ１１において、推定誤差指標値を算出する。すなわち、まず、組合せ集合Ｅ_ａｌｌ内の全ての要素に対して観測行列Ｈおよび行列Ｒを評価し、Ｍ＝（Ｈ^ＴＲ^‐１Ｈ）^‐１を計算するとともに、この行列Ｍの対角要素を算出する。このとき、観測行列Ｈは、前述の式（３）〜（７）により算出され、行列Ｒは、式（３）〜（７）に定義された変数を用いて、以下の式（９）〜（１２）により算出される。
【００２９】
【数１０】

【数１１】

【数１２】

【００３０】
上記式（９）〜（１２）において、σ_ｉｌＲ、σ_ｉｌＥ、σ_ｉｌＡｚは、２つのセンサｉ（ｉ＝１、２）を用いてＬ個の目標ｌ（ｌ＝１、…、Ｌ）を観測する際の、それぞれ、距離、仰角、方位角の観測誤差の分散値である。
式（９）〜（１２）を用いて、組合せ集合Ｅ_ａｌｌ内の全ての要素に対して行列Ｍを評価し、この行列Ｍの対角要素の平方根（σ_１、σ_２、…、σ_５、σ_６）を推定誤差指標値とする。
この推定誤差指標値の集合をΣ_ａｌｌと称する。すなわち、１つの目標配置の組合せ
【数１３】

から、６つの推定誤差指標値（σ_１、σ_２、…、σ_５、σ_６）が算出され、これを全ての組合せｅについて算出し、推定誤差指標値の集合Σ_ａｌｌを作成する。
なお、行列Ｍの対角要素を用いる代わりに、行列Ｍの種々のノルムを指標値として用いることもできる。
【００３１】
ここで、もし、各センサの観測雑音の分散値が変動する可能性がある場合は、たとえば、各観測諸元の分散値の変動範囲（上限および下限）を設定し、この範囲をある数で段階的に区切り、段階毎の分散値の組合せを用いて推定誤差指標値を算出し、その算出結果を平均した値の集合を推定誤差指標値の集合Σ_ａｌｌとすることもできる。
たとえば、レーダが２台の場合、１つの行列Ｍから、各センサ１、２の距離、仰角、方位角に対し、上記６個（レーダ数が３であれば、９個）の推定誤差指標値が得られる。ここでは、便宜的に、推定誤差指標値が最小値を示す目標位置を最適な配置位置とする場合について説明しているが、実際には、これらの指標値を用いる場合、６つの変数のどれに重きをおくかなどを考慮しながら、「最適」な配置が決定されることになる。
たとえば、６つの推定誤差指標値の中から、たとえばレーダ１の距離について推定誤差指標値が最小な配置を選出しても、他の５つの変数の推定精度が優れているか否か（すなわち、誤差指標値が小さいか否か）は別の問題となる。すなわち、他の５つの推定誤差指標値を確認しながら最終的に配置を決定するので、必ずしも、レーダ１の距離の誤差指標値が最小な配置が選択されるとは限らず、６つの誤差指標値のトレードオフを行いながら、最適な目標配置が決定される。
たとえば、６つの推定誤差指標値のトレードオフを行う方法としては、６つの誤差指標値を重み付け統合する方法があり、この方法によれば、設計者は、６つの図を見ながら配置を行う必要がなく、統合後の１つの図で配置を決定することが可能となり、設計の効率化につながる。
【００３２】
図１内のステップＳ１１に続いて、ステップＳ１２のように、各変数の推定誤差指標値を重み付け統合し、重み付け統合された値が最適（たとえば、最小）な目標配置の組合せを決定する。
この場合、重み付け統合後の推定誤差指標値は、たとえば、以下の式（１３）、（１４）のように算出される。
【００３３】
【数１４】

【００３４】
以下、重み付け統合後の推定誤差指標値の集合Σ_{ａｌｌ＿ｗｅｉｇｈｔｅｄ}を形成し、この集合の中から、以下の式（１５）を満たすような組合せｅ_ｏｐｔ（最適な目標配置）を選出する。
【００３５】
【数１５】

【００３６】
最後に、ステップＳ１３において、推定誤差指標値の集合Σ_ａｌｌの中で、推定誤差指標値が最小値を示す目標位置の組合せを選出する。このとき、各変数毎に推定誤差指標値が存在するので、目的に応じてその重要度をユーザが決定し、最適な目標配置ｅ_ｏｐｔを決定する。
【００３７】
このように、目標を自由に静止配置できる場合には、事前に推定誤差指標値が最適（たとえば、最小）になる目標配置を高精度に選出することができる。
なお、重み付け統合処理ステップＳ１２は、各目標の配置の組合せに対して複数の推定誤差指標値が得られる場合に、設計の効率化を目的として実行されるが、各目標の配置の組合せに対する推定誤差指標値が単一の場合、または、設計の効率化が要求されない場合には省略してもよい。
【００３８】
すなわち、バイアス誤差推定アルゴリズムに必要な目標位置決定方法として、各目標の配置可能領域を設定するステップＳ１と、各目標の配置可能な三次元領域をグリッド化して三次元位置ベクトル集合Ｄ_ｌを算出するステップＳ２と、グリッド化された配置領域集合から組合せを生成するステップＳ３と、全ての組合せについて推定誤差指標値を算出するステップＳ１１と、推定誤差指標値を用いて最適な各目標配置の組合せを決定するステップＳ１３とを設けることにより、ステップＳ１２を実行しなくても、複数の目標配置を事前に決定することができる。
ステップＳ１２を実行しない場合には、ステップＳ１３において、推定誤差指標値の集合Σａｌｌを用いて、最適な目標配置が選出される。
【００３９】
一方、推定誤差指標値の集合Σａｌｌを用いて最適な目標配置の組合せを選択することが難しい場合には、最適な各目標配置の組合せを容易に決定するために、上記各ステップに加えて、各推定誤差指標値を統合するステップとして重み付け統合ステップＳ１２を実行し、複数の目標の配置を事前に決定する。
重み付け統合ステップ１２を実行する場合には、ステップＳ１３において、推定誤差指標値の集合Σａｌｌからではなく、重み付け統合後の推定誤差指標値の集合Σａｌｌ＿ｗｅｉｇｈｔの中から、最適な目標位置の組み合わせが求められる。
同様に、推定誤差指標値と最小特異値や地理的情報とを統合する場合（後述する）においても、統合後の値を用いて、最適な目標配置位置が決定される。
【００４０】
また、センサの各観測諸元の観測精度が可変である場合には、推定誤差指標値の算出ステップＳ１１において各観測諸元の観測精度の上限および下限を与え、その間を段階的に区切って段階毎の分散値の組合せを用いて推定誤差指標値を算出し、その平均値の集合を推定誤差指標値の集合Σ_ａｌｌとして、複数の目標配置を事前に決定する。
さらに、推定誤差指標値として、行列Ｍ（＝（Ｈ^ＴＲ^‐１Ｈ）^‐１）の対角要素の平方根（σ_１、・・・、σ_６）を用いたが、他の指標値を用いることもできる。
また、レーダの台数や目標位置決定対象となる目標数は、２個に限らず、必要に応じて任意数だけ設定可能なことは言うまでもない。
【００４１】
実施の形態２．
なお、上記実施の形態１では、推定誤差が最小となる目標位置決定方法を示したが、推定誤差が最小の優れた目標配置であっても、その目標配置がたまたま推定値の発散する配置に近い場合には、推定値が発散したり、推定誤差が劣化してしまう可能性がある。
したがって、このような推定値の発散を回避するために、推定誤差指標値マップと最小特異値マップとを併用することにより、発散を防ぎつつ、推定精度の優れた目標配置を決定してもよい。
【００４２】
また、目標が飛行物体（飛行機、ヘリコプタ、気球など）の場合には、地理的制約などによって飛行禁止領域となる場合や、目標どうしの衝突危険領域となる場合、または、その他の条件で目標配置に制約がある場合に、これらの地理的情報を反映させることが望ましい。
そこで、上記地理的情報を推定誤差指標値と統合することにより、さらに安全な位置に目標を配置してもよい。
以下、上記条件に鑑みて、最小特異値マップおよび地理的情報を併用したこの発明の実施の形態２について説明する。
【００４３】
図２はこの発明の実施の形態２による処理手順を示すフローチャートであり、ステップＳ１〜Ｓ３およびＳ１１〜Ｓ１３は、前述（図１参照）と同様の処理を示している。
この場合、前述の重み付け統合処理（ステップＳ１２）に続いて、最小特異値との統合処理（ステップＳ１４）と、地理的情報との統合処理（ステップＳ１５）とが実行される。
【００４４】
まず、前述と同様に、ステップＳ１〜Ｓ３、Ｓ１１において、推定誤差指標値を算出し、必要に応じて、ステップＳ１２において重み付け統合推定誤差指標値を算出する。
【００４５】
次に、ステップＳ１４において、最小特異値集合Λ_ａｌｌとの統合を行う。
ステップＳ１４における統合処理としては、たとえば第１の方法として、最小特異値が或る値以下の（発散の起こり易い）目標配置の場合を、推定誤差指標値の集合Σ_ａｌｌから取り除いてしまう方法が考えられる。または、第２の方法として、最小特異値と推定誤差指標値との重み付け統合を行うことが考えられる。これらの統合方法により、最小特異値が小さい（発散の起こり易い）目標配置が、後述の目標配置選択処理（ステップ１３）で選出されないようにする。
【００４６】
次に、ステップＳ１５において、地理的情報との統合を行う。
ステップＳ１５における統合処理としては、たとえば第１の方法として、地理的情報により目標配置不可の領域を、推定誤差指標値の集合Σ_ａｌｌから取り除いてしまう方法が考えられる。または、第２の方法として、地理的情報と推定誤差指標値との重み付け統合を行うことが考えられる。これらの方法により、たとえば、地理的制約の所定レベルよりも大きい目標配置が、以下の目標配置選択処理（ステップ１３）で選出されないようにする。
すなわち、地理的情報に基づく制約が統合され、たとえば地理的制約が大きい目標配置位置を除いた組合せの中から、最適な配置位置の組合せが決定されることになる。
【００４７】
最後に、ステップＳ１３において、上記ステップＳ１４およびＳ１５による統合処理後の推定誤差指標値が最適となるような目標配置を選出する。
このように、事前に推定誤差が最適となるような目標配置を選出するときに、推定精度の優れた配置が発散可能性の高い配置の近傍に位置する可能性がある場合でも、最小特異値および推定誤差指標値を統合する（ステップＳ１４）ことにより、発散する配置を除外した上で最適な目標配置を選出する（ステップＳ１３）ことができる。
また、地理的条件（または、運用条件）の情報を統合して（ステップＳ１５）、地理的条件（または、運用条件）などによる目標の配置が望ましくない位置を除外することにより、上記制約を考慮した目標配置の決定が可能となる。
【００４８】
すなわち、最適な目標配置を決定する際に、地理的情報（地理的制約による飛行禁止領域、目標どうしの衝突危険領域、その他の目標配置の制約など）がある場合には、これらの地理的情報を反映するために、ステップＳ１５において地理的情報と推定誤差指標値とを統合することにより、安全な位置に複数の目標配置を事前に決定することができる。
【００４９】
なお、最小特異値および地理的情報の統合処理を併用したが、いずれか一方のみの統合処理を実行してもよい。
たとえば、最適な目標配置を決定する際に、推定精度が優れている目標配置であっても、その配置が、たまたま推定値の発散する配置に近い場合には、推定値が発散（または、推定誤差が劣化）してしまう可能性があるため、最小特異値との統合ステップ１４を実行して、最小特異値マップと推定誤差指標値マップとを併用することにより、発散を防ぎつつ、推定精度の優れた複数の目標配置を事前に決定することができる。
【００５０】
実施の形態３．
なお、上記実施の形態２、３では、最適な目標の配置を事前に決定したが、既に目標が飛行している場合には、その飛行経路に基づく目標位置をリアルタイムに決定してもよい。
以下、目標位置をリアルタイムに決定したこの発明の実施の形態３について説明する。
図３はこの発明の実施の形態３による処理動作を示す説明図であり、図４はこの発明の実施の形態３による処理手順を示すフローチャートである。
【００５１】
図３においては、２つのレーダ１、２で２つの目標Ｃ１、Ｃ２を検知する場合を示しており、目標Ｃ１、Ｃ２の位置する領域は、各時刻ｔ_ｋ、ｔ_ｋ＋１、ｔ_ｋ＋２において刻々と移動する。
図３において、各目標Ｃ１、Ｃ２は、直接に、または、各レーダ１、２を介して、相互に情報交換を行い、推定誤差指標値を用いて逐次的に飛行航路を決定する。
また、目標Ｃ１、Ｃ２毎に、各時刻ｔ_ｋ、ｔ_ｋ＋１、ｔ_ｋ＋２における到達可能領域の推定誤差指標値マップを形成し、各時刻における推定誤差指標値が最適となる各目標Ｃ１、Ｃ２の位置が選択されて決定される。
【００５２】
図４において、ステップＳ１１〜Ｓ１５は、前述（図２参照）と同様の処理であり、ステップＳ２２およびＳ２３は、それぞれ、各ステップＳ２およびＳ３に対応している。
この場合、前述のステップＳ１に代えて、各目標の現時刻における運動諸元の入力処理（ステップＳ１６）と、各目標が次時刻に到達可能な位置領域（可能配置領域）の算出処理（ステップＳ１７）とが実行される。
また、目標位置選出ステップＳ１３に続いて、図４の処理終了条件を満たすか否かの判定処理（ステップＳ１８）が実行され、終了条件を満たさない場合には、現時刻ｔ_ｋから次の時刻ｔ_ｋ＋１への更新処理ならびに決定された目標位置への目標の移動飛行処理（ステップＳ１９）が実行された後に、運動諸元入力ステップＳ１６に戻る。
【００５３】
まず、ステップＳ１６において、各目標の現時刻ｔ_ｋにおける位置、速度および加速度などの運動諸元を取得する。
続いて、ステップＳ１７において、各目標の運動能力を考慮して、各目標が次の時刻ｔ_ｋ＋１に到達でき得る位置領域（可能配置領域）を算出する。
たとえば、運動能力情報として、各目標の各軸（ｘｙｚ）方向に対する最小加速度ａｘ_ｌｍｉｎ、ａｙ_ｌｍｉｎ、ａｚ_ｌｍｉｎおよび最大加速度ａｘ_ｌｍａｘ、ａｙ_ｌｍａｘ、ａｚ_ｌｍａｘが与えられたとすると、これらを各軸についてグリッド間隔Δａｘ_ｌ、Δａｙ_ｌ、Δａｚ_ｌ、（ｌ＝１、…、Ｌ）を設定し、以下の式（１６）のように分割する。
【００５４】
【数１６】

【００５５】
また、分割された各軸の点の集合から１点ずつ選出することにより、全ての組合せを作成し、三次元加速度ベクトルの集合を生成する。この三次元加速度ベクトルの集合をＡＧ_ｌ（ｌ＝１、…、Ｌ）と称する。
以下、三次元加速度ベクトル集合ＡＧ_ｌ内の各加速度ベクトルａ_ｌを用いて、目標ｌの次の時刻ｔ_ｋ＋１にとり得る位置の集合を算出することができる。
たとえば、目標ｌが次の時刻ｔ_ｋ＋１にとり得る位置は、三次元加速度ベクトル集合ＡＧ_ｌの各加速度ベクトルａ_ｌに対する運動方程式を用いて、以下の式（１７）のように表される。
【００５６】
【数１７】

【００５７】
ただし、式（１７）において、ｄ_{ｌ，ｋ＋１}、ｄ_ｌ，ｋは、それぞれ、時刻ｔ_ｋ＋１およびｔ_ｋにおける目標ｌの位置ベクトルであり、ｖ_ｌ，ｋは、時刻ｔ_ｋにおける目標ｌの速度ベクトルである。
式（１７）により求められる運動諸元（目標位置）を、全ての三次元加速度ベクトル集合ＡＧ_ｌ内の要素について算出し、次の時刻ｔ_ｋ＋１にとり得る三次元位置ベクトルの集合Ｄ_ｌ（ｌ＝１、…、Ｌ）を算出する。ここで、三次元位置ベクトル集合Ｄ_ｌ（ｌ＝１、…、Ｌ）は、「三次元位置の空間」とも称される。
【００５８】
次に、前述と同様に、ステップＳ２２およびＳ２３において、三次元位置ベクトル集合Ｄ_ｌ（ｌ＝１、…、Ｌ）を用いて、位置ベクトルの組合せ集合Ｅ_ａｌｌを定義するとともに、ステップＳ１１、Ｓ１２、Ｓ１４、Ｓ１５およびＳ１３において、統合された推定誤差指標値が最小となるような各目標の位置を選出する。
【００５９】
最後に、ステップＳ１８において、図４の処理ルーチンの終了条件を満たすか否かを、たとえば、与えられた時刻Ｔｅｎｄと元の時刻ｔ_ｋとを比較して、ｔ_ｋ＞Ｔｅｎｄ（時刻ｔ_ｋが時刻Ｔｅｎｄを経過）の関係を満たすか否かにより、判定する。
ステップＳ１８において、ｔ_ｋ＞Ｔｅｎｄ（すなわち、ｙｅｓ）と判定されれば、図４の処理ルーチンを終了し、ｔ_ｋ≦Ｔｅｎｄ（すなわち、ｎｏ）と判定されれば、ステップＳ１９において、時刻が更新されるとともに、得られた位置への目標の移動が行われ、再びステップＳ１６に戻り、同様の処理を繰り返す。
【００６０】
なお、上記方法は、たとえば、多数の目標のうちの数個のみの移動経路を決定する場合も有効である。また、上記方法によれば、目標の移動経路を各時刻ｔ_ｋの運動諸元に基づいて決定し、次の時刻ｔ_ｋ＋１での目標の飛行経路を決定することができるうえ、各目標の位置や速度などの初期運動諸元のみを与えることにより、飛行計画を立てることができる。
このように、目標が自由に移動できる場合、推定誤差指標値が最適（たとえば、最小）となるような移動経路をリアルタイムに生成することができる。
【００６１】
すなわち、上記各ステップＳ２２、Ｓ２３、Ｓ１１〜Ｓ１５に加え、各目標の現時刻における運動諸元の入力ステップＳ１６と、各目標が次時刻に到達可能な位置領域の算出ステップＳ１７と、処理を終了するか否かを判定するステップＳ１８と、時刻の更新および目標位置への目標移動飛行ステップＳ１９とを設けることにより、複数の目標移動経路（飛行経路）をリアルタイムに決定することができる。
なお、上記実施の形態３においても、重み付け統合ステップＳ１２、最小特異値統合ステップＳ１４、または、地理的情報統合ステップＳ１５は、それぞれ、必要に応じて実行されるが、省略することもできる。
【００６２】
【発明の効果】
以上のように、この発明によれば、三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、複数の目標が配置され得る三次元領域を可能配置領域として指定する配置領域設定ステップと、可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、可能配置領域集合から目標毎に、三次元位置ベクトルのうちの１ベクトルずつ選出して組合せを生成するとともに、組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、推定誤差指標値が最小値を示す目標位置の組合せを、各目標の最適な配置位置の組合せとして決定する目標位置選出ステップとを備え、各目標が配置される前に各目標の配置位置を決定するようにしたので、推定精度の高い目標配置を事前に決定することのできるセンサバイアス誤差推定用の目標位置決定方法が得られる効果がある。
【００６３】
また、この発明によれば、三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、各目標の現時刻における運動諸元を取り込む運動諸元入力ステップと、運動諸元に基づいて各目標が次の時刻に到達可能な位置領域を可能配置領域として算出する可能配置領域算出ステップと、可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、可能配置領域集合から目標毎に、三次元位置ベクトルのうちの１ベクトルずつ選出して組合せを生成するとともに、組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、推定誤差指標値が最小値を示す目標位置の組合せを、各目標の最適な配置位置の組合せとして決定する目標位置選出ステップと、処理終了条件を満たすか否かを判定する終了判定ステップと、処理終了条件が満たされない場合に、現時刻から次の時刻に更新するとともに、決定された目標位置に目標を移動飛行させる時刻更新および目標移動ステップとを備え、各目標の移動経路を現時刻毎にリアルタイムに決定するようにしたので、推定精度の高い目標配置を決定して、飛行中の目標に対しても推定精度が高くなる移動経路をリアルタイムに決定することのできるセンサバイアス誤差推定用の目標位置決定方法が得られる効果がある。
【図面の簡単な説明】
【図１】この発明の実施の形態１を示すフローチャートである。
【図２】この発明の実施の形態２を示すフローチャートである。
【図３】この発明の実施の形態３における時刻毎の目標位置を示す説明図である。
【図４】この発明の実施の形態３を示すフローチャートである。
【図５】従来のセンサバイアス誤差推定用の目標位置決定方法に基づくセンサ設置誤差補正処理を示す説明図である。
【図６】従来のセンサバイアス誤差推定アルゴリズムを示す説明図である。
【図７】従来のセンサバイアス誤差推定用の目標位置決定方法を示すフローチャートである。
【符号の説明】
１、２レーダ（センサ）、Ｃ１、Ｃ２目標、Ｓ１配置領域設定ステップ、Ｓ２、Ｓ２２配置領域グリッド化ステップ、Ｓ３、Ｓ２３目標位置組合せステップ、Ｓ１１誤差指標値算出ステップ、Ｓ１２重み付け統合ステップ、Ｓ１３目標位置選出ステップ、Ｓ１４最小特異値統合ステップ、Ｓ１５地理的情報統合ステップ、Ｓ１６運動諸元入力ステップと、Ｓ１７可能配置領域算出ステップ、Ｓ１８終了判定ステップ、Ｓ１９時刻更新および目標移動ステップ。[0001]
BACKGROUND OF THE INVENTION
When detecting a target (including searching and tracking) using a plurality of sensors (such as radar), the present invention reduces target detection performance due to alignment errors (installation errors) of the distance, elevation angle, and azimuth angle of each sensor. In order to avoid this problem, a method for estimating the installation error of each sensor as a bias error in advance is described. In particular, in view of the problem that the estimation accuracy deteriorates depending on the target position (movement path), the target position (and target movement path) is determined. The present invention relates to a target position determination method for estimating a sensor bias error that can be determined to improve estimation accuracy.
[0002]
[Prior art]
In general, when a target is detected (tracking, etc.) using multiple sensors (such as radar), if an installation error occurs in each sensor, it may lead to deterioration in detection performance. Error) is estimated in advance as a bias error, and the observation data of each sensor needs to be corrected based on the bias error. Since the installation error of each sensor is regarded as a constant value for a short time, it is called a bias error for correction calculation.
In addition, in order to execute such a bias error estimation algorithm, it is necessary to place a plurality of targets in the air and estimate the installation error of each sensor using observation data obtained by observing these targets. is there.
For example, FIGS. 5 and 6 are explanatory diagrams showing a conventional sensor installation error correction process and a bias error estimation method (see, for example, Non-Patent Document 1).
[0003]
[Non-Patent Document 1]
Yoshio Obata and Takamitsu Okada, "Radar bias error estimation in 3D radar data fusion", Transactions of the Society of Instrument and Control Engineers, Vol. 35, no. 7, pp. 823-831, FIG. 1
[0004]
In FIG. 5, the display screens (observed values) B1 and B2 of the two sensors (radars 1 and 2) are overlapped and integrated, and the three-dimensional positions of the targets C1 to C3 (see the ○, □, and Δ marks). This shows a method of correcting misrecognition when both sensors are installed by misrecognizing the true north direction.
In FIG. 5, radars 1 and 2 (sensors) are made up of two-dimensional position detectors (PPIs) and detect a plurality of targets C1 to C3, respectively.
In the display examples of the

radars

1 and 2, the broken line is a correct orthogonal coordinate system in which the upper direction is “north” and the right direction is “east”, and the solid line is an orthogonal coordinate system that is affected by a bias error. Here, it is assumed that each of the

radars

1 and 2 has a bias error with respect to the azimuth and is installed in a state where true north is erroneously recognized.
[0005]
In this case, when the observation value data B1 and B2 from the two

radars

1 and 2 are overlapped and integrated, each target C1 to C3 is actually erroneously recognized as a plurality of targets. However, if the observed values B1 and B2 are corrected and integrated using the estimated values of the installation errors (bias errors) of the

radars

1 and 2, a single target position can be accurately obtained as in the corrected data. Can be detected.
Therefore, in order to avoid the erroneous recognition of the targets C1 to C3 as described above, it is important to estimate the installation errors of the

radars

1 and 2 in advance. An algorithm for estimating the installation error of each of the

radars

1 and 2 is described in the above document and can be expressed as shown in FIG.
[0006]
In FIG. 6, each of the

radars

1 and 2 acquires the observed values B1 and B2 by synchronously observing the same plural (for example, two) targets C1 and C2 (in this case, airplanes).
Subsequently, the estimation algorithm (extended Kalman) 10 uses the Kalman filter to collate the observed values B1 and B2 to detect a deviation amount between them, and calculates a bias error estimated value 10a of each

radar

1 and 2.
However, the estimation accuracy of the bias error estimated value 10a may be greatly deteriorated depending on the relative positions of the targets C1 and C2 and the

radars

1 and 2.
[0007]
That is, in order to execute the estimation algorithm 10 for calculating the bias error estimated value 10a, it is necessary to arrange a plurality of targets (for example, C1 and C2) in space. Two problems arise.
(1) The bias error estimated value 10a may diverge depending on the relative arrangement of each target and each of the

radars

1 and 2, but it is usually difficult to know the relative arrangement in advance.
(2) The relationship between the relative arrangement and the estimation accuracy of the bias error estimated value 10a is also unknown.
[0008]
In view of the above problems (1) and (2), there is a demand for a method for determining in advance a target arrangement with high estimation accuracy without causing the bias error estimation value to diverge.
Therefore, for example, as a solution to the problem (1), a new algorithm that can detect and avoid a target arrangement with a high possibility of divergence of the bias error estimated value 10a in advance can be considered.
FIG. 7 is a flowchart showing a target position determination method for bias error estimation processing using the above-described novel algorithm, and shows a processing routine for avoiding in advance target placement that is likely to cause bias error estimation divergence. Yes.
[0009]
In FIG. 7, first, a three-dimensional area (possible arrangement area) in which each target can be arranged is set (step S1), and the possible arrangement areas are gridded (matrixed) in order to calculate a set of three-dimensional vectors. (Step S2).
Next, combinations are generated by selecting vectors one by one from the set of gridable areas where targets can be arranged, and this is repeatedly executed to generate all combinations of target positions (step S3).
In addition, for all combinations of target positions, an observation matrix and its minimum singular value are calculated (step S4), and a combination of target positions indicating “0” or “a value near 0” from the set of all minimum singular values. Is selected (step S5), and the processing routine of FIG. 7 is terminated.
[0010]
Hereinafter, the target position determination method shown in FIG. 7 will be described more specifically with reference to mathematical expressions.
The processing routine of FIG. 7 assumes that all targets can be placed at arbitrary stationary positions, and the placement with a high possibility of divergence of bias error estimates is given when the placement position range of each target is given. The case where the position is determined in advance is shown.
First, in step S1, a three-dimensional position space Q in which each target l can be arranged for L targets l (l = 1, 2,..., L). _l (L = 1, 2,..., L) is set. For example, each axis (x ₁ , Y ₁ , Z ₁ ) Minimum value x _lmin , Y _lmin , Z _lmin And the maximum value x _lmax , Y _lmax , Z _lmax Are given by the following equation (1).
[0011]
[Expression 1]

[0012]
Next, in step S2, the space Q of the three-dimensional position where each target can be placed. _l (L = 1, 2,..., L) is gridded, and a set D of three-dimensional position vectors D _l (L = 1, 2,..., L) is generated.
For example, the space Q of the three-dimensional position _l (L = 1, 2,..., L), grid spacing Δx _l , Δy _l , Δz _l (L = 1, 2,..., L) is set, and each axis (x, y, z) in the three-dimensional space is divided as shown in the following equation (2).
[0013]
[Expression 2]

[0014]
Then, one point is selected from the set of one-dimensional points of the axes x, y, and z divided as described above, and all combinations that constitute a three-dimensional vector are generated. This combination is expressed as the above-described three-dimensional position vector set D. _l (L = 1,..., L).
Next, in step S3, the three-dimensional position vector set D _l Three-dimensional vectors are selected one by one from (l = 1, 2,..., L), and all combinations are generated. That is, one combination is composed of L three-dimensional vectors. Here, a set of combinations is called e, and the set of combinations is called E _all Call it.
Subsequently, in step S4, the combination set E _all First, an observation matrix H is calculated for all the combinations. At this time, the calculation formula of the observation matrix H is the true position of the target l (l = 1,..., L) viewed from each radar i (i = 1, 2) as in the following formula (3):
[Equation 3]

Is expressed as the following formulas (4) to (7).
[0015]
[Expression 4]

[Equation 5]

[Formula 6]

[Expression 7]

[0016]
And the combination set E _all Minimum singular value of observation matrix H for all elements in
[Equation 8]

Is calculated. Where the set of calculated minimum singular values is Λ _all Call it.
Finally, in step S5, the minimum singular value set Λ _all In the set Λ _all Indicates that the target arrangement with “0” (or close to “0”) is a target arrangement with high possibility of divergence, so the target arrangement of “0” (or “close to 0”) is excluded. A target arrangement is selected from the combination. Thereby, the combination of the target arrangement | positioning with high possibility of divergence can be avoided.
Further, in order to select an arrangement with the smallest possibility of divergence, a combination of target positions at which the minimum singular value shows the maximum value is selected.
That is, the combination e so as to satisfy the following expression (8): _max Is elected.
[0017]
[Equation 9]

[0018]
This combination e _max However, this is the target placement with the least possibility of divergence.
As described above, in the target position determination method of FIG. 7, when the target can be freely placed in a stationary manner, the target placement in which the divergence of the bias error estimate is likely to occur (or low) is examined in advance. A target arrangement pattern in which the minimum singular value is maximized (that is, the divergence is least likely to occur) can be generated in advance, and the target position can be determined in advance.
However, the estimation accuracy is still unknown, and the target layout that is unlikely to diverge does not necessarily match the target layout with excellent estimation accuracy, so even if a target layout that does not diverge is selected, sufficient estimation is possible. Accuracy is not always obtained.
[0019]
[Problems to be solved by the invention]
As described above, the conventional method for determining the target position for sensor bias error estimation uses a new algorithm to detect in advance a target arrangement where the estimated bias error of the sensor installation diverges, and a target that does not diverge. Although the position is determined in advance and the flight path is determined in real time for the target in flight, the estimation accuracy of the bias error estimate is unknown, so the target placement with excellent estimation accuracy (or , The target travel route) cannot be determined.
[0020]
The present invention has been made to solve the above-described problems. An estimated error index value of a bias error estimated value is calculated in advance, and a target arrangement having a high estimation accuracy (ie, a small estimation error) is obtained. It is an object of the present invention to obtain a target position determination method for sensor bias error estimation that can be determined.
[0021]
Further, the present invention calculates an estimation error index value of the bias error estimation value in real time and determines a target arrangement with high estimation accuracy (that is, estimation error is small). It is an object of the present invention to obtain a target position determination method for sensor bias error estimation that can determine a moving path with high estimation accuracy in real time.
[0022]
[Means for Solving the Problems]
A target position determination method for estimating a sensor bias error according to the present invention is a method for determining an arrangement position of a plurality of targets in order to estimate an installation error of a plurality of sensors for detecting a target in a three-dimensional region as a bias error. An arrangement area setting step for designating a three-dimensional area where a plurality of targets can be arranged as a possible arrangement area, and a set of three-dimensional position vectors obtained by gridting the possible arrangement areas as a possible arrangement area set. For each target from the arrangement area grid step and possible arrangement area set Of the 3D position vector Select one vector at a time to generate a combination, and repeat the combination to generate all combinations, and a target position combination step for all combinations Corresponds to the amount of deviation An error index value calculating step for calculating an estimated error index value and an estimated error index value minimum value And a target position selection step for determining a combination of target positions as an optimal combination of the positions of the targets, and the positions of the targets are determined before the targets are arranged.
[0023]
The target position determination method for estimating a sensor bias error according to the present invention determines a placement position of a plurality of targets in order to estimate an installation error of a plurality of sensors that detect a target in a three-dimensional region as a bias error. It is possible to calculate the position area where each target can reach the next time as a possible arrangement area based on the movement specifications and the movement specification input step for capturing the movement specifications at the current time of each target. An arrangement area calculation step, an arrangement area grid step for calculating a set of three-dimensional position vectors obtained by gridting the possible arrangement areas as a possible arrangement area set, and for each target from the possible arrangement area set Of the 3D position vector Select one vector at a time to generate a combination, and repeat the combination to generate all combinations, and a target position combination step for all combinations Corresponds to the amount of deviation An error index value calculating step for calculating an estimated error index value and an estimated error index value minimum value A target position selection step that determines a combination of target positions as an optimal arrangement position combination of each target, an end determination step that determines whether or not a processing end condition is satisfied, and when the processing end condition is not satisfied In addition to updating from the current time to the next time, a time update for moving the target to the determined target position and a target moving step are provided, and the moving path of each target is determined in real time for each current time. .
[0024]
DETAILED DESCRIPTION OF THE INVENTION
Embodiment 1 FIG.
Hereinafter, the first embodiment of the present invention will be described in detail with reference to the drawings.
FIG. 1 is a flowchart showing a processing procedure according to Embodiment 1 of the present invention, and shows a processing routine of a target position determination method in sensor installation error estimation.
In FIG. 1, steps S1 to S3 indicate the same processing as described above (see FIG. 7).
[0025]
First, as described above, each target possible arrangement area (space Q of the three-dimensional position) _l ) Setting (step S1), grid formation of possible arrangement regions (step S2), and combination of target positions (step S3).
Subsequently, an estimated error index value for each bias error estimated value is calculated (step S11), the estimated error index value for each bias error estimated value is weighted and integrated (step S12), and the estimated error index value for each estimated value is calculated. Then, a combination of target positions that obtains the optimum estimation accuracy is selected (step S13), and the processing routine of FIG.
[0026]
Hereinafter, the first embodiment of the present invention shown in FIG. 1 will be described more specifically with reference to mathematical expressions.
In the case of the target position determination method shown in FIG. 1, all targets can be freely arranged at a stationary position, and when a target arrangement position range is given, a stationary arrangement position can be determined in advance. .
[0027]
First, in the same manner as described above, in steps S1 to S3, the space Q of the three-dimensional positions where each target (L) can be arranged. _l (L = 1, 2,..., L) is gridded, and these three-dimensional position vector sets D _l Combination set E of (l = 1,..., L) _all Get.
[0028]
Next, in step S11, an estimated error index value is calculated. That is, first, the combination set E _all Evaluate the observation matrix H and the matrix R for all elements in M = (H ^T R ^-1 H) ^-1 And the diagonal elements of this matrix M are calculated. At this time, the observation matrix H is calculated by the above-described equations (3) to (7), and the matrix R is expressed by the following equations (9) to (9) using the variables defined in the equations (3) to (7). Calculated by (12).
[0029]
[Expression 10]

[Expression 11]

[Expression 12]

[0030]
In the above formulas (9) to (12), σ _ilR , Σ _ilE , Σ _ilAz Is a dispersion value of distance, elevation angle, and azimuth angle observation error when observing L targets l (l = 1,..., L) using two sensors i (i = 1, 2). It is.
Using the formulas (9) to (12), the combination set E _all Evaluate the matrix M for all elements in and the square root of the diagonal elements of this matrix M (σ ₁ , Σ ₂ , ..., σ ₅ , Σ ₆ ) Is an estimated error index value.
This set of estimated error index values is represented by Σ _all Called. In other words, one target arrangement combination
[Formula 13]

From the six estimated error index values (σ ₁ , Σ ₂ , ..., σ ₅ , Σ ₆ ) Is calculated for all combinations e, and a set of estimated error index values Σ _all Create
Instead of using the diagonal elements of the matrix M, various norms of the matrix M can be used as index values.
[0031]
Here, if there is a possibility that the dispersion value of the observation noise of each sensor may fluctuate, for example, set the fluctuation range (upper limit and lower limit) of the dispersion value of each observation specification and set this range to a certain number. The estimated error index value is calculated using a combination of variance values for each stage, and a set of values obtained by averaging the calculation results is a set of estimated error index values Σ. _all It can also be.
For example, if there are two radars, the above six (9 if the number of radars is 3) estimated error index values for the distance, elevation angle, and azimuth of each

sensor

1 and 2 from one matrix M Is obtained. Here, for convenience, the case where the target position where the estimated error index value indicates the minimum value is set as the optimum arrangement position is described. However, in actuality, when these index values are used, any of the six variables is used. The “optimal” arrangement is determined in consideration of whether or not the weight is important.
For example, even if an arrangement having the smallest estimated error index value for the distance of the radar 1 is selected from among the six estimated error index values, for example, whether or not the estimation accuracy of the other five variables is excellent (that is, error) Whether or not the index value is small is another problem. That is, since the arrangement is finally determined while checking the other five estimated error index values, the arrangement having the smallest error index value of the distance of the radar 1 is not necessarily selected, and the six error indices are not necessarily selected. The optimal target placement is determined while making a value trade-off.
For example, as a method of performing a trade-off of six estimated error index values, there is a method of weighted integration of six error index values. According to this method, a designer needs to perform placement while looking at six diagrams. Therefore, it is possible to determine the arrangement with a single figure after integration, which leads to design efficiency.
[0032]
Subsequent to step S11 in FIG. 1, the estimated error index values of the respective variables are weighted and integrated as in step S12, and a combination of target arrangements in which the weighted integrated value is optimal (for example, the minimum) is determined.
In this case, the estimated error index value after the weighted integration is calculated as in the following formulas (13) and (14), for example.
[0033]
[Expression 14]

[0034]
Hereinafter, a set of estimated error index values after weighted integration Σ _{all_weighted} And a combination e satisfying the following expression (15) from this set: _opt Select (optimal target placement).
[0035]
[Expression 15]

[0036]
Finally, in step S13, a set of estimated error index values Σ _all Among these, a combination of target positions where the estimated error index value indicates the minimum value is selected. At this time, since there is an estimated error index value for each variable, the user determines the importance according to the purpose, and the optimum target placement e _opt To decide.
[0037]
As described above, when the target can be freely and statically arranged, the target arrangement in which the estimated error index value is optimum (for example, minimum) can be selected in advance with high accuracy.
Note that the weighted integration processing step S12 is executed for the purpose of design efficiency when a plurality of estimated error index values are obtained for each target arrangement combination. It may be omitted if the error index value is single or if design efficiency is not required.
[0038]
In other words, as a target position determination method necessary for the bias error estimation algorithm, step S1 for setting a position where each target can be arranged, and a three-dimensional position vector set D obtained by grid-forming the three-dimensional areas where each target can be arranged _l Step S2 for calculating, Step S3 for generating combinations from the grid-arranged arrangement region set, Step S11 for calculating estimated error index values for all combinations, and each target arrangement optimum using the estimated error index values By providing step S13 for determining the combination of the above, a plurality of target arrangements can be determined in advance without executing step S12.
If step S12 is not executed, an optimal target arrangement is selected using the set of estimated error index values Σall in step S13.
[0039]
On the other hand, when it is difficult to select an optimal combination of target arrangements using the set of estimated error index values Σall, in order to easily determine the optimal combination of target arrangements, in addition to the above steps, A weighting integration step S12 is executed as a step of integrating the estimated error index values, and the arrangement of a plurality of targets is determined in advance.
When the weighted integration step 12 is executed, in step S13, the optimum combination of target positions is obtained from the set of estimated error index values Σall_weight after the weighted integration, not from the set of estimated error index values Σall. .
Similarly, even when the estimated error index value and the minimum singular value or geographical information are integrated (described later), the optimum target arrangement position is determined using the integrated value.
[0040]
When the observation accuracy of each observation item of the sensor is variable, an upper limit and a lower limit of the observation accuracy of each observation item are given in the estimation error index value calculation step S11, and the steps are divided step by step. An estimated error index value is calculated using a combination of variance values for each, and a set of average values is calculated as a set of estimated error index values Σ. _all As described above, a plurality of target arrangements are determined in advance.
Further, as the estimated error index value, the matrix M (= (H ^T R ^-1 H) ^-1 ) Square root of the diagonal element (σ ₁ , ..., σ ₆ ), But other index values may be used.
Needless to say, the number of radars and the target number for target position determination are not limited to two, and any number can be set as necessary.
[0041]
Embodiment 2. FIG.
In the first embodiment, the target position determination method that minimizes the estimation error has been described. However, even if the target position is an excellent target arrangement with the smallest estimation error, the target arrangement happens to be an arrangement in which the estimated value diverges. If they are close, the estimated value may diverge or the estimation error may deteriorate.
Therefore, in order to avoid such divergence of the estimated value, by using the estimation error index value map and the minimum singular value map together, a target arrangement with excellent estimation accuracy may be determined while preventing divergence. .
[0042]
Also, if the target is a flying object (airplane, helicopter, balloon, etc.), it may become a flight prohibited area due to geographical restrictions, a target collision area, or other conditions It is desirable to reflect these geographical information when there is a limitation in
Therefore, the target may be arranged at a safer position by integrating the geographical information with the estimated error index value.
Hereinafter, in view of the above conditions, a second embodiment of the present invention in which the minimum singular value map and geographical information are used together will be described.
[0043]
FIG. 2 is a flowchart showing a processing procedure according to the second embodiment of the present invention. Steps S1 to S3 and S11 to S13 show the same processing as described above (see FIG. 1).
In this case, following the above-described weighted integration process (step S12), an integration process with the minimum singular value (step S14) and an integration process with the geographical information (step S15) are executed.
[0044]
First, in the same manner as described above, an estimation error index value is calculated in steps S1 to S3 and S11, and a weighted integrated estimation error index value is calculated in step S12 as necessary.
[0045]
Next, in step S14, the minimum singular value set Λ _all Integration with.
As the integration process in step S14, for example, as a first method, a target arrangement in which the minimum singular value is a certain value or less (prone to divergence) is used. _all It is possible to remove it. Alternatively, as a second method, it is conceivable to perform weighted integration of the minimum singular value and the estimated error index value. By these integration methods, a target arrangement having a small minimum singular value (easy to diverge) is prevented from being selected in a target arrangement selection process (step 13) described later.
[0046]
Next, in step S15, integration with geographical information is performed.
As the integration process in step S15, for example, as a first method, an area where target placement is impossible due to geographical information is changed to a set of estimated error index values Σ. _all It is possible to remove it. Alternatively, as a second method, it is conceivable to perform weighted integration between geographical information and an estimated error index value. By these methods, for example, a target arrangement larger than a predetermined level of geographical restriction is prevented from being selected in the following target arrangement selection process (step 13).
In other words, constraints based on geographical information are integrated, and for example, an optimal combination of arrangement positions is determined from combinations excluding target arrangement positions with large geographical restrictions.
[0047]
Finally, in step S13, a target arrangement is selected such that the estimated error index value after the integration process in steps S14 and S15 is optimal.
In this way, when selecting a target location that has an optimal estimation error in advance, even if there is a possibility that a location with excellent estimation accuracy may be located in the vicinity of a highly divergent location, the minimum singular value Further, by integrating the estimated error index values (step S14), it is possible to select an optimum target arrangement (step S13) after excluding the divergent arrangement.
In addition, the information on the geographical condition (or operation condition) is integrated (step S15), and the above constraints are taken into account by excluding the position where the target placement is not desirable due to the geographical condition (or operation condition) or the like. It is possible to determine the target placement.
[0048]
In other words, when determining the optimal target placement, if there is geographical information (such as a flight-prohibited region due to geographical constraints, a collision risk region between targets, and other target placement constraints), such geographical information In order to reflect this, by integrating the geographical information and the estimated error index value in step S15, a plurality of target arrangements can be determined in advance at a safe position.
[0049]
In addition, although the integration process of the minimum singular value and the geographical information is used together, only one of the integration processes may be executed.
For example, when determining the optimal target location, even if the target location has good estimation accuracy, if the location happens to be close to the location where the estimated value diverges, the estimated value will diverge (or estimate Since the error may be deteriorated), the integration step 14 with the minimum singular value is executed and the minimum singular value map and the estimated error index value map are used together to prevent the divergence and the estimation accuracy. A plurality of excellent target placements can be determined in advance.
[0050]
Embodiment 3 FIG.
In the second and third embodiments, the optimal target arrangement is determined in advance. However, when the target is already flying, the target position based on the flight path may be determined in real time.
The third embodiment of the present invention in which the target position is determined in real time will be described below.
FIG. 3 is an explanatory diagram showing a processing operation according to the third embodiment of the present invention, and FIG. 4 is a flowchart showing a processing procedure according to the third embodiment of the present invention.
[0051]
FIG. 3 shows a case where two

radars

1 and 2 detect two targets C1 and C2, and the regions where the targets C1 and C2 are located are shown at each time t. _k , T _{k + 1} , T _{k + 2} Move moment by moment.
In FIG. 3, the targets C1 and C2 exchange information with each other directly or via the

radars

1 and 2, and sequentially determine flight routes using estimated error index values.
In addition, for each target C1, C2, each time t _k , T _{k + 1} , T _{k + 2} An estimated error index value map of the reachable area is formed, and the positions of the targets C1 and C2 at which the estimated error index value at each time is optimal are selected and determined.
[0052]
In FIG. 4, steps S11 to S15 are the same processing as described above (see FIG. 2), and steps S22 and S23 correspond to steps S2 and S3, respectively.
In this case, instead of the above-described step S1, the movement specification input process (step S16) at the current time of each target and the calculation process of the position area (possible arrangement area) where each target can reach the next time (step S17) is executed.
Subsequent to the target position selection step S13, a determination process (step S18) as to whether or not the process end condition of FIG. 4 is satisfied is executed. If the end condition is not satisfied, the current time t _k To the next time t _{k + 1} After the update process and the moving flight process of the target to the determined target position (step S19) are executed, the process returns to the motion specification input step S16.
[0053]
First, in step S16, the current time t of each target _k Get the motion parameters such as position, velocity and acceleration at.
Subsequently, in step S17, each target is set to the next time t in consideration of the athletic ability of each target. _{k + 1} A position area (possible arrangement area) that can be reached is calculated.
For example, as athletic ability information, the minimum acceleration ax for each axis (xyz) direction of each target _lmin , Ay _lmin , Az _lmin And maximum acceleration ax _lmax , Ay _lmax , Az _lmax Are given as grid spacing Δax for each axis. _l , Δay _l , Δaz _l , (L = 1,..., L) are set and divided as shown in the following equation (16).
[0054]
[Expression 16]

[0055]
Further, by selecting one point from the set of points on each axis divided, all combinations are created, and a set of three-dimensional acceleration vectors is generated. This set of three-dimensional acceleration vectors is AG _l (L = 1,..., L).
Hereinafter, the three-dimensional acceleration vector set AG _l Each acceleration vector a _l To the next time t of the target l _{k + 1} A set of possible positions can be calculated.
For example, the target l is the next time t _{k + 1} The position that can be taken is a three-dimensional acceleration vector set AG _l Acceleration vectors a _l The following equation (17) is expressed using the equation of motion for.
[0056]
[Expression 17]

[0057]
However, in Formula (17), d _{l, k + 1} , D _{l, k} Respectively, at time t _{k + 1} And t _k Is the position vector of the target l at v _{l, k} Is the time t _k Is the velocity vector of the target 1 at.
The motion specification (target position) obtained by the equation (17) is calculated from all three-dimensional acceleration vector sets AG. _l Is calculated for the element in and the next time t _{k + 1} A set of three-dimensional position vectors D _l (L = 1,..., L) is calculated. Here, the three-dimensional position vector set D _l (L = 1,..., L) is also referred to as a “three-dimensional position space”.
[0058]
Next, in the same manner as described above, in steps S22 and S23, the three-dimensional position vector set D _l (L = 1,..., L), and a position vector combination set E _all In step S11, S12, S14, S15 and S13, the position of each target is selected such that the integrated estimated error index value is minimized.
[0059]
Finally, in step S18, whether or not the end condition of the processing routine of FIG. 4 is satisfied is determined by, for example, given time Tend and original time t. _k And t _k > Tend (time t _k Is determined based on whether or not the relationship of time Tend has passed).
In step S18, t _k If it is determined that> Tend (that is, yes), the processing routine of FIG. _k If it is determined that ≦ Tend (ie, no), the time is updated in step S19, the target is moved to the obtained position, the process returns to step S16 again, and the same processing is repeated.
[0060]
Note that the above method is also effective when, for example, only a few movement paths among many targets are determined. In addition, according to the above method, the target movement route is determined at each time t. _k The next time t _{k + 1} It is possible to determine the flight path of the target at, and to make a flight plan by giving only the initial motion parameters such as the position and speed of each target.
In this way, when the target can move freely, it is possible to generate a movement route in which the estimated error index value is optimal (for example, minimum) in real time.
[0061]
That is, in addition to the above steps S22, S23, and S11 to S15, the motion specification input step S16 of each target at the current time, the calculation step S17 of the position area where each target can reach the next time, and the process are completed By providing step S18 for determining whether or not to perform and updating the time and target moving flight step S19 to the target position, a plurality of target moving paths (flight paths) can be determined in real time.
Also in the third embodiment, the weighting integration step S12, the minimum singular value integration step S14, or the geographical information integration step S15 is executed as necessary, but may be omitted.
[0062]
【The invention's effect】
As described above, according to the present invention, in order to estimate an installation error of a plurality of sensors that detect a target in a three-dimensional region as a bias error, a method for determining an arrangement position of a plurality of targets, An arrangement area setting step for designating a three-dimensional area in which a target can be arranged as a possible arrangement area, and an arrangement area grid formation step for calculating a set of three-dimensional position vectors obtained by gridting the possible arrangement area as a possible arrangement area set And for each target from the set of possible placement areas Of the 3D position vector Select one vector at a time to generate a combination, and repeat the combination to generate all combinations, and a target position combination step for all combinations Corresponds to the amount of deviation An error index value calculating step for calculating an estimated error index value and an estimated error index value minimum value A target position selection step for determining a target position combination indicating the optimal arrangement position combination of each target, and determining the arrangement position of each target before each target is arranged. There is an effect that a target position determination method for sensor bias error estimation that can determine a target arrangement with high accuracy in advance can be obtained.
[0063]
In addition, according to the present invention, there is provided a method for determining an arrangement position of a plurality of targets in order to estimate an installation error of a plurality of sensors for detecting a target in a three-dimensional region as a bias error, and A motion specification input step for capturing motion specifications at a time, a possible placement region calculation step for calculating a location region where each target can reach the next time based on the motion specifications as a possible placement region, and a possible placement region An arrangement area grid step for calculating a set of three-dimensional position vectors obtained by grid formation as a possible arrangement area set, and for each target from the possible arrangement area set Of the 3D position vector Select one vector at a time to generate a combination, and repeat the combination to generate all combinations, and a target position combination step for all combinations Corresponds to the amount of deviation An error index value calculating step for calculating an estimated error index value and an estimated error index value minimum value A target position selection step that determines a combination of target positions as an optimal arrangement position combination of each target, an end determination step that determines whether or not a processing end condition is satisfied, and when the processing end condition is not satisfied In addition to updating from the current time to the next time, the time update and target moving step for moving the target to the determined target position and a target moving step are provided, and the moving path of each target is determined in real time for each current time. Therefore, it is possible to obtain a target position determination method for estimating a sensor bias error that can determine a target arrangement with high estimation accuracy and determine a moving path in which the estimation accuracy is high even for a target in flight in real time. There is.
[Brief description of the drawings]
FIG. 1 is a flowchart showing Embodiment 1 of the present invention.
FIG. 2 is a flowchart showing a second embodiment of the present invention.
FIG. 3 is an explanatory diagram showing a target position for each time in a third embodiment of the present invention.
FIG. 4 is a flowchart showing Embodiment 3 of the present invention.
FIG. 5 is an explanatory diagram showing a sensor installation error correction process based on a conventional target position determination method for estimating a sensor bias error.
FIG. 6 is an explanatory diagram showing a conventional sensor bias error estimation algorithm.
FIG. 7 is a flowchart showing a conventional method for determining a target position for estimating a sensor bias error.
[Explanation of symbols]
1, 2 radar (sensor), C1, C2 target, S1 placement area setting step, S2, S22 placement area gridding step, S3, S23 target position combination step, S11 error index value calculation step, S12 weighting integration step, S13 target Position selection step, S14 minimum singular value integration step, S15 geographical information integration step, S16 motion specification input step, S17 possible arrangement area calculation step, S18 end determination step, S19 time update and target movement step.

Claims

三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、
前記複数の目標が配置され得る三次元領域を可能配置領域として指定する配置領域設定ステップと、
前記可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、
前記可能配置領域集合から前記目標毎に、三次元位置ベクトルのうちの１ベクトルずつ選出して組合せを生成するとともに、前記組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、
前記全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、
前記推定誤差指標値が最小値を示す目標位置の組合せを、前記各目標の最適な配置位置の組合せとして決定する目標位置選出ステップとを備え、
前記各目標が配置される前に前記各目標の配置位置を決定することを特徴とするセンサバイアス誤差推定用の目標位置決定方法。In order to estimate an installation error of a plurality of sensors that detect a target in a three-dimensional region as a bias error, a method of determining an arrangement position of the plurality of targets,
An arrangement area setting step for designating a three-dimensional area in which the plurality of targets can be arranged as a possible arrangement area;
A placement area gridding step for calculating a set of three-dimensional position vectors obtained by gridting the possible placement areas as a possible placement area set;
For each target from the possible arrangement region set, a target position combining step of selecting one vector of three-dimensional position vectors and generating a combination, and repeating the combination to generate all combinations;
An error index value calculating step for calculating an estimated error index value corresponding to the deviation amount for all the combinations;
A target position selecting step of determining a combination of target positions at which the estimated error index value indicates a minimum value as a combination of optimum arrangement positions of the respective targets,
A target position determination method for estimating a sensor bias error, wherein an arrangement position of each target is determined before each target is arranged.

三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、
前記各目標の現時刻における運動諸元を取り込む運動諸元入力ステップと、
前記運動諸元に基づいて前記各目標が次の時刻に到達可能な位置領域を可能配置領域として算出する可能配置領域算出ステップと、
前記可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、
前記可能配置領域集合から前記目標毎に、三次元位置ベクトルのうちの１ベクトルずつ選出して組合せを生成するとともに、前記組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、
前記全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、
前記推定誤差指標値が最小値を示す目標位置の組合せを、前記各目標の最適な配置位置の組合せとして決定する目標位置選出ステップと、
処理終了条件を満たすか否かを判定する終了判定ステップと、
前記処理終了条件が満たされない場合に、前記現時刻から次の時刻に更新するとともに、決定された目標位置に目標を移動飛行させる時刻更新および目標移動ステップとを備え、
前記各目標の移動経路を前記現時刻毎にリアルタイムに決定することを特徴とするセンサバイアス誤差推定用の目標位置決定方法。In order to estimate an installation error of a plurality of sensors that detect a target in a three-dimensional region as a bias error, a method of determining an arrangement position of the plurality of targets,
An exercise specification input step for capturing the exercise specification at the current time of each target;
A possible arrangement area calculating step for calculating, as a possible arrangement area, a position area where each of the targets can reach the next time based on the movement specifications;
A placement area gridding step for calculating a set of three-dimensional position vectors obtained by gridting the possible placement areas as a possible placement area set;
For each target from the possible arrangement region set, a target position combining step of selecting one vector of three-dimensional position vectors and generating a combination, and repeating the combination to generate all combinations;
An error index value calculating step for calculating an estimated error index value corresponding to the deviation amount for all the combinations;
A target position selecting step for determining a combination of target positions at which the estimated error index value indicates a minimum value as a combination of optimum arrangement positions of the targets;
An end determination step for determining whether or not a process end condition is satisfied;
When the processing end condition is not satisfied, it is updated from the current time to the next time, and includes a time update and target movement step for moving the target to the determined target position, and a target movement step,
A target position determination method for estimating a sensor bias error, wherein a movement path of each target is determined in real time at each current time.

前記誤差指標値算出ステップは、
前記可能配置領域集合から選出された全ての組合せ要素に対して、観測行列Ｈおよび行列Ｒを評価して、以下の式、
М＝（Н^ＴＲ^−１Н）^−１
により行列Мを計算するとともに前記行列Ｍの対角要素を算出し、前記行列Ｍの対角要素の平方根を前記推定誤差指標値として算出することを特徴とする請求項１または請求項２に記載のセンサバイアス誤差推定用の目標位置決定方法。The error index value calculating step includes:
Evaluating the observation matrix H and the matrix R for all combination elements selected from the possible arrangement region set, the following equation:
М = (Н ^T R ^-1 Н) ^-1
The matrix М is calculated by the above, the diagonal elements of the matrix M are calculated, and the square root of the diagonal elements of the matrix M is calculated as the estimated error index value. Of determining a target position for estimating a sensor bias error.

前記各目標の配置位置の組合せに対する推定誤差指標値として複数の値が得られた場合に、前記各推定誤差指標値を重み付け統合する重み付け統合ステップを備え、
前記目標位置選出ステップは、重み付け統合処理後の推定誤差指標値に基づいて、前記最適な配置位置の組合せを決定することを特徴とする請求項１から請求項３までのいずれか１項に記載のセンサバイアス誤差推定用の目標位置決定方法。When a plurality of values are obtained as estimated error index values for the combination of the arrangement positions of the targets, the weight integration step of weight integrating the estimated error index values,
The said target position selection step determines the combination of the said optimal arrangement position based on the estimation error parameter | index value after a weighting integration process, The any one of Claim 1- Claim 3 characterized by the above-mentioned. Of determining a target position for estimating a sensor bias error.

推定誤差指標値算出ステップは、平均値算出ステップを含み、
前記平均値算出ステップは、
前記センサによる前記目標の各観測諸元の観測精度が可変である場合に、前記各観測諸元の観測精度の分散値変動範囲を与えて、前記分散値変動範囲を段階的に区切り、
段階毎の分散値の組合せを用いて推定誤差指標値を算出するとともに、前記段階毎の推定誤差指標値の平均値の集合を前記推定誤差指標値の集合として算出することを特徴とする請求項１から請求項４までのいずれか１項に記載のセンサバイアス誤差推定用の目標位置決定方法。The estimated error index value calculating step includes an average value calculating step,
The average value calculating step includes:
When the observation accuracy of each observation item of the target by the sensor is variable, a dispersion value variation range of the observation accuracy of each observation item is given, and the dispersion value variation range is stepwise separated,
The estimated error index value is calculated using a combination of variance values for each stage, and a set of average values of estimated error index values for each stage is calculated as the set of estimated error index values. The target position determination method for sensor bias error estimation according to any one of claims 1 to 4.

前記可能配置領域集合から選出された全ての組合せ要素に対して、観測行列Ｈおよび前記観測行列Ｈの最小特異値を算出するとともに、前記最小特異値の集合マップと推定誤差指標値の集合マップとを統合する最小特異値統合ステップを備え、
前記目標位置選出ステップは、前記最小特異値が０に近い目標配置位置を除いた組合せの中から、前記各目標の最適な配置位置の組合せを決定することを特徴とする請求項１から請求項５までのいずれか１項に記載のセンサバイアス誤差推定用の目標位置決定方法。For all combination elements selected from the possible arrangement region set, the observation matrix H and the minimum singular value of the observation matrix H are calculated, and the minimum singular value set map and the estimation error index value set map A minimum singular value integration step that integrates
The said target position selection step determines the combination of the optimal arrangement position of each said target from the combination except the target arrangement position whose said minimum singular value is close | similar to 0. 6. The target position determination method for sensor bias error estimation according to any one of items 5 to 5.

前記目標の配置位置に対して地理的制約を含む地理的情報が存在する場合に、前記地理的情報と前記推定誤差指標値と統合して、前記地理的情報を前記推定誤差指標値に反映させるための地理的情報統合ステップを備え、
前記目標位置選出ステップは、前記地理的制約を統合した組合せの中から、前記最適な配置位置の組合せを決定することを特徴とする請求項１から請求項６までのいずれか１項に記載のセンサバイアス誤差推定用の目標位置決定方法。When there is geographical information including geographical constraints on the target arrangement position, the geographical information is integrated with the estimated error index value to reflect the geographical information in the estimated error index value. A geographic information integration step for
The said target position selection step determines the combination of the said optimal arrangement position from the combination which integrated the said geographical restrictions, The any one of Claim 1-6 characterized by the above-mentioned. A target position determination method for sensor bias error estimation.

前記目標位置選出ステップは、前記地理的制約が所定レベルよりも大きい目標配置位置を除いた組合せの中から、前記最適な配置位置の組合せを決定することを特徴とする請求項７に記載のセンサバイアス誤差推定用の目標位置決定方法。 8. The sensor according to claim 7, wherein the target position selecting step determines the optimum combination of the arrangement positions from combinations excluding the target arrangement positions where the geographical restriction is larger than a predetermined level. A target position determination method for bias error estimation.