JP4108424B2 - Target position determination method for sensor bias error estimation - Google Patents
Target position determination method for sensor bias error estimation Download PDFInfo
- Publication number
- JP4108424B2 JP4108424B2 JP2002276850A JP2002276850A JP4108424B2 JP 4108424 B2 JP4108424 B2 JP 4108424B2 JP 2002276850 A JP2002276850 A JP 2002276850A JP 2002276850 A JP2002276850 A JP 2002276850A JP 4108424 B2 JP4108424 B2 JP 4108424B2
- Authority
- JP
- Japan
- Prior art keywords
- target
- combination
- arrangement
- index value
- error
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Radar Systems Or Details Thereof (AREA)
Description
【0001】
【発明の属する技術分野】
この発明は、複数のセンサ(レーダなど)を用いた目標の検知(捜索および追尾などを含む)に際し、各センサの距離、仰角および方位角のアライメント誤差(設置誤差)による目標検知性能の劣化を回避するために、事前に各センサの設置誤差をバイアス誤差として推定する方法に関し、特に、目標の位置(移動経路)によって推定精度が劣化する問題点に鑑み、目標位置(および目標移動経路)を決定可能にして推定精度を向上させたセンサバイアス誤差推定用の目標位置決定方法に関するものである。
【0002】
【従来の技術】
一般に、複数のセンサ(レーダなど)を用いて目標の探知(追尾など)を行う場合、各センサに設置誤差が生じると検知性能の劣化につながる可能性があるので、各センサの設置誤差(アライメント誤差)をバイアス誤差としてあらかじめ推定し、各センサの観測データをバイアス誤差に基づいて補正演算する必要がある。なお、各センサの設置誤差は、短時間の間では一定値と見なされるので、補正演算用のバイアス誤差と称されている。
また、このようなバイアス誤差推定アルゴリズムを実行するためには、複数の目標を空中に配置し、これらの目標を観測して得られる観測データを用いて、各センサの設置誤差を推定する必要がある。
たとえば、図5および図6は従来のセンサの設置誤差補正処理およびバイアス誤差推定方法を示す説明図である(たとえば、非特許文献1参照)。
【0003】
【非特許文献1】
小菅義夫、岡田隆光による、「三次元レーダのデータ融合におけるレーダバイアス誤差推定」、計測自動制御学会論文集、Vol.35、No.7、第823〜831頁、Fig.1
【0004】
図5においては、2つのセンサ(レーダ1、2)の表示画面(観測値)B1、B2を重ね合わせて統合し、目標C1〜C3(○印、□印、△印参照)の三次元位置を認識する際に、両センサが真の北方向を誤認識して設置された場合の誤認識を補正する方法を示している。
図5において、レーダ1、2(センサ)は、二次元位置検出器(PPI:Plan Position Indicator)からなり、それぞれ、複数の目標C1〜C3を検知する。
各レーダ1、2の表示例において、破線は、上方向が「北」、右方向が「東」とする正しい直交座標系であり、実線はバイアス誤差の影響を受けた直交座標系である。ここでは、各レーダ1、2は、方位角に対してバイアス誤差を有しており、真北を誤認識した状態で設置されているものとする。
【0005】
この場合、2つのレーダ1、2からの観測値データB1、B2を重ね合わせて統合すると、実際には各1つの目標C1〜C3が、それぞれ複数の目標として誤認識されてしまう。しかし、各レーダ1、2の設置誤差(バイアス誤差)の推定値を用いて、各観測値B1、B2を補正して統合すると、補正後のデータのように、単一の目標位置を正確に検知することができる。
したがって、上記のような各目標C1〜C3の誤認識を回避するためには、事前に各レーダ1、2の設置誤差を推定しておくことが重要となる。各レーダ1、2の設置誤差を推定するアルゴリズムは、上記文献に記載されており、図6のように表すことができる。
【0006】
図6において、各レーダ1、2は、同一の複数(たとえば、2個)の目標C1、C2(この場合、飛行機)を同期観測して、観測値B1、B2を取得する。
続いて、推定アルゴリズム(拡張カルマン)10は、カルマンフィルタを用いて、各観測値B1、B2を照合して両者のずれ量を検出し、各レーダ1、2のバイアス誤差推定値10aを演算する。
ただし、バイアス誤差推定値10aの推定精度は、各目標C1、C2と各レーダ1、2との相対位置によっては、大きく劣化する可能性がある。
【0007】
すなわち、バイアス誤差推定値10aを算出するための推定アルゴリズム10を実行するためには、複数の目標(たとえば、C1、C2)を空間に配置することが必要となるが、目標の配置に関して、以下の2つの問題が生じる。
(1)各目標と各レーダ1、2との相対配置によってはバイアス誤差推定値10aが発散するおそれがあるが、通常、相対配置を事前に知ることは困難である。
(2)上記相対配置とバイアス誤差推定値10aの推定精度との関係についても、未知である。
【0008】
上記問題(1)、(2)に鑑みて、バイアス誤差推定値が発散せずに、且つ、推定精度の高い目標配置を事前に決定する方法が要求されている。
そこで、たとえば問題(1)の解決策として、バイアス誤差推定値10aの発散可能性が高い目標配置を事前に検出して回避することのできる新規なアルゴリズムが考えられる。
図7は上記新規なアルゴリズムによるバイアス誤差推定処理用の目標位置決定方法を示すフローチャートであり、バイアス誤差推定値の発散が生じる可能性の高い目標配置を事前に回避するための処理ルーチンを示している。
【0009】
図7において、まず、各目標の配置が可能な三次元領域(可能配置領域)を設定し(ステップS1)、三次元ベクトルの集合を算出するために、可能配置領域をグリッド化(マトリクス化)する(ステップS2)。
次に、グリッド化された各目標の配置可能領域の集合から、1ベクトルずつ選出して組合せを生成するとともに、これを繰り返し実行して、全ての目標位置の組合せを生成する(ステップS3)。
また、全ての目標位置の組合せについて、観測行列およびその最小特異値を算出し(ステップS4)、全ての最小特異値の集合から、「0」または「0付近の値」を示す目標位置の組合せを選出し(ステップS5)、図7の処理ルーチンを終了する。
【0010】
以下、図7に示した目標位置決定方法について、数式を参照しながら、さらに具体的に説明する。
図7の処理ルーチンは、全ての目標が任意の静止位置に配置可能であることを前提条件として、各目標の配置位置範囲が与えられた場合に、バイアス誤差推定値の発散可能性が高い配置位置を事前に決定する場合を示している。
まず、ステップS1において、L個の目標l(l=1、2、…、L)に対し、各目標lを配置することのできる三次元位置の空間Ql(l=1、2、…、L)を設定する。たとえば、三次元空間の各軸(x1、y1、z1)の最小値xlmin、ylmin、zlminおよび最大値xlmax、ylmax、zlmaxを、それぞれ以下の式(1)のように与える。
【0011】
【数1】
【0012】
次に、ステップS2において、各目標を配置可能な三次元位置の空間Ql(l=1、2、…、L)をグリッド化し、三次元の位置ベクトルの集合Dl(l=1、2、…、L)を生成する。
たとえば、三次元位置の空間Ql(l=1、2、…、L)に対して、グリッドの間隔Δxl、Δyl、Δzl(l=1、2、…、L)を設定し、三次元空間の各軸(x、y、z)を、以下の式(2)のように分割する。
【0013】
【数2】
【0014】
そして、上記のように分割された各軸x、y、zの一次元の点の集合から1点ずつ選出し、三次元のベクトルを構成するような全ての組合せを生成する。この組合せを、上記の三次元位置ベクトル集合Dl(l=1、…、L)と称する。
次に、ステップS3において、三次元位置ベクトル集合Dl(l=1、2、…、L)から、1つずつ三次元ベクトルを選出し、全ての組合せを生成する。すなわち、1つの組合せは、L個の三次元ベクトルから構成される。ここで、一組の組合せをeと呼び、また、この組合せの集合をEallと呼ぶ。
続いて、ステップS4において、組合せ集合Eallの全ての組合せに対し、まず、観測行列Hを算出する。このとき、観測行列Hの算出式は、各レーダi(i=1、2)から見た目標l(l=1、…、L)の真位置を、以下の式(3)のように、
【数3】
と置くと、以下の式(4)〜(7)のように表される。
【0015】
【数4】
【数5】
【数6】
【数7】
【0016】
そして、組合せ集合Eall内の全ての要素に対して、観測行列Hの最小特異値
【数8】
を算出する。ここで、算出された最小特異値の集合をΛallと呼ぶ。
最後に、ステップS5において、最小特異値集合Λallの中で、集合Λallが「0」の(または、「0」に近い)目標配置が、発散の可能性の高い目標配置であることを示すので、「0」(または、「0に近い」)目標配置を除いた組合せから、目標配置を選択する。これにより、発散の可能性の高い目標配置の組合せを回避することができる。
また、発散の可能性の最も少ない配置を選択するためには、最小特異値が最大値を示す目標位置の組合せを選出する。
すなわち、以下の式(8)を満たすように、組合せemaxを選出する。
【0017】
【数9】
【0018】
この組合せemaxが、最も発散の可能性の少ない目標配置である。
上記のように、図7の目標位置決定方法は、目標を自由に静止配置できる場合には、バイアス誤差推定値の発散が起こる可能性の高い(または、低い)目標配置を事前に調べることにより、最小特異値が最大になる(すなわち、発散の最も起こりにくい)目標配置パターンを事前に生成し、目標位置を事前に決定することができる。
しかしながら、推定精度については依然として不明であり、発散の生じにくい目標配置が、必ずしも推定精度の優れた目標配置と一致するとは限らないので、仮に、発散しない目標配置を選出したとしても、十分な推定精度が得られるとは限らない。
【0019】
【発明が解決しようとする課題】
従来のセンサバイアス誤差推定用の目標位置決定方法は以上のように、新規なアルゴリズムを用いて、センサ設置のバイアス誤差推定値が発散するような目標配置を事前に検出し、発散の生じない目標位置を事前に決定するとともに、飛行中の目標に対してリアルタイムで飛行経路を決定しているが、バイアス誤差推定値の推定精度については未知であることから、推定精度の優れた目標配置(または、目標移動経路)を決定することができないという問題点があった。
【0020】
この発明は上記のような問題点を解決するためになされたもので、バイアス誤差推定値の推定誤差指標値を事前に計算して、推定精度の高い(すなわち、推定誤差が小さい)目標配置を決定することのできるセンサバイアス誤差推定用の目標位置決定方法を得ることを目的とする。
【0021】
また、この発明は、バイアス誤差推定値の推定誤差指標値をリアルタイムに計算して、推定精度の高い(すなわち、推定誤差が小さい)目標配置を決定することにより、飛行中の目標に対しても推定精度の高い移動経路をリアルタイムに決定することのできるセンサバイアス誤差推定用の目標位置決定方法を得ることを目的とする。
【0022】
【課題を解決するための手段】
この発明に係るセンサバイアス誤差推定用の目標位置決定方法は、三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、複数の目標が配置され得る三次元領域を可能配置領域として指定する配置領域設定ステップと、可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、可能配置領域集合から目標毎に、三次元位置ベクトルのうちの1ベクトルずつ選出して組合せを生成するとともに、組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、推定誤差指標値が最小値を示す目標位置の組合せを、各目標の最適な配置位置の組合せとして決定する目標位置選出ステップとを備え、各目標が配置される前に各目標の配置位置を決定するものである。
【0023】
また、この発明に係るセンサバイアス誤差推定用の目標位置決定方法は、三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、各目標の現時刻における運動諸元を取り込む運動諸元入力ステップと、運動諸元に基づいて各目標が次の時刻に到達可能な位置領域を可能配置領域として算出する可能配置領域算出ステップと、可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、可能配置領域集合から目標毎に、三次元位置ベクトルのうちの1ベクトルずつ選出して組合せを生成するとともに、組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、推定誤差指標値が最小値を示す目標位置の組合せを、各目標の最適な配置位置の組合せとして決定する目標位置選出ステップと、処理終了条件を満たすか否かを判定する終了判定ステップと、処理終了条件が満たされない場合に、現時刻から次の時刻に更新するとともに、決定された目標位置に目標を移動飛行させる時刻更新および目標移動ステップとを備え、各目標の移動経路を現時刻毎にリアルタイムに決定するものである。
【0024】
【発明の実施の形態】
実施の形態1.
以下、図面を参照しながら、この発明の実施の形態1について詳細に説明する。
図1はこの発明の実施の形態1による処理手順を示すフローチャートであり、センサ設置誤差推定における目標位置決定方法の処理ルーチンを示している。
図1において、ステップS1〜S3は、前述(図7参照)と同様の処理を示している。
【0025】
まず、前述と同様に、各目標の可能配置領域(三次元位置の空間Ql)の設定(ステップS1)、可能配置領域のグリッド化(ステップS2)および目標位置の組合せ(ステップS3)を実行する。
続いて、各バイアス誤差推定値に対する推定誤差指標値を算出し(ステップS11)、各バイアス誤差推定値に対する推定誤差指標値を重み付け統合し(ステップS12)、各推定値に対する推定誤差指標値に対して、最適な推定精度を得るような目標位置の組合せを選出し(ステップS13)、図1の処理ルーチンを終了する。
【0026】
以下、図1に示したこの発明の実施の形態1について、数式を参照しながら、さらに具体的に説明する。
図1に示した目標位置決定方法の場合、全ての目標を自由に静止位置に配置することができ、目標の配置位置範囲が与えられた場合に、事前に静止配置位置を決定することができる。
【0027】
まず、前述と同様に、ステップS1〜S3において、各目標(L個)の配置可能な三次元位置の空間Ql(l=1、2、…、L)をグリッド化し、これらの三次元位置ベクトル集合Dl(l=1、…、L)の組合せ集合Eallを得る。
【0028】
次に、ステップS11において、推定誤差指標値を算出する。すなわち、まず、組合せ集合Eall内の全ての要素に対して観測行列Hおよび行列Rを評価し、M=(HTR‐1H)‐1を計算するとともに、この行列Mの対角要素を算出する。このとき、観測行列Hは、前述の式(3)〜(7)により算出され、行列Rは、式(3)〜(7)に定義された変数を用いて、以下の式(9)〜(12)により算出される。
【0029】
【数10】
【数11】
【数12】
【0030】
上記式(9)〜(12)において、σilR、σilE、σilAzは、2つのセンサi(i=1、2)を用いてL個の目標l(l=1、…、L)を観測する際の、それぞれ、距離、仰角、方位角の観測誤差の分散値である。
式(9)〜(12)を用いて、組合せ集合Eall内の全ての要素に対して行列Mを評価し、この行列Mの対角要素の平方根(σ1、σ2、…、σ5、σ6)を推定誤差指標値とする。
この推定誤差指標値の集合をΣallと称する。すなわち、1つの目標配置の組合せ
【数13】
から、6つの推定誤差指標値(σ1、σ2、…、σ5、σ6)が算出され、これを全ての組合せeについて算出し、推定誤差指標値の集合Σallを作成する。
なお、行列Mの対角要素を用いる代わりに、行列Mの種々のノルムを指標値として用いることもできる。
【0031】
ここで、もし、各センサの観測雑音の分散値が変動する可能性がある場合は、たとえば、各観測諸元の分散値の変動範囲(上限および下限)を設定し、この範囲をある数で段階的に区切り、段階毎の分散値の組合せを用いて推定誤差指標値を算出し、その算出結果を平均した値の集合を推定誤差指標値の集合Σallとすることもできる。
たとえば、レーダが2台の場合、1つの行列Mから、各センサ1、2の距離、仰角、方位角に対し、上記6個(レーダ数が3であれば、9個)の推定誤差指標値が得られる。ここでは、便宜的に、推定誤差指標値が最小値を示す目標位置を最適な配置位置とする場合について説明しているが、実際には、これらの指標値を用いる場合、6つの変数のどれに重きをおくかなどを考慮しながら、「最適」な配置が決定されることになる。
たとえば、6つの推定誤差指標値の中から、たとえばレーダ1の距離について推定誤差指標値が最小な配置を選出しても、他の5つの変数の推定精度が優れているか否か(すなわち、誤差指標値が小さいか否か)は別の問題となる。すなわち、他の5つの推定誤差指標値を確認しながら最終的に配置を決定するので、必ずしも、レーダ1の距離の誤差指標値が最小な配置が選択されるとは限らず、6つの誤差指標値のトレードオフを行いながら、最適な目標配置が決定される。
たとえば、6つの推定誤差指標値のトレードオフを行う方法としては、6つの誤差指標値を重み付け統合する方法があり、この方法によれば、設計者は、6つの図を見ながら配置を行う必要がなく、統合後の1つの図で配置を決定することが可能となり、設計の効率化につながる。
【0032】
図1内のステップS11に続いて、ステップS12のように、各変数の推定誤差指標値を重み付け統合し、重み付け統合された値が最適(たとえば、最小)な目標配置の組合せを決定する。
この場合、重み付け統合後の推定誤差指標値は、たとえば、以下の式(13)、(14)のように算出される。
【0033】
【数14】
【0034】
以下、重み付け統合後の推定誤差指標値の集合Σall_weightedを形成し、この集合の中から、以下の式(15)を満たすような組合せeopt(最適な目標配置)を選出する。
【0035】
【数15】
【0036】
最後に、ステップS13において、推定誤差指標値の集合Σallの中で、推定誤差指標値が最小値を示す目標位置の組合せを選出する。このとき、各変数毎に推定誤差指標値が存在するので、目的に応じてその重要度をユーザが決定し、最適な目標配置eoptを決定する。
【0037】
このように、目標を自由に静止配置できる場合には、事前に推定誤差指標値が最適(たとえば、最小)になる目標配置を高精度に選出することができる。
なお、重み付け統合処理ステップS12は、各目標の配置の組合せに対して複数の推定誤差指標値が得られる場合に、設計の効率化を目的として実行されるが、各目標の配置の組合せに対する推定誤差指標値が単一の場合、または、設計の効率化が要求されない場合には省略してもよい。
【0038】
すなわち、バイアス誤差推定アルゴリズムに必要な目標位置決定方法として、各目標の配置可能領域を設定するステップS1と、各目標の配置可能な三次元領域をグリッド化して三次元位置ベクトル集合Dlを算出するステップS2と、グリッド化された配置領域集合から組合せを生成するステップS3と、全ての組合せについて推定誤差指標値を算出するステップS11と、推定誤差指標値を用いて最適な各目標配置の組合せを決定するステップS13とを設けることにより、ステップS12を実行しなくても、複数の目標配置を事前に決定することができる。
ステップS12を実行しない場合には、ステップS13において、推定誤差指標値の集合Σallを用いて、最適な目標配置が選出される。
【0039】
一方、推定誤差指標値の集合Σallを用いて最適な目標配置の組合せを選択することが難しい場合には、最適な各目標配置の組合せを容易に決定するために、上記各ステップに加えて、各推定誤差指標値を統合するステップとして重み付け統合ステップS12を実行し、複数の目標の配置を事前に決定する。
重み付け統合ステップ12を実行する場合には、ステップS13において、推定誤差指標値の集合Σallからではなく、重み付け統合後の推定誤差指標値の集合Σall_weightの中から、最適な目標位置の組み合わせが求められる。
同様に、推定誤差指標値と最小特異値や地理的情報とを統合する場合(後述する)においても、統合後の値を用いて、最適な目標配置位置が決定される。
【0040】
また、センサの各観測諸元の観測精度が可変である場合には、推定誤差指標値の算出ステップS11において各観測諸元の観測精度の上限および下限を与え、その間を段階的に区切って段階毎の分散値の組合せを用いて推定誤差指標値を算出し、その平均値の集合を推定誤差指標値の集合Σallとして、複数の目標配置を事前に決定する。
さらに、推定誤差指標値として、行列M(=(HTR‐1H)‐1)の対角要素の平方根(σ1、・・・、σ6)を用いたが、他の指標値を用いることもできる。
また、レーダの台数や目標位置決定対象となる目標数は、2個に限らず、必要に応じて任意数だけ設定可能なことは言うまでもない。
【0041】
実施の形態2.
なお、上記実施の形態1では、推定誤差が最小となる目標位置決定方法を示したが、推定誤差が最小の優れた目標配置であっても、その目標配置がたまたま推定値の発散する配置に近い場合には、推定値が発散したり、推定誤差が劣化してしまう可能性がある。
したがって、このような推定値の発散を回避するために、推定誤差指標値マップと最小特異値マップとを併用することにより、発散を防ぎつつ、推定精度の優れた目標配置を決定してもよい。
【0042】
また、目標が飛行物体(飛行機、ヘリコプタ、気球など)の場合には、地理的制約などによって飛行禁止領域となる場合や、目標どうしの衝突危険領域となる場合、または、その他の条件で目標配置に制約がある場合に、これらの地理的情報を反映させることが望ましい。
そこで、上記地理的情報を推定誤差指標値と統合することにより、さらに安全な位置に目標を配置してもよい。
以下、上記条件に鑑みて、最小特異値マップおよび地理的情報を併用したこの発明の実施の形態2について説明する。
【0043】
図2はこの発明の実施の形態2による処理手順を示すフローチャートであり、ステップS1〜S3およびS11〜S13は、前述(図1参照)と同様の処理を示している。
この場合、前述の重み付け統合処理(ステップS12)に続いて、最小特異値との統合処理(ステップS14)と、地理的情報との統合処理(ステップS15)とが実行される。
【0044】
まず、前述と同様に、ステップS1〜S3、S11において、推定誤差指標値を算出し、必要に応じて、ステップS12において重み付け統合推定誤差指標値を算出する。
【0045】
次に、ステップS14において、最小特異値集合Λallとの統合を行う。
ステップS14における統合処理としては、たとえば第1の方法として、最小特異値が或る値以下の(発散の起こり易い)目標配置の場合を、推定誤差指標値の集合Σallから取り除いてしまう方法が考えられる。または、第2の方法として、最小特異値と推定誤差指標値との重み付け統合を行うことが考えられる。これらの統合方法により、最小特異値が小さい(発散の起こり易い)目標配置が、後述の目標配置選択処理(ステップ13)で選出されないようにする。
【0046】
次に、ステップS15において、地理的情報との統合を行う。
ステップS15における統合処理としては、たとえば第1の方法として、地理的情報により目標配置不可の領域を、推定誤差指標値の集合Σallから取り除いてしまう方法が考えられる。または、第2の方法として、地理的情報と推定誤差指標値との重み付け統合を行うことが考えられる。これらの方法により、たとえば、地理的制約の所定レベルよりも大きい目標配置が、以下の目標配置選択処理(ステップ13)で選出されないようにする。
すなわち、地理的情報に基づく制約が統合され、たとえば地理的制約が大きい目標配置位置を除いた組合せの中から、最適な配置位置の組合せが決定されることになる。
【0047】
最後に、ステップS13において、上記ステップS14およびS15による統合処理後の推定誤差指標値が最適となるような目標配置を選出する。
このように、事前に推定誤差が最適となるような目標配置を選出するときに、推定精度の優れた配置が発散可能性の高い配置の近傍に位置する可能性がある場合でも、最小特異値および推定誤差指標値を統合する(ステップS14)ことにより、発散する配置を除外した上で最適な目標配置を選出する(ステップS13)ことができる。
また、地理的条件(または、運用条件)の情報を統合して(ステップS15)、地理的条件(または、運用条件)などによる目標の配置が望ましくない位置を除外することにより、上記制約を考慮した目標配置の決定が可能となる。
【0048】
すなわち、最適な目標配置を決定する際に、地理的情報(地理的制約による飛行禁止領域、目標どうしの衝突危険領域、その他の目標配置の制約など)がある場合には、これらの地理的情報を反映するために、ステップS15において地理的情報と推定誤差指標値とを統合することにより、安全な位置に複数の目標配置を事前に決定することができる。
【0049】
なお、最小特異値および地理的情報の統合処理を併用したが、いずれか一方のみの統合処理を実行してもよい。
たとえば、最適な目標配置を決定する際に、推定精度が優れている目標配置であっても、その配置が、たまたま推定値の発散する配置に近い場合には、推定値が発散(または、推定誤差が劣化)してしまう可能性があるため、最小特異値との統合ステップ14を実行して、最小特異値マップと推定誤差指標値マップとを併用することにより、発散を防ぎつつ、推定精度の優れた複数の目標配置を事前に決定することができる。
【0050】
実施の形態3.
なお、上記実施の形態2、3では、最適な目標の配置を事前に決定したが、既に目標が飛行している場合には、その飛行経路に基づく目標位置をリアルタイムに決定してもよい。
以下、目標位置をリアルタイムに決定したこの発明の実施の形態3について説明する。
図3はこの発明の実施の形態3による処理動作を示す説明図であり、図4はこの発明の実施の形態3による処理手順を示すフローチャートである。
【0051】
図3においては、2つのレーダ1、2で2つの目標C1、C2を検知する場合を示しており、目標C1、C2の位置する領域は、各時刻tk、tk+1、tk+2において刻々と移動する。
図3において、各目標C1、C2は、直接に、または、各レーダ1、2を介して、相互に情報交換を行い、推定誤差指標値を用いて逐次的に飛行航路を決定する。
また、目標C1、C2毎に、各時刻tk、tk+1、tk+2における到達可能領域の推定誤差指標値マップを形成し、各時刻における推定誤差指標値が最適となる各目標C1、C2の位置が選択されて決定される。
【0052】
図4において、ステップS11〜S15は、前述(図2参照)と同様の処理であり、ステップS22およびS23は、それぞれ、各ステップS2およびS3に対応している。
この場合、前述のステップS1に代えて、各目標の現時刻における運動諸元の入力処理(ステップS16)と、各目標が次時刻に到達可能な位置領域(可能配置領域)の算出処理(ステップS17)とが実行される。
また、目標位置選出ステップS13に続いて、図4の処理終了条件を満たすか否かの判定処理(ステップS18)が実行され、終了条件を満たさない場合には、現時刻tkから次の時刻tk+1への更新処理ならびに決定された目標位置への目標の移動飛行処理(ステップS19)が実行された後に、運動諸元入力ステップS16に戻る。
【0053】
まず、ステップS16において、各目標の現時刻tkにおける位置、速度および加速度などの運動諸元を取得する。
続いて、ステップS17において、各目標の運動能力を考慮して、各目標が次の時刻tk+1に到達でき得る位置領域(可能配置領域)を算出する。
たとえば、運動能力情報として、各目標の各軸(xyz)方向に対する最小加速度axlmin、aylmin、azlminおよび最大加速度axlmax、aylmax、azlmaxが与えられたとすると、これらを各軸についてグリッド間隔Δaxl、Δayl、Δazl、(l=1、…、L)を設定し、以下の式(16)のように分割する。
【0054】
【数16】
【0055】
また、分割された各軸の点の集合から1点ずつ選出することにより、全ての組合せを作成し、三次元加速度ベクトルの集合を生成する。この三次元加速度ベクトルの集合をAGl(l=1、…、L)と称する。
以下、三次元加速度ベクトル集合AGl内の各加速度ベクトルalを用いて、目標lの次の時刻tk+1にとり得る位置の集合を算出することができる。
たとえば、目標lが次の時刻tk+1にとり得る位置は、三次元加速度ベクトル集合AGlの各加速度ベクトルalに対する運動方程式を用いて、以下の式(17)のように表される。
【0056】
【数17】
【0057】
ただし、式(17)において、dl,k+1、dl,kは、それぞれ、時刻tk+1およびtkにおける目標lの位置ベクトルであり、vl,kは、時刻tkにおける目標lの速度ベクトルである。
式(17)により求められる運動諸元(目標位置)を、全ての三次元加速度ベクトル集合AGl内の要素について算出し、次の時刻tk+1にとり得る三次元位置ベクトルの集合Dl(l=1、…、L)を算出する。ここで、三次元位置ベクトル集合Dl(l=1、…、L)は、「三次元位置の空間」とも称される。
【0058】
次に、前述と同様に、ステップS22およびS23において、三次元位置ベクトル集合Dl(l=1、…、L)を用いて、位置ベクトルの組合せ集合Eallを定義するとともに、ステップS11、S12、S14、S15およびS13において、統合された推定誤差指標値が最小となるような各目標の位置を選出する。
【0059】
最後に、ステップS18において、図4の処理ルーチンの終了条件を満たすか否かを、たとえば、与えられた時刻Tendと元の時刻tkとを比較して、tk>Tend(時刻tkが時刻Tendを経過)の関係を満たすか否かにより、判定する。
ステップS18において、tk>Tend(すなわち、yes)と判定されれば、図4の処理ルーチンを終了し、tk≦Tend(すなわち、no)と判定されれば、ステップS19において、時刻が更新されるとともに、得られた位置への目標の移動が行われ、再びステップS16に戻り、同様の処理を繰り返す。
【0060】
なお、上記方法は、たとえば、多数の目標のうちの数個のみの移動経路を決定する場合も有効である。また、上記方法によれば、目標の移動経路を各時刻tkの運動諸元に基づいて決定し、次の時刻tk+1での目標の飛行経路を決定することができるうえ、各目標の位置や速度などの初期運動諸元のみを与えることにより、飛行計画を立てることができる。
このように、目標が自由に移動できる場合、推定誤差指標値が最適(たとえば、最小)となるような移動経路をリアルタイムに生成することができる。
【0061】
すなわち、上記各ステップS22、S23、S11〜S15に加え、各目標の現時刻における運動諸元の入力ステップS16と、各目標が次時刻に到達可能な位置領域の算出ステップS17と、処理を終了するか否かを判定するステップS18と、時刻の更新および目標位置への目標移動飛行ステップS19とを設けることにより、複数の目標移動経路(飛行経路)をリアルタイムに決定することができる。
なお、上記実施の形態3においても、重み付け統合ステップS12、最小特異値統合ステップS14、または、地理的情報統合ステップS15は、それぞれ、必要に応じて実行されるが、省略することもできる。
【0062】
【発明の効果】
以上のように、この発明によれば、三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、複数の目標が配置され得る三次元領域を可能配置領域として指定する配置領域設定ステップと、可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、可能配置領域集合から目標毎に、三次元位置ベクトルのうちの1ベクトルずつ選出して組合せを生成するとともに、組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、推定誤差指標値が最小値を示す目標位置の組合せを、各目標の最適な配置位置の組合せとして決定する目標位置選出ステップとを備え、各目標が配置される前に各目標の配置位置を決定するようにしたので、推定精度の高い目標配置を事前に決定することのできるセンサバイアス誤差推定用の目標位置決定方法が得られる効果がある。
【0063】
また、この発明によれば、三次元領域内の目標を検知する複数のセンサの設置誤差をバイアス誤差として推定するために、複数の目標の配置位置を決定する方法であって、各目標の現時刻における運動諸元を取り込む運動諸元入力ステップと、運動諸元に基づいて各目標が次の時刻に到達可能な位置領域を可能配置領域として算出する可能配置領域算出ステップと、可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、可能配置領域集合から目標毎に、三次元位置ベクトルのうちの1ベクトルずつ選出して組合せを生成するとともに、組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、推定誤差指標値が最小値を示す目標位置の組合せを、各目標の最適な配置位置の組合せとして決定する目標位置選出ステップと、処理終了条件を満たすか否かを判定する終了判定ステップと、処理終了条件が満たされない場合に、現時刻から次の時刻に更新するとともに、決定された目標位置に目標を移動飛行させる時刻更新および目標移動ステップとを備え、各目標の移動経路を現時刻毎にリアルタイムに決定するようにしたので、推定精度の高い目標配置を決定して、飛行中の目標に対しても推定精度が高くなる移動経路をリアルタイムに決定することのできるセンサバイアス誤差推定用の目標位置決定方法が得られる効果がある。
【図面の簡単な説明】
【図1】 この発明の実施の形態1を示すフローチャートである。
【図2】 この発明の実施の形態2を示すフローチャートである。
【図3】 この発明の実施の形態3における時刻毎の目標位置を示す説明図である。
【図4】 この発明の実施の形態3を示すフローチャートである。
【図5】 従来のセンサバイアス誤差推定用の目標位置決定方法に基づくセンサ設置誤差補正処理を示す説明図である。
【図6】 従来のセンサバイアス誤差推定アルゴリズムを示す説明図である。
【図7】 従来のセンサバイアス誤差推定用の目標位置決定方法を示すフローチャートである。
【符号の説明】
1、2 レーダ(センサ)、C1、C2 目標、S1 配置領域設定ステップ、S2、S22 配置領域グリッド化ステップ、S3、S23 目標位置組合せステップ、S11 誤差指標値算出ステップ、S12 重み付け統合ステップ、S13 目標位置選出ステップ、S14 最小特異値統合ステップ、S15 地理的情報統合ステップ、S16 運動諸元入力ステップと、S17 可能配置領域算出ステップ、S18 終了判定ステップ、S19 時刻更新および目標移動ステップ。[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 (
In FIG. 5,
In the display examples of the
[0005]
In this case, when the observation value data B1 and B2 from the two
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
[0006]
In FIG. 6, each of the
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
However, the estimation accuracy of the bias error estimated
[0007]
That is, in order to execute the
(1) The bias error estimated
(2) The relationship between the relative arrangement and the estimation accuracy of the bias error estimated
[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
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 1 , Y 1 , Z 1 ) 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
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
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 (σ 1 , Σ 2 , ..., σ 5 , Σ 6 ) 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 (σ 1 , Σ 2 , ..., σ 5 , Σ 6 ) 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
For example, even if an arrangement having the smallest estimated error index value for the distance of the
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
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 (σ 1 , ..., σ 6 ), 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]
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
[0050]
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
In FIG. 3, the targets C1 and C2 exchange information with each other directly or via the
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
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
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
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 (8)
前記複数の目標が配置され得る三次元領域を可能配置領域として指定する配置領域設定ステップと、
前記可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、
前記可能配置領域集合から前記目標毎に、三次元位置ベクトルのうちの1ベクトルずつ選出して組合せを生成するとともに、前記組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、
前記全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、
前記推定誤差指標値が最小値を示す目標位置の組合せを、前記各目標の最適な配置位置の組合せとして決定する目標位置選出ステップとを備え、
前記各目標が配置される前に前記各目標の配置位置を決定することを特徴とするセンサバイアス誤差推定用の目標位置決定方法。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.
前記各目標の現時刻における運動諸元を取り込む運動諸元入力ステップと、
前記運動諸元に基づいて前記各目標が次の時刻に到達可能な位置領域を可能配置領域として算出する可能配置領域算出ステップと、
前記可能配置領域をグリッド化して得られる三次元位置ベクトルの集合を可能配置領域集合として算出する配置領域グリッド化ステップと、
前記可能配置領域集合から前記目標毎に、三次元位置ベクトルのうちの1ベクトルずつ選出して組合せを生成するとともに、前記組合せを繰り返して、全ての組合せを生成する目標位置組合せステップと、
前記全ての組合せについて、ずれ量に対応する推定誤差指標値を算出する誤差指標値算出ステップと、
前記推定誤差指標値が最小値を示す目標位置の組合せを、前記各目標の最適な配置位置の組合せとして決定する目標位置選出ステップと、
処理終了条件を満たすか否かを判定する終了判定ステップと、
前記処理終了条件が満たされない場合に、前記現時刻から次の時刻に更新するとともに、決定された目標位置に目標を移動飛行させる時刻更新および目標移動ステップとを備え、
前記各目標の移動経路を前記現時刻毎にリアルタイムに決定することを特徴とするセンサバイアス誤差推定用の目標位置決定方法。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.
前記可能配置領域集合から選出された全ての組合せ要素に対して、観測行列Hおよび行列Rを評価して、以下の式、
М=(НTR−1Н)−1
により行列Мを計算するとともに前記行列Mの対角要素を算出し、前記行列Mの対角要素の平方根を前記推定誤差指標値として算出することを特徴とする請求項1または請求項2に記載のセンサバイアス誤差推定用の目標位置決定方法。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.
前記目標位置選出ステップは、重み付け統合処理後の推定誤差指標値に基づいて、前記最適な配置位置の組合せを決定することを特徴とする請求項1から請求項3までのいずれか1項に記載のセンサバイアス誤差推定用の目標位置決定方法。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.
前記平均値算出ステップは、
前記センサによる前記目標の各観測諸元の観測精度が可変である場合に、前記各観測諸元の観測精度の分散値変動範囲を与えて、前記分散値変動範囲を段階的に区切り、
段階毎の分散値の組合せを用いて推定誤差指標値を算出するとともに、前記段階毎の推定誤差指標値の平均値の集合を前記推定誤差指標値の集合として算出することを特徴とする請求項1から請求項4までのいずれか1項に記載のセンサバイアス誤差推定用の目標位置決定方法。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.
前記目標位置選出ステップは、前記最小特異値が0に近い目標配置位置を除いた組合せの中から、前記各目標の最適な配置位置の組合せを決定することを特徴とする請求項1から請求項5までのいずれか1項に記載のセンサバイアス誤差推定用の目標位置決定方法。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.
前記目標位置選出ステップは、前記地理的制約を統合した組合せの中から、前記最適な配置位置の組合せを決定することを特徴とする請求項1から請求項6までのいずれか1項に記載のセンサバイアス誤差推定用の目標位置決定方法。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.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002276850A JP4108424B2 (en) | 2002-09-24 | 2002-09-24 | Target position determination method for sensor bias error estimation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2002276850A JP4108424B2 (en) | 2002-09-24 | 2002-09-24 | Target position determination method for sensor bias error estimation |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2004117017A JP2004117017A (en) | 2004-04-15 |
JP4108424B2 true JP4108424B2 (en) | 2008-06-25 |
Family
ID=32272613
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002276850A Expired - Fee Related JP4108424B2 (en) | 2002-09-24 | 2002-09-24 | Target position determination method for sensor bias error estimation |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4108424B2 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105911497A (en) * | 2016-06-15 | 2016-08-31 | 国网北京市电力公司 | Correction method and device for partial discharge positioning error |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006007940A (en) * | 2004-06-24 | 2006-01-12 | Fujitsu Ltd | Calibration method of radar device, radar device, monitoring system, and program |
JP5094195B2 (en) * | 2006-04-20 | 2012-12-12 | 三菱電機株式会社 | System wake measurement device and wake assignment / wake error correction processing method |
JP4804371B2 (en) * | 2007-01-18 | 2011-11-02 | 三菱電機株式会社 | Sensor bias error estimation device |
JP6872917B2 (en) * | 2017-02-02 | 2021-05-19 | 株式会社デンソーテン | Radar device and target detection method |
CN114323035A (en) * | 2020-09-30 | 2022-04-12 | 华为技术有限公司 | Positioning method, device and system |
-
2002
- 2002-09-24 JP JP2002276850A patent/JP4108424B2/en not_active Expired - Fee Related
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105911497A (en) * | 2016-06-15 | 2016-08-31 | 国网北京市电力公司 | Correction method and device for partial discharge positioning error |
Also Published As
Publication number | Publication date |
---|---|
JP2004117017A (en) | 2004-04-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7233859B2 (en) | Method and device for planning a trajectory | |
JP6239664B2 (en) | Ambient environment estimation apparatus and ambient environment estimation method | |
KR101831028B1 (en) | Method and apparatus for relocation of mobile robot in indoor environment | |
CN110889808B (en) | Positioning method, device, equipment and storage medium | |
CN111638526B (en) | Method for robot to automatically build graph in strange environment | |
CN110146909A (en) | A kind of location data processing method | |
CN105704652B (en) | Fingerprint base acquisition and optimization method in a kind of positioning of WLAN/ bluetooth | |
US7489255B2 (en) | Self-position identification apparatus and self-position identification method | |
US20020183922A1 (en) | Route planner with area avoidance capability | |
JP2016109650A (en) | Position estimation system, position estimation method, and position estimation program | |
JP2014523572A (en) | Generating map data | |
JP7034353B2 (en) | Positioning system and positioning method | |
CN112904358B (en) | Laser positioning method based on geometric information | |
KR20220058901A (en) | Data processing methods and devices | |
JP4108424B2 (en) | Target position determination method for sensor bias error estimation | |
CN110608742A (en) | Map construction method and device based on particle filter SLAM | |
CN114608585A (en) | Method and device for synchronous positioning and mapping of mobile robot | |
CN109769206B (en) | Indoor positioning fusion method and device, storage medium and terminal equipment | |
CN109903367A (en) | Construct the method, apparatus and computer readable storage medium of map | |
CN109190647B (en) | Active and passive data fusion method | |
WO2024120187A1 (en) | Method for estimating dynamic target of unmanned aerial vehicle in information rejection environment | |
CN115900511B (en) | Nonlinear separable least square-based magnetic dipole target positioning method | |
US20230118390A1 (en) | Method and device for providing tracking data for recognizing the movement of persons and hands for controlling at least one function of a technical system, and sensor system | |
JP3595279B2 (en) | Target position determination method and target movement path determination method in sensor installation error estimation | |
CN114173281B (en) | TOA-based positioning system beacon node optimization layout method in indoor NLOS environment |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050815 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20071012 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20071030 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20071228 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20080304 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20080402 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110411 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120411 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120411 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130411 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130411 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140411 Year of fee payment: 6 |
|
LAPS | Cancellation because of no payment of annual fees |