JP2007309926A - システム航跡測定装置および航跡割当・航跡誤差補正処理方法 - Google Patents
システム航跡測定装置および航跡割当・航跡誤差補正処理方法 Download PDFInfo
- Publication number
- JP2007309926A JP2007309926A JP2007110703A JP2007110703A JP2007309926A JP 2007309926 A JP2007309926 A JP 2007309926A JP 2007110703 A JP2007110703 A JP 2007110703A JP 2007110703 A JP2007110703 A JP 2007110703A JP 2007309926 A JP2007309926 A JP 2007309926A
- Authority
- JP
- Japan
- Prior art keywords
- wake
- track
- remote
- local
- group
- 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.)
- Granted
Links
Images
Landscapes
- Radar Systems Or Details Thereof (AREA)
Abstract
【解決手段】ローカル航跡とリモート航跡のペアで航跡の組合せを作成し、各組合せの航跡ペアの差分を取って、組合せごとに算出したペアの差分の2乗和の最小値を1つ選択し、その最小値に対応する組合せを航跡割当とし、またペアの差分の2乗の頻度分布の最頻値の中から航跡バイアス誤差分散を算出する航跡割当処理部と、ローカル航跡とリモート航跡の航跡ランダム誤差分散と、航跡バイアス誤差分散に基づいて航跡バイアス誤差を算出する航跡誤差推定処理部と、航跡バイアス誤差分に基づいて補正した補正したリモート航跡とローカル航跡を重み付け統合してシステム航跡を生成する航跡統合処理部を備える。
【選択図】図1
Description
図42は、複数のセンサL,Aで同時に複数の目標T1,T2を観測している状況を表す。ローカルセンサLとリモートセンサAとしては、レーダ、IR(Infrared Ray)センサ、EW(Electronic Warfare)等のセンサを想定している。ローカルセンサL、リモートセンサAは、いずれも自身で追尾処理を行うことを前提とする。ローカルセンサLは、今、観測ビームLB1により観測し、得られた目標T1の観測値を用いてその航跡LB1T1を生成している。また、リモートセンサAは、観測ビームAB1により観測し、得られた目標T1と目標T2の観測値を用いて航跡AB1T1と航跡AB1T2を生成している。
まず、目標T1、目標T2をそれぞれ、ローカルセンサLの持つ観測ビームLB1、リモートセンサの持つ観測ビームAB1で観測する。その結果、ローカルセンサLでは、航跡LB1T1、リモートセンサAでは、リモート航跡AB1T1とリモート航跡AB1T2が得られたとする。フュージョンセンタ3では、得られたローカル航跡LB1T1、リモート航跡AB1T1とAB1T2から、同一航跡判定の候補となるペアを作成する。この同一航跡判定の候補となるペア作成のことを以降、「航跡割当」と呼ぶこととする。そして、同一航跡と判定されたペアについては統合し、システム航跡を作成する。この場合、理想的には、ローカル航跡LB1T1とリモート航跡AB1T1が同一航跡と判定した後に、その2航跡を統合してできるシステム航跡と、リモート航跡AB1T2のみからなるシステム航跡の計2つのシステム航跡ができることが望ましい。
図1はこの発明の実施の形態1によるシステム航跡測定装置の機能構成を示すブロック図である。
図1において、センサ10は、レーダ、IRセンサ等で構成され、ローカルセンサ、リモートセンサからなる複数台のセンサを表すものとする。システム航跡測定装置は、航跡割当処理部20、航跡誤差推定処理部30、航跡統合処理部40、表示処理部50を備えている。
センサ10は、各センサ自身で、目標および誤目標などを含んだ観測値を取得して、センサ航跡(ローカル航跡、リモート航跡)をそれぞれ生成し、それらのセンサ航跡を航跡割当処理部20に入力する。航跡割当処理部20では、センサ10から得られるローカル航跡とリモート航跡のペアを作成し、このペアを組み合わせて航跡の組合せを作成する。この場合、航跡の組合せは全ての可能性を考えて作成される。
ペアP1(L1−R1)
ペアP2(L1−R2)
ペアP3(L1−R3)
ペアP4(L2−R1)
ペアP5(L2−R2)
ペアP6(L2−R3)
ペアP7(L3−R1)
ペアP8(L3−R2)
ペアP9(L3−R3)
さらに、これらのペアを用いて作成できる航跡の組合せは、下記のようにC1〜C6の6通りとなる。
組合せC1[(L1−R1),(L2−R2),(L3−R3)]
組合せC2[(L1−R1),(L2−R3),(L3−R2)]
組合せC3[(L1−R2),(L2−R1),(L3−R3)]
組合せC4[(L1−R2),(L2−R3),(L3−R1)]
組合せC5[(L1−R3),(L2−R1),(L3−R2)]
組合せC6[(L1−R3),(L2−R2),(L3−R1)]
σλC1=(ΔλL1−R1)2 +(ΔλL2−R2)2 +(ΔλL3−R3)2
σλC2=(ΔλL1−R1)2 +(ΔλL2−R3)2 +(ΔλL3−R2)2
σλC3=(ΔλL1−R2)2 +(ΔλL2−R1)2 +(ΔλL3−R3)2
σλC4=(ΔλL1−R2)2 +(ΔλL2−R3)2 +(ΔλL3−R1)2
σλC5=(ΔλL1−R3)2 +(ΔλL2−R1)2 +(ΔλL3−R2)2
σλC6=(ΔλL1−R3)2 +(ΔλL2−R2)2 +(ΔλL3−R1)2
例えば、組合せC3[(L1−R2),(L2−R1),(L3−R3)]の各ペア(L1−R2)、(L2−R1)、(L3−R3)の差分の2乗は、(ΔλL1−R2)2 、(ΔλL2−R1)2 、(ΔλL3−R3)2 である。この中で、差分の2乗のある区間を決めて、最頻値を算出する。
航跡割当処理部20は、最終的に、最頻値(Δλmode)2 を航跡バイアス誤差分散として、航跡誤差推定処理部30へ出力する。また、航跡割当処理部20からは、航跡割当結果も航跡誤差推定処理部30へ出力する。
表示処理部50では、航跡統合処理部40から入力されるシステム航跡、ローカル航跡、リモート航跡を、オペレータに表示する。ここで、システム航跡の管理番号、ローカル航跡の管理番号、リモート航跡の管理番号を基に、システム航跡がどのローカル航跡およびリモート航跡と関連を持っているかを考慮してオペレータに表示する。
まず、処理が開始されると、航跡割当処理部20において、ローカルセンサからローカル航跡、リモートセンサからリモート航跡をそれぞれ取得する(ステップST1)。次に、ローカル航跡とリモート航跡のペアおよび組合せを作成する(ステップST2)。作成した組合せ毎に、ペアの差の2乗和を計算する(ステップST3)。組合せ毎に計算した、ペアの差の2乗和の最小値を選択する(ステップST4)。次に、ペアの差の2乗和の最小値に基づく組合せを航跡割当結果と決定する(ステップST5)。そして、航跡割当結果におけるペアの差の2乗の頻度分布より最頻値を算出し(ステップST6)、航跡割当結果におけるペアの差の2乗の最頻値を、航跡バイアス誤差の分散と決定する(ステップST7)。
図5はこの発明の実施の形態2によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態2は、実施の形態1の構成に対して組合せ制限制御部60を新たに設けたものである。
組合せ制限制御部60で行う制御の説明に用いる、ローカル航跡とリモート航跡の関係を図6および図7に示す。これらの図6および図7はいずれも図2のシナリオ例を基にしたものである。ここで、図2のシナリオ例では、ローカル航跡L1とリモート航跡R1が同一目標からの航跡を、ローカル航跡L2とリモート航跡R2が同一目標からの航跡を、さらに、ローカル航跡L3とリモート航跡R3が同一目標からの航跡を表すものと仮定する。つまり、ローカル航跡とリモート航跡の真のペアが(L1−R1)、(L2−R2)、(L3−R3)となるものとしている。また、図6および図7の標記で、四角点線はローカル航跡L1、L2、L3を含むローカル航跡群を表し、楕円点線はリモート航跡R1、R2、R3を含むリモート航跡群を表す。また、図6の片矢印はリモート航跡をローカル航跡に合わせ込むこと(合わせ込む処理を「シフト」と呼ぶこととする。)を表し、図7の両矢印はローカル航跡とリモート航跡の差を表すものとする。
図10はこの発明の実施の形態3によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態3は、実施の形態1の構成に対して航跡誤差算出制御部70を新たに設けたものである。
航跡誤差算出制御部70で行う制御を説明するための、ローカル航跡群の重心とリモート航跡群の重心の関係を図11に示す。図11において、ローカル航跡群(ローカル航跡L1〜L3)の重心Lgを○印で表し、リモート航跡群(リモート航跡R1〜R3)の重心Rgを□印で表す。また、両矢印は、ローカル航跡群の重心Lgとリモート航跡群の重心Rgの差分を表す。
図12はこの発明の実施の形態4によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態4は、実施の形態1の構成に対して、新たに組合せ結果DB(データベース)90を設けたものである。
組合せ結果DB90は、航跡割当処理部20で行った、各時刻におけるローカル航跡とリモート航跡の組合せの全結果、およびその全結果に基づくローカル航跡とリモート航跡のペアの差分の2乗を保持する手段である。
図13はこの発明の実施の形態5によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態5は、実施の形態1の構成に対して粗ゲート制御部110を新たに設けたものである。
ローカル航跡とリモート航跡の組合せ単位のクラスタ化と、この実施の形態5により処理を行う単位の粗ゲート化の例を図14に示す。図14が示す状態は、ローカル航跡をL1、L2、L3、リモート航跡をR1、R2、R3の3航跡とし、航跡L3、R3が、他の航跡L1、R1、L2、R2から十分距離が離れていることを想定している。
図15はこの発明の実施の形態6によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態6は、実施の形態1の構成に対して航跡数制限制御処理部120を新たに設けたものである。
航跡数制限制御処理部120では、センサ10から入力されるセンサ航跡に含まれる目標位置ベクトルおよび目標速度ベクトルに基づいて目標の現在位置および移動方向を算出し、予め地理的に決めておいた評価点に向かっているローカル航跡およびリモート航跡をのみを、航跡割当処理部20における処理対象のセンサ航跡として抽出する処理を行う。そして、その処理対象のセンサ航跡を航跡割当処理部20に入力することで、航跡割当処理部20が対象となるローカル航跡およびリモート航跡に対して所定の処理を行う。
図16はこの発明の実施の形態7によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態7は、実施の形態1の構成に対して航跡バイアス誤差オイラー角制御部130を新たに設けたものである。
この実施の形態7で行う、回転角から航跡バイアス誤差を推定する方法を図17に示す。図17において、実線で示されるx−y−zはローカルセンサの直交座標、点線で示されるx’−y’−z’はリモートセンサの直交座標である。ここで、ローカルセンサの直交座標の変換座標がリモートセンサの直交座標とみなした場合、z’軸は、x軸周りの回転角dxを与えた場合のz軸を表し、y’軸はx軸周りの回転角dyを与えた場合のy軸を表す。この場合、回転角(オイラー角)は航跡バイアス誤差として推定することができる。
図18はこの発明の実施の形態8によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態8は、実施の形態1の構成に対して航跡バイアス誤差直交座標制御部140を新たに設けたものである。
この実施の形態8で行う、航跡バイアス誤差を推定する方法を図19に示す。図19において、実線で示されるx−y−zはローカルセンサの直交座標、点線で示されるx’−y’−z’はリモートセンサの直交座標である。ローカル航跡位置を[x,y,z]、リモート航跡位置を[x’,y’,z’]としたとき、ローカル航跡位置とリモート航跡位置には、x=x’+δx、y=y’+δy、z=z’+δzの関係があることになる。すなわち、リモートセンサの直交座標は、ローカルセンサの直交座標に対してバイアス誤差[δx、δy、δz]を持つ座標ということになる。したがって、この直交座標のバイアス誤差は、求めるべき航跡バイアス誤差とみなすことができる。
図20はこの発明の実施の形態9によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態9は、実施の形態1の構成に対して航跡バイアス誤差極座標制御部150を新たに設けたものである。
この実施の形態9で行う、航跡バイアス誤差を推定する方法を図21に示す。
図21において、実線で示されるx−y−zはローカルセンサの直交座標、点線で示されるx’−y’−z’はリモートセンサの直交座標である。ここで、ローカル航跡およびリモート航跡を極座標表示で表すと、ローカル航跡位置を[R,E,Az]、リモート航跡位置を[R’,E’,Az’]とすると、ローカル航跡位置とリモート航跡位置には、R=R’+δR、E=E’+δE、Az=Az’+δAzの関係があることになる。すなわち、リモートセンサの極座標は、ローカルセンサの極座標に対してバイアス誤差[δR、δE、δAz]を持つ座標であるということができる。したがって、この極座標のバイアス誤差は、求めるべき航跡バイアス誤差とみなすことができる。
図22はこの発明の実施の形態10によるシステム航跡測定装置の機能構成を示すブロック図である。図において、上記図1に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態10は、実施の形態1で用いた航跡割当処理部20および航跡誤差推定処理部30に代えて、それぞれ異なる処理を行う航跡割当処理部202および航跡誤差推定処理部302を設けたものである。
ここでは、複数のローカル航跡の集合をローカル航跡群(以下、ローカル航跡群L、あるいは単に航跡群Lと呼ぶ)とし、また、リモート航跡の集合をリモート航跡群(以下、リモート航跡群R、あるいは単に航跡群Rと呼ぶ)とする。また、ローカル航跡とリモート航跡の対をペアと呼び、ペアの集合を組合せと呼ぶ。組合せに関しては、ペアが成立しない場合、例えば、ローカル航跡群とリモート航跡群の航跡数が異なる場合に、ローカル航跡またはリモート航跡の一方しかない場合も組合せの数として含まれるものとする。
航跡割当処理部202では、まず、ローカル航跡のそれぞれを中心としたゲート内に、リモート航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量ρを設定し、設定した航跡シフト量分だけリモート航跡群をローカル航跡群にシフトさせて、ローカル航跡とリモート航跡のペアをN個(Nは0以上の整数)以上含む組合せを抽出する。説明上、「ローカル航跡のそれぞれを中心としたゲート内にリモート航跡のいずれかがペアとなるように最大限入れるようにする」という内容で説明を行うが、これは、逆に「リモート航跡のそれぞれを中心としたゲート内にローカルのいずれかがペアとなるように最大限入れるようにする」という内容にすることもできる。つまり、以降の説明において、特に断りのない限り、リモートをローカル、ローカルをリモートに置き換えても処理が可能であることを前提としたものである。また、航跡シフト量ρは、説明上、図および文章の中においてスカラー表現で記載するが、多次元のベクトルでもよい。例えば、極座標の場合の航跡シフト量は、距離、仰角、方位角からなる3次元のベクトルで定義してもよいし、あるいは、距離、仰角からなる2次元のベクトル、距離、方位角からなる2次元のベクトル、仰角、方位角からなる2次元のベクトル、そして、距離の1次元のスカラー、仰角の1次元のスカラー、方位角の1次元のスカラーで定義してもよい。直交座標、オイラー角などの他の座標系でも同様である。また、極座標での航跡シフト量、直交座標での航跡シフト量を結合したベクトルで、新たに航跡シフト量を定義してもよい。
図23(a)の状態において、リモート航跡群Rをローカル航跡群Lに航跡シフト量ρだけシフトさせる。シフトの方法は、例えば、リモート航跡群R中の任意のリモート航跡を、ローカル航跡群L中の任意のローカル航跡に向かって合わせ込むことにより行う。ここでは、リモート航跡群R中のリモート航跡R1を、ローカル航跡群L中のローカル航跡L1に向かって航跡シフト量ρ分シフトさせる様子を示している。シフトを行った後の図23(b)において、ローカル航跡のゲート内にリモート航跡が入るか否かを判定し、ローカル航跡のゲート内に入ったリモート航跡は、ゲートを構成しているローカル航跡と、ゲート内に入ったリモート航跡をペアとみなす。例えば、図23(b)におけるリモート航跡R1はローカル航跡L1のゲート内に入ったので、ローカル航跡L1とリモート航跡R1はペアである。同様に、ローカル航跡L2とリモート航跡R2、ローカル航跡L3とリモート航跡R3もペアである。但し、リモート航跡R4は、どのローカル航跡のゲート内にも入らないため、ペアが成立しない。つまり、図23(b)では、L1とR1、L2とR2、L3とR3の各ペアをペア1、ペア2、ペア3としたとき、ペア1、ペア2、ペア3からなる組合せができたことになる。
次に、航跡割当処理部202では、航跡シフトに応じて決まる、複数個ある組合せの内、ペアがN個(Nは0以上の整数)以上ある場合の組合せを抽出する。一方、ペアがN個以上ある組合せが、1つも得られない場合は、航跡シフト量を再設定し再度シフト処理を行う。
さらに、航跡割当処理部202は、このようにして各組合せで算出したペアの差の2乗和が最小となる組合せを航跡割当結果として計算して後述の航跡誤差推定処理部302に与える。
まず、処理が開始されると、ローカルセンサからローカル航跡、リモートセンサからリモート航跡をそれぞれ取得する(ステップST11)。次に、航跡割当処理部202において、航跡シフト量ρの初期設定を行う(ステップST12)。次に、航跡群L又は航跡群Rのいずれか一方を固定した上で、他方の航跡群全体をシフトさせる。ここでは、以降、航跡群Lを固定して、航跡群Rを航跡シフト量ρ分シフトする例で説明することとする。そして、航跡群Rをシフトした後、航跡群Lのメンバである各ローカル航跡の中に、航跡群Rのメンバである各リモート航跡が、ローカル航跡を中心としたゲート内に入るか否かを調べる。ゲート内に入る場合、ローカル航跡とリモート航跡のペアが成立する。そして、ゲート内にリモート航跡が最大限入る組合せを抽出する(ステップST13)。次に、ゲート内にリモート航跡が最大限入る組合せ中のペアの個数がN個以上かを調べる(ステップST14)。ペアの個数がN個未満の場合、航跡シフト量ρを別な値に再設定を行う処理(ステップST15)を経て、ステップST13の処理を再度行うようにする。一方、ペアの個数がN個以上の場合、組合せ毎に、不当なペアを除いて、ペアの差の2乗和を算出する(ステップST16)。次に、算出した組合せ毎のペアの差の2乗和が最小となる組合せを決定し、航跡割当結果として、ローカル航跡群とリモート航跡群の組合せと共に航跡誤差推定処理部302に出力する(ステップST17)。
図27はこの発明の実施の形態11によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図22に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態11は、実施の形態10で用いた航跡割当処理部202に代えて、一部異なる処理を行う航跡割当処理部203を設けたものである。
航跡割当処理部203における処理について説明する。
航跡割当処理部203では、まず、上記図23および図24を用いて説明した処理を行う。すなわち、航跡群Lを固定した上で、航跡群R全体を航跡シフト量ρ分シフトし、ローカル航跡を中心としたゲート内にリモート航跡が最大個数入る組合せを抽出する。次に、ローカル航跡を中心としたゲート内にリモート航跡が入る個数、つまり、組合せ中のペアがN個(Nは0以上の整数)以上かを調べる。そして、組合せ中のペアがN未満の場合、航跡シフト量ρを再設定する。ここまでは、実施の形態10の航跡割当処理部202と同じである。
ここで、組合せ毎のペアの差の2乗の頻度分布の形状の例を図28に示す。図28(a)は頻度分布が妥当な形状、図28(b)、(c)は頻度分布が不当な形状の例を表す。頻度分布の形状が妥当である場合とは、ローカル航跡とリモート航跡のペアが妥当な場合である。つまり、ローカル航跡とリモート航跡が同一目標からの航跡であると考えられ、組合せ中のどのペアについても、ペアの差が一定となるはずである。そのため、ローカル航跡とリモート航跡のペアが正確に生成されていれば、図28(a)のような頻度分布の形状になるはずである。一方、頻度分布が不当な形状、例えば、図28(b)のように、ペアの差の2乗の頻度の値がどの区間でも一定な場合、また図28(c)図32のように、頻度のピークが複数ある場合は、ローカル航跡とリモート航跡のペア生成が誤っている可能性がある。
頻度分布の形状が妥当な形状を持つ組合せがあり、かつその組合せが複数ある場合には、航跡割当処理部203は、その組合せが持つ頻度分布の形状から頻度の低い不当なペアを除去して、ペアの差の2乗和を算出し、さらに、ペアの差の2乗和が最小となる組合せを抽出し、航跡割当結果として航跡誤差推定処理部302へ送る。
ステップST14の処理において、ゲート内にリモート航跡が最大個数入る組合せ中のペアの個数がN個以上の場合、組合せ毎に、ペアの差の2乗の頻度分布を作成する(ステップSTST141)。次に、組合せ毎のペアの差の2乗の頻度分布が妥当な形状であるかを調べ(ステップST142)、妥当な形状を持つ組合せがない場合は、航跡シフト量ρの再設定を行い(ステップST15)、組合せを再度作成する処理に入る。一方、組合せ毎のペアの差の2乗の頻度分布が不当な形状である場合は、組合せ毎に、不当なペアを除いて、ペアの差の2乗和を算出する(ステップST16)。
図30はこの発明の実施の形態12によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図27に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態12は、実施の形態11で用いた航跡割当処理部203に対して組合せ評価制御部190を設けたものである。
組合せ評価制御部190の処理機能について説明する。
組合せ評価制御部190は、組合せ中に不当な形状のペアがある場合は除去して、各組合せで残った妥当なペアの差の2乗和を算出する航跡割当処理部203の処理として、ペアの差の2乗の頻度分布における最頻値を含む上位α%(αは100以下の正の実数)の範囲に基づいてペアの差の2乗和を算出するよう航跡割当処理部203を制御する手段である。
実施の形態11で説明したように、航跡割当処理部203では、当該設定した航跡シフト量分だけ一方の航跡群(例えば、ローカル航跡群L)に対して他方の航跡群(例えば、リモート航跡群R)をシフトさせてローカル航跡とリモート航跡の対であるペアをN個(Nは0以上の整数)以上含む組合せを抽出して、組合せ毎のペアの差の2乗の頻度分布を算出し、算出したペアの差の2乗の頻度分布の形状から妥当な形状を持つ組合せを取得し、取得したそれぞれの組合せ中に不当な形状のペアがある場合は除去して、各組合せで残った妥当なペアの差の2乗和を算出する処理を行っている。この場合の組合せ毎の頻度分布を用いた不当なペアを除去して、ペアの差の2乗和を算出する処理に、この実施の形態12を適用した概念を図31に示す。
図32はこの発明の実施の形態13によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図22に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態13は、実施の形態11の航跡割当処理部203に代えて、一部異なる処理を行う航跡割当処理部204を設けたものである。
航跡割当処理部204における処理について説明する。
航跡割当処理部204では、まず、航跡群Lを固定した上で、航跡群R全体を航跡シフト量ρ分シフトし、ローカル航跡を中心としたゲート内にリモート航跡が最大個数入る組合せを抽出する。次に、ローカル航跡を中心としたゲート内にリモート航跡が入る個数、つまり、組合せ中のペアがN個(Nは0以上の整数)以上かを調べる。そして、組合せ中のペアがN未満の場合、航跡シフト量ρを再設定する。一方、組合せ中のペアがN個以上のときは、組合せ毎に、ペアの差の2乗の頻度分布を作成する。ここまでは、実施の形態11の航跡割当処理部203と同じである。
次に、実施の形態11の航跡割当処理部203と同様に、取得したそれぞれの組合せ中に不当な形状のペアがある場合は、不当なペアを除いて、ペアの差の2乗和を算出する。そして、不当なペアを除いた組合せから求めたペアの差の2乗和が、最小となる場合の組合せを航跡割当結果として航跡誤差推定処理部302に与える。
ゲート内にリモート航跡が最大個数入る組合せ中のペアの個数がN個以上の場合において、ステップST141の処理では組合せ毎に、ペアの差の2乗の頻度分布を作成するが、作成されたペアの差の頻度分布に複数のピークがある組合せが存在した場合には、この頻度分布の上位2個のピーク差を考慮して、航跡シフト量ρを変化させ、頻度分布を再計算する(ステップST143)。次に、再計算された頻度分布のピークが1個になったかを調べる(ステップST144)。頻度分布のピークが1個になっていない場合は、ステップST143の処理に戻り、頻度分布を再計算する。一方、頻度分布のピークが1個の場合は、組合せ毎に、不当なペアを除いて、ペアの差の2乗和を算出する(ステップST16)。
図35はこの発明の実施の形態14によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図22に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態14は、実施の形態10の航跡割当処理部202に対して航跡シフト量制御処理部210を設けたものである。
次に、航跡シフト量制御処理部210の処理機能について説明する。
航跡シフト量制御処理部210は、ローカル航跡群およびリモート航跡群のいずれか一方(例えば、ローカル航跡群)における航跡のそれぞれを中心としたゲート内に、他方の航跡群(例えば、リモート航跡群)の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群(リモート航跡群)を一方の航跡群(ローカル航跡群)にシフトさせる航跡割当処理部202の処理後において、さらにランダム誤差を考慮した航跡シフト量を設定して、他方の航跡群(リモート航跡群)を、当該ランダム誤差を考慮した航跡シフト量分再シフトさせてから組合せを抽出するよう航跡割当処理部202を制御する手段である。
航跡割当処理部202では、上記実施の形態10で説明したように、ローカル航跡群およびリモート航跡群のいずれか一方で、ローカル航跡またはリモート航跡を中心としたゲート内に他方の航跡群のリモート航跡またはローカル航跡が最大個数入るような航跡シフト量を設定した後、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせてローカル航跡とリモート航跡の対であるペアをN個(Nは0以上の整数)以上含む組合せを抽出する処理を行っている。しかし、リモート航跡群中のリモート航跡をローカル航跡群中のローカル航跡へ合わせ込む処理において、ペアができないケースが生じる場合がある。これは、逆に、ローカル航跡をリモート航跡に合わせ込む場合にも同様に起こる問題である。
今、図36(a)において、R1をL1に合わせこむように航跡シフト量ρを設定し、航跡群Rを航跡群Lにシフトすると、図36(b)に示すように、R1がL1に合わせ込まれる。図36(b)において、R1はL1を中心としたゲートに入っているので、L1とR1をペアとみなす。同様に、R3がL3を中心としたゲートに入っているので、L3とR3をペアとみなす。しかし、R2はL2を中心としたゲートに入っていないので、本来L2とR2はペアとなるべきであるが、ペアとみなされない。このような状況になるのは、ローカル航跡、リモート航跡がそれぞれ、ローカルセンサとリモートセンサが持つランダム誤差、例えば、観測誤差等の影響を受けているからである。
このようなランダム誤差の影響でペアが成立しないケースを改善するには、図36(a)から図36(b)に移る際に設定した航跡シフト量ρに加え、さらに図36(c)に示すように、ランダム誤差を考慮した航跡シフト量Δρを設定して航跡群Rをシフトさせるようにしてやればよい。図36(c)において、図36(b)でペアが成立しなかったL2とR2は、ランダム誤差を考慮した航跡シフト量Δρを設定し、航跡群Rをシフトさせることにより、L2を中心としたゲートにR2を入れることができるようになる。
そのため、航跡シフト制御処理部210では、航跡割当処理部202がリモート航跡をローカル航跡に合せ込むように航跡シフト量ρを設定して航跡群Rをシフトさせた後、さらに、ランダム誤差を考慮した航跡シフト量Δρを設定して航跡群Rを、航跡シフト量Δρ分再度シフトさせて組合せを作成するよう航跡割当処理部202を制御するようにする。
図37はこの発明の実施の形態15によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図22に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態15は、実施の形態10で用いた航跡割当処理部202に対してゲート内航跡選択制御処理部220を設けたものである。
次に、ゲート内航跡選択制御処理部220の処理機能について説明する。
航跡割当処理部202では、ローカル航跡群およびリモート航跡群のいずれか一方(例えば、ローカル航跡群)における航跡のそれぞれを中心としたゲート内に、他方の航跡群(例えば、リモート航跡群)の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群(リモート航跡群)を一方の航跡群(ローカル航跡群)にシフトさせる処理を行っている。ゲート内航跡選択制御処理部220では、航跡割当処理部202の上記処理において、ローカル航跡(またはリモート航跡)を中心としたゲート内にリモート航跡(またはローカル航跡)が複数入った場合、ゲートの中心から最も近いものをペアとなる相手として選択するよう航跡割当処理部202を制御する。
したがって、この実施の形態15によれば、ローカル航跡(またはリモート航跡)を中心としたゲート内にリモート航跡(またはローカル航跡)が複数入った場合、ペアを一意に決めることが可能となる。
図38はこの発明の実施の形態16によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図22に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態16は、実施の形態10で用いた航跡割当処理部202に対して祖ゲート使用航跡数制限処理部230を設けたものである。
次に、祖ゲート使用航跡数制限処理部230の処理機能について説明する。
航跡割当処理部202では、ローカル航跡群およびリモート航跡群のいずれか一方(例えば、ローカル航跡群)における航跡のそれぞれを中心としたゲート内に、他方の航跡群(例えば、リモート航跡群)の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群(リモート航跡群)を一方の航跡群(ローカル航跡群)にシフトさせる処理を行っている。祖ゲート使用航跡数制限処理部230では、航跡割当処理部202の上記処理におけるローカル航跡群中のローカル航跡数およびリモート航跡群中のリモート航跡数を、粗ゲートにより限定するよう航跡割当処理部202を制御する。粗ゲートの中心は、オペレータの指定した中心位置、事前に設定したエリアの中心位置、あるいはシステムで注目目標と判断した目標位置を設定することが考えられる。この粗ゲートにより、ローカル航跡群、リモート航跡群の各航跡数が限定されるため、組合せを生成する演算の低減が図れる。
以上のように、この実施の形態16によれば、粗ゲートにより、ローカル航跡とリモート航跡のペアリングを行うエリアを限定して、ローカル航跡群中のローカル航跡およびリモート航跡群中のリモート航跡の数を絞るようにしたので、組合せを生成する演算時間を低減することが可能となる。なお、祖ゲート使用航跡数制限処理部230を、実施の形態11の航跡割当処理部203あるいは実施の形態13の航跡割当処理部204に対して適用しても同様な効果を奏する。
図39はこの発明の実施の形態17によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図22に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態17は、実施の形態10で用いた航跡割当処理部202に対して航跡群重心使用合わせ込み制御処理部240を設けたものである。
次に、航跡群重心使用合わせ込み制御処理部240の処理機能について説明する。
航跡割当処理部202では、ローカル航跡群およびリモート航跡群のいずれか一方(例えば、ローカル航跡群)における航跡のそれぞれを中心としたゲート内に、他方の航跡群(例えば、リモート航跡群)の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群(リモート航跡群)を一方の航跡群(ローカル航跡群)にシフトさせる処理を行っている。航跡群重心使用合わせ込み制御処理部240では、航跡割当処理部202の上記処理において、航跡群Lおよび航跡群Rのそれぞれの重心を求め、航跡シフト量ρを、航跡群R(または航跡群L)の重心を航跡群L(または航跡群R)の重心に合わせ込む値に設定して、航跡群R(または航跡群L)を航跡群L(または航跡群R)にシフトさせるよう航跡割当処理部202を制御する。航跡群Rの重心および航跡群Lの重心は、航跡群の代表点相当である。そのため、航跡群Rの重心を航跡群Lの重心に合わせ込むことで、航跡群R中の各リモート航跡を航跡群L中の各ローカル航跡に合わせ込む処理数を減すことができる。したがって、組合せを生成するための演算時間の低減を図ることができる。
以上のように、この実施の形態17によれば、両航跡群の重心を用いて合わせ込みを行うようにしたので、組合せ生成に要する演算時間の低減化を可能にする。なお、航跡群重心使用合わせ込み制御処理部240を、実施の形態11の航跡割当処理部203あるいは実施の形態13の航跡割当処理部204に対して適用しても同様な効果を奏する。
図40はこの発明の実施の形態18によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図22に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態18は、実施の形態10で用いた航跡割当処理部202に対して航跡シフト範囲制御処理部250を設けたものである。
次に、航跡シフト範囲制御処理部250の処理機能について説明する。
航跡割当処理部202では、ローカル航跡群およびリモート航跡群のいずれか一方(例えば、ローカル航跡群)における航跡のそれぞれを中心としたゲート内に、他方の航跡群(例えば、リモート航跡群)の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群(リモート航跡群)を一方の航跡群(ローカル航跡群)にシフトさせる処理を行っている。航跡シフト範囲制御処理部250では、航跡割当処理部202の上記処理において、航跡群Lと航跡群Rの最大値および最小値から航跡シフトの範囲を決め、その決めた航跡シフトの範囲内で航跡群のシフトを行わせるよう航跡割当処理部202を制御する。ここで、航跡群Lと航跡群Rの最大値および最小値の決め方は、例えば、航跡バイアス誤差を仮定している座標系における、航跡位置の最大値、最小値などで決める。あるいは、航跡バイアス誤差を定義している座標系以外の座標系で、航跡位置の最大値、最小値を決定してもよい。このように、航跡シフト範囲制御処理部250により航跡シフトの範囲を制限することにより、むやみやたらに航跡シフトを行う手間が省け、結果として、組合せ生成に要する演算時間の低減化を図ることができる。
以上のように、この実施の形態18によれば、航跡群Lと航跡群Rの最大値および最小値から航跡シフトの範囲を決め、その決めた航跡シフトの範囲を限定するようにしたので、航跡群のシフを行う手間、つまり、組合せ生成に要する演算時間の低減が可能となる。なお、航跡シフト範囲制御処理部250を、実施の形態11の航跡割当処理部203あるいは実施の形態13の航跡割当処理部204に対して適用しても同様な効果を奏する。
図41はこの発明の実施の形態19によるシステム航跡測定装置の機能構成を示すブロック図である。図において、図32に相当する部分には同一符号を付し、原則としてその説明は省略する。この実施の形態19は、実施の形態13で用いた航跡割当処理部204に対して航跡シフト各軸制御処理部260を設けたものである。
次に、航跡シフト各軸制御処理部260の処理機能について説明する。
航跡シフト各軸制御処理部260は、組合せ毎のペアの差の2乗の頻度分布に複数のピークがある組合せが存在した場合には、そのピークが1つになるように航跡シフト量を再設定して航跡シフトを行った後、ペアの差の2乗の頻度分布を再計算する航跡割当処理部204の処理において、各軸での航跡シフトの頻度分布のピーク差に応じてそれぞれの軸方向の航跡シフト量を再設定しピークが1つになるよう航跡シフトを行うよう航跡割当処理部204を制御する手段である。
ここで、航跡シフト量ρを定義する座標系は、極座標でも、直交座標でもオイラー角で定義してもよい。また、ベクトルの次元は何次元でもよい。航跡シフト各軸制御処理部260では、航跡シフト量ρとして、例えば直交座標における2次元のベクトルを用いる。つまり、航跡シフトをx軸、y軸で行うことを想定する。
Claims (21)
- ローカルセンサおよびリモートセンサのそれぞれが目標および誤目標などを含んだ観測値から生成した目標の航跡に基づいてシステム航跡を測定するシステム航跡測定装置において、
ローカル航跡とリモート航跡のペアを作成し、作成したペアを組み合わせて航跡の組合せを作成し、各組合せを構成するペアについて差分を取って、組合せごとにペアの差分の2乗和を算出し、算出した差分の2乗和の中から最小値を1つ選択し、当該選択した最小値に対応する組合せを航跡割当とし、次に、算出した航跡割当に対応するペアの差分で、差分の2乗の頻度分布を取り、当該差分の2乗の頻度分布の最頻値の中から航跡バイアス誤差分散を算出する航跡割当処理部と、
前記算出された航跡割当を構成するローカル航跡とリモート航跡の各ペアにおけるローカル航跡の持つ航跡ランダム誤差分散とリモート航跡の持つ航跡ランダム誤差分散、および前記航跡割当処理部で算出された航跡バイアス誤差分散に基づいて、航跡バイアス誤差を算出する航跡誤差推定処理部と、
前記航跡割当処理部で算出された航跡割当結果を構成するローカル航跡とリモート航跡の各ペアについて、前記航跡誤差推定処理部で算出された航跡バイアス誤差分に基づいて補正したリモート航跡を算出し、当該補正したリモート航跡とローカル航跡を、リモート航跡のランダム誤差分散、ローカル航跡の航跡ランダム誤差分散および航跡バイアス誤差分散を考慮して重み付け統合してシステム航跡を生成する航跡統合処理部と、
前記航跡統合処理部から出力されたシステム航跡、ローカル航跡およびリモート航跡を、それぞれの管理番号で関連付けて表示を行う表示処理部を備えたことを特徴とするシステム航跡測定装置。 - リモート航跡群の基準とするリモート航跡を、これに対応するローカル航跡群のローカル航跡に合わせ込む処理を行うことに並行して、前記リモート航跡群とローカル航跡群に含まれる他のそれぞれ対応するローカル航跡とリモート航跡の合わせ込みを行い、合わせ込んだローカル航跡とリモート航跡同士をペアとする航跡の組合せを用いて航跡割当を算出すると共に、当該合わせ込みの基準としたリモート航跡とローカル航跡の合わせ込む前の位置の差から、合わせ込みに用いたリモート航跡のランダム誤差分とローカル航跡のランダム誤差分を引いた値を2乗したものから航跡バイアス誤差分散として算出させるよう航跡割当処理部を制御する組合せ制限制御部を備えたことを特徴とする請求項1記載のシステム航跡測定装置。
- リモート航跡群の重心とローカル航跡群の重心の差を航跡バイアス誤差として算出する航跡誤差算出制御部を備え、
航跡割当処理部は、前記航跡誤差算出制御部で算出された航跡バイアス誤差を航跡の組合せを構成するペアの差分とし、組合せごとにペアの差分の2乗和を算出して、当該2乗和が最小となるような組合せを航跡割当とし、
航跡誤差推定処理部は、前記航跡誤差算出制御部で算出された航跡バイアス誤差を、求めるべき航跡バイアス誤差としてそのまま出力するようにしたことを特徴とする請求項1記載のシステム航跡測定装置。 - スキャンした各時刻におけるローカル航跡とリモート航跡の組合せの全結果、およびその全結果に基づくローカル航跡とリモート航跡のペアの差分の2乗を蓄積保持する組合せ結果データベースを備え、
航跡割当処理部は、現時刻のスキャンによる処理の際、過去のスキャン分のローカル航跡とリモート航跡の組合せの全結果、およびその全結果に基づくローカル航跡とリモート航跡のペアの差分の2乗を前記組合せ結果データベースから読み出して、これらの過去のデータを含めてローカル航跡とリモート航跡の航跡割当と航跡バイアス誤差分散の計算を行い、かつ、今回の処理で決定された、リモート航跡とローカル航跡のペアからなる組合せの全結果、およびその航跡の組合せの全結果におけるリモート航跡とローカル航跡のペアの差分の2乗を前記組合せ結果データベースに蓄積することを特徴とする請求項1記載のシステム航跡測定装置。 - 各ローカル航跡を中心とした粗ゲートをそれぞれ設定し、設定した粗ゲートに入るローカル航跡とリモート航跡の組合せの纏まりをクラスタ化するよう航跡割当処理部を制御する粗ゲート制御部を備え、
前記航跡割当処理部は、生成したクラスタ毎に航跡割当および航跡バイアス誤差分散を算出することを特徴とする請求項1記載のシステム航跡測定装置。 - ローカル航跡とリモート航跡に含まれる目標位置ベクトルおよび目標速度ベクトルに基づいて目標の現在位置および移動方向を算出し、算出した目標の現在位置および移動方向から、予め地理的に決めておいた評価点に向かっているローカル航跡およびリモート航跡のみを抽出する航跡数制限制御処理部を備え、
航跡割当処理部は、航跡数制限制御処理部で抽出されたローカル航跡とリモート航跡に対して航跡割当および航跡バイアス誤差分散を算出することを特徴とする請求項1記載のシステム航跡測定装置。 - ローカルセンサの直交座標を変換した座標をリモートセンサの直交座標とみなした場合のオイラー角を算出し、当該オイラー角を航跡バイアス誤差と推定するように航跡誤差推定処理部を制御する航跡バイアス誤差オイラー角制御部を備えたことを特徴とする請求項1記載のシステム航跡測定装置。
- ローカル航跡に対して、ローカルセンサの直交座標上におけるリモート航跡が、その各軸方向にバイアス誤差を持つリモートセンサの直交座標上にある場合に、このリモートセンサの直交座標のバイアス誤差を算出し、当該直交座標のバイアス誤差を航跡バイアス誤差として推定する処理を行わせるよう航跡誤差推定処理部を制御する航跡バイアス誤差直交座標制御部を備えたことを特徴とする請求項1記載のシステム航跡測定装置。
- ローカル航跡に対して、ローカルセンサの極座標上におけるリモート航跡が、その各極方向にバイアス誤差を持つリモートセンサの極座標上にある場合に、このリモートセンサの極座標のバイアス誤差を算出し、当該極座標のバイアス誤差を航跡バイアス誤差として推定する処理を行わせるよう航跡誤差推定部を制御する航跡バイアス誤差極座標制御部を備えたことを特徴とする請求項1記載のシステム航跡測定装置。
- ローカルセンサからのローカル航跡とリモートセンサからのリモート航跡をそれぞれ取得するステップと、
ローカル航跡とリモート航跡のペアおよび組合せを作成するステップと、
組合せ毎にペアの差の2乗和を計算するステップと、
組合せ毎に計算したペアの差の2乗和の最小値を選択するステップと、
ペアの差の2乗和の最小値に基づく組合せを航跡割当と決定するステップと、
決定された航跡割当におけるペアの差の2乗和の頻度分布より最頻値を算出するステップと、
決定された航跡割当におけるペアの差の2乗和の最頻値を、航跡バイアス誤差分散と決定するステップと、
決定された航跡割当である各ローカル航跡とリモート航跡のペアについて、ローカル航跡の持つ航跡ランダム誤差分散、リモート航跡の持つ航跡ランダム誤差分散および航跡バイアス誤差分散に基づいて、航跡バイアス誤差を推定するステップと、
決定された航跡割当であるリモート航跡とローカル航跡のペアについて、航跡バイアス誤差分を考慮して補正したリモート航跡を算出し、当該補正したリモート航跡を、ローカル航跡の航跡ランダム誤差分散、リモート航跡の航跡ランダム誤差分散および航跡ランダム誤差分散を考慮してローカル航跡と重み付け統合することによりシステム航跡を生成するステップと、
生成されたシステム航跡の管理番号、ローカル航跡の管理番号を基に、当該システム航跡がどのローカル航跡およびリモート航跡と関連を持っているかを考慮してシステム航跡、ローカル航跡およびリモート航跡を表示するステップを有したことを特徴とする航跡割当と航跡誤差補正処理方法。 - ローカルセンサおよびリモートセンサのそれぞれが目標および誤目標などを含んだ観測値から生成した目標の航跡に基づいてシステム航跡を測定するシステム航跡測定装置において、
ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせてローカル航跡とリモート航跡のペアをN個(Nは0以上の整数)以上含む組合せを抽出し、抽出したそれぞれの組合せ中にある不当なペアを除く処理を行った後、各組合せで残った妥当なペアの差の2乗和を算出し、各組合せの中から、算出したペアの差の2乗和が最小となる場合の組合せを航跡割当結果として抽出する航跡割当処理部と、
前記航跡割当処理部で算出された航跡割当結果であるローカル航跡群とリモート航跡群の組合せを用いて航跡バイアス誤差の分散を求め、当該求めた航跡バイアス誤差の分散、航跡割当結果、ローカル航跡とリモート航跡の持つ航跡ランダム誤差分散に基づいて航跡バイアス誤差を算出する航跡誤差推定処理部と、
前記航跡割当処理部で算出された航跡割当結果を構成するローカル航跡とリモート航跡の各ペアについて、前記航跡誤差推定処理部で算出された航跡バイアス誤差分に基づいて補正したリモート航跡を算出し、当該補正したリモート航跡とローカル航跡を、リモート航跡のランダム誤差分散、ローカル航跡の航跡ランダム誤差分散および航跡バイアス誤差分散を考慮して重み付け統合してシステム航跡を生成する航跡統合処理部と、
前記航跡統合処理部から出力されたシステム航跡、ローカル航跡およびリモート航跡を、それぞれの管理番号で関連付けて表示を行う表示処理部を備えたことを特徴とするシステム航跡測定装置。 - ローカルセンサおよびリモートセンサのそれぞれが目標および誤目標などを含んだ観測値から生成した目標の航跡に基づいてシステム航跡を測定するシステム航跡測定装置において、
ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせてローカル航跡とリモート航跡のペアをN個(Nは0以上の整数)以上含む組合せを抽出し、抽出した組合せ毎のペアの差の2乗の頻度分布を算出し、算出したペアの差の2乗の頻度分布の形状から妥当な形状を持つ組合せを取得し、取得したそれぞれの組合せ中に不当な形状のペアがある場合は除去した後、各組合せで残った妥当なペアの差の2乗和を算出し、各組合せの中から、算出したペアの差の2乗和が最小となる組合せを航跡割当結果として抽出する航跡割当処理部と、
前記航跡割当処理部で算出された航跡割当結果であるローカル航跡群とリモート航跡群の組合せを用いて航跡バイアス誤差の分散を求め、当該求めた航跡バイアス誤差の分散、航跡割当結果、ローカル航跡とリモート航跡の持つ航跡ランダム誤差分散に基づいて航跡バイアス誤差を算出する航跡誤差推定処理部と、
前記航跡割当処理部で算出された航跡割当結果を構成するローカル航跡とリモート航跡の各ペアについて、前記航跡誤差推定処理部で算出された航跡バイアス誤差分に基づいて補正したリモート航跡を算出し、当該補正したリモート航跡とローカル航跡を、リモート航跡のランダム誤差分散、ローカル航跡の航跡ランダム誤差分散および航跡バイアス誤差分散を考慮して重み付け統合してシステム航跡を生成する航跡統合処理部と、
前記航跡統合処理部から出力されたシステム航跡、ローカル航跡およびリモート航跡を、それぞれの管理番号で関連付けて表示を行う表示処理部を備えたことを特徴とするシステム航跡測定装置。 - ローカルセンサおよびリモートセンサのそれぞれが目標および誤目標などを含んだ観測値から生成した目標の航跡に基づいてシステム航跡を測定するシステム航跡測定装置において、
ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせてローカル航跡とリモート航跡のペアをN個(Nは0以上の整数)以上含む組合せを抽出し、抽出した組合せ毎のペアの差の2乗の頻度分布を算出し、算出したペアの差の2乗の頻度分布に複数のピークがある組合せが存在した場合には、そのピークが1つになるような航跡シフト量を再設定して航跡シフトを行った後、ペアの差の2乗の頻度分布を再計算して妥当な組合せを取得し、取得したそれぞれの組合せ中に不当な形状のペアがある場合は除去した後、各組合せで残った妥当なペアの差の2乗和を算出し、各組合せの中から、算出したペアの差の2乗和が最小となる組合せを航跡割当結果として抽出する航跡割当処理部と、
前記航跡割当処理部で算出された航跡割当結果であるローカル航跡群とリモート航跡群の組合せを用いて航跡バイアス誤差の分散を求め、当該求めた航跡バイアス誤差の分散、航跡割当結果、ローカル航跡とリモート航跡の持つ航跡ランダム誤差分散に基づいて航跡バイアス誤差を算出する航跡誤差推定処理部と、
前記航跡割当処理部で算出された航跡割当結果を構成するローカル航跡とリモート航跡の各ペアについて、前記航跡誤差推定処理部で算出された航跡バイアス誤差分に基づいて補正したリモート航跡を算出し、当該補正したリモート航跡とローカル航跡を、リモート航跡のランダム誤差分散、ローカル航跡の航跡ランダム誤差分散および航跡バイアス誤差分散を考慮して重み付け統合してシステム航跡を生成する航跡統合処理部と、
前記航跡統合処理部から出力されたシステム航跡、ローカル航跡およびリモート航跡を、それぞれの管理番号で関連付けて表示を行う表示処理部を備えたことを特徴とするシステム航跡測定装置。 - 組合せ中に不当な形状のペアがある場合は除去して、各組合せで残った妥当なペアの差の2乗和を算出する航跡割当処理部の処理として、ペアの差の2乗の頻度分布における最頻値を含む上位α%(αは100以下の正の実数)の範囲に基づいてペアの差の2乗和を算出するよう前記航跡割当処理部を制御する組合せ評価制御部を備えたことを特徴とする、請求項12または請求項13記載のシステム航跡測定装置。
- ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせる航跡割当処理部の処理後において、さらにランダム誤差を考慮した航跡シフト量を設定して、前記他方の航跡群を、当該ランダム誤差を考慮した航跡シフト量分再シフトさせてから組合せを抽出するよう前記航跡割当処理部を制御する航跡シフト量制御処理部を備えたことを特徴とする請求項11から請求項13のうちのいずれか1項記載のシステム航跡測定装置。
- ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせる航跡割当処理部の処理において、前記ゲート内に他方の航跡群の航跡が複数入った場合には、前記ゲートの中心から最も近くにある他方の航跡群の航跡をペアとなる相手として選択するよう前記航跡割当処理部を制御するゲート内航跡選択制御処理部を備えたことを特徴とする請求項11から請求項13のうちのいずれか1項記載のシステム航跡測定装置。
- ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせる航跡割当処理部の処理において、ローカル航跡群中のローカル航跡数およびリモート航跡群中のリモート航跡数を、粗ゲートにより限定するよう前記航跡割当処理部を制御する祖ゲート使用航跡数制限処理部を備えたことを特徴とする請求項11から請求項13のうちのいずれか1項記載のシステム航跡測定装置。
- ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせる航跡割当処理部の処理において、ローカル航跡群およびリモート航跡群のそれぞれの重心を求め、前記航跡シフト量を各々の重心を合わせ込む値に設定して航跡群をシフトさせるよう前記航跡割当処理部を制御する航跡群重心使用合わせ込み制御処理部を備えたことを特徴とする請求項11から請求項13のうちのいずれか1項記載のシステム航跡測定装置。
- ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせる航跡割当処理部の処理において、ローカル航跡群およびリモート航跡群の最大値および最小値から航跡シフトの範囲を決め、決めた航跡シフトの範囲内で、航跡群のシフトを行わせるよう前記航跡割当処理部を制御する航跡シフト範囲制御処理部を備えたことを特徴とする請求項11から請求項13のうちのいずれか1項記載のシステム航跡測定装置。
- 組合せ毎のペアの差の2乗の頻度分布に複数のピークがある組合せが存在した場合には、そのピークが1つになるように航跡シフト量を再設定して航跡シフトを行った後、ペアの差の2乗の頻度分布を再計算する航跡割当処理部の処理において、各軸での航跡シフトの頻度分布のピーク差に応じてそれぞれの軸方向の航跡シフト量を再設定しピークが1つになるよう航跡シフトを行うよう前記航跡割当処理部を制御する航跡シフト各軸制御処理部を備えたことを特徴とする請求項13記載のシステム航跡測定装置。
- ローカルセンサからローカル航跡、リモートセンサからリモート航跡をそれぞれ取得するステップと、
航跡シフト量ρの初期設定を行うステップと、
ローカル航跡群およびリモート航跡群のいずれか一方における航跡のそれぞれを中心としたゲート内に、他方の航跡群の航跡のいずれかがペアとなるように最大限入れるようにする航跡シフト量を設定し、当該設定した航跡シフト量分だけ他方の航跡群を一方の航跡群にシフトさせてローカル航跡とリモート航跡のペアを含む組合せを抽出するステップと、
抽出したゲート内にリモート航跡が最大個数入る組合せ中のペアの個数がN個以上かを調べるステップと、
抽出したゲート内にリモート航跡が最大個数入る組合せ中のペアの個数がN個未満の場合には、N個以上となるまで航跡シフト量ρを再設定して再シフトおよび組合せを抽出する処理を行うステップと、
抽出したゲート内にリモート航跡が最大個数入る組合せ中のペアの個数がN個以上の場合には、組合せ毎に、不当なペアを除いて、ペアの差の2乗和を算出するステップと、
算出した組合せ毎のペアの差の2乗和が最小となる組合せを決定し、航跡割当結果として出力するステップと、
航跡割当結果であるローカル航跡群とリモート航跡群の組合せを用いて航跡バイアス誤差の分散を求め、当該求めた航跡バイアス誤差の分散、航跡割当結果、ローカル航跡とリモート航跡の持つ航跡ランダム誤差分散に基づいて航跡バイアス誤差を算出するステップと、
航跡割当結果を構成するローカル航跡とリモート航跡の各ペアについて、前記航跡誤差推定処理部で算出された航跡バイアス誤差分に基づいて補正したリモート航跡を算出し、当該補正したリモート航跡とローカル航跡を、リモート航跡のランダム誤差分散、ローカル航跡の航跡ランダム誤差分散および航跡バイアス誤差分散を考慮して重み付け統合してシステム航跡を生成するステップと、
生成されたシステム航跡の管理番号、ローカル航跡の管理番号を基に、当該システム航跡がどのローカル航跡およびリモート航跡と関連を持っているかを考慮してシステム航跡、ローカル航跡およびリモート航跡を表示するステップを有したことを特徴とする航跡割当と航跡誤差補正処理方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007110703A JP5094195B2 (ja) | 2006-04-20 | 2007-04-19 | システム航跡測定装置および航跡割当・航跡誤差補正処理方法 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006116962 | 2006-04-20 | ||
JP2006116962 | 2006-04-20 | ||
JP2007110703A JP5094195B2 (ja) | 2006-04-20 | 2007-04-19 | システム航跡測定装置および航跡割当・航跡誤差補正処理方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007309926A true JP2007309926A (ja) | 2007-11-29 |
JP5094195B2 JP5094195B2 (ja) | 2012-12-12 |
Family
ID=38842894
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007110703A Active JP5094195B2 (ja) | 2006-04-20 | 2007-04-19 | システム航跡測定装置および航跡割当・航跡誤差補正処理方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5094195B2 (ja) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011064484A (ja) * | 2009-09-15 | 2011-03-31 | Mitsubishi Electric Corp | センサバイアス推定装置 |
JP2012047490A (ja) * | 2010-08-24 | 2012-03-08 | Mitsubishi Electric Corp | 追尾装置 |
JP2012189474A (ja) * | 2011-03-11 | 2012-10-04 | Nec Corp | レーダ装置、データ処理方法、及びデータ処理プログラム |
CN105812791A (zh) * | 2016-04-08 | 2016-07-27 | 中国西安卫星测控中心 | 一种光学跟踪测量数据系统误差补偿方法 |
KR20190044322A (ko) * | 2017-10-20 | 2019-04-30 | 국방과학연구소 | 관성항법장치의 고도 보정 방법 및 장치 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07151855A (ja) * | 1993-11-29 | 1995-06-16 | Mitsubishi Electric Corp | 同一航跡判定装置 |
JP2002318280A (ja) * | 2001-04-24 | 2002-10-31 | Mitsubishi Electric Corp | センサ設置誤差推定における目標の位置決定方法及び目標の移動経路決定方法 |
JP2004117017A (ja) * | 2002-09-24 | 2004-04-15 | Mitsubishi Electric Corp | センサバイアス誤差推定用の目標位置決定方法 |
-
2007
- 2007-04-19 JP JP2007110703A patent/JP5094195B2/ja active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07151855A (ja) * | 1993-11-29 | 1995-06-16 | Mitsubishi Electric Corp | 同一航跡判定装置 |
JP2002318280A (ja) * | 2001-04-24 | 2002-10-31 | Mitsubishi Electric Corp | センサ設置誤差推定における目標の位置決定方法及び目標の移動経路決定方法 |
JP2004117017A (ja) * | 2002-09-24 | 2004-04-15 | Mitsubishi Electric Corp | センサバイアス誤差推定用の目標位置決定方法 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011064484A (ja) * | 2009-09-15 | 2011-03-31 | Mitsubishi Electric Corp | センサバイアス推定装置 |
JP2012047490A (ja) * | 2010-08-24 | 2012-03-08 | Mitsubishi Electric Corp | 追尾装置 |
JP2012189474A (ja) * | 2011-03-11 | 2012-10-04 | Nec Corp | レーダ装置、データ処理方法、及びデータ処理プログラム |
CN105812791A (zh) * | 2016-04-08 | 2016-07-27 | 中国西安卫星测控中心 | 一种光学跟踪测量数据系统误差补偿方法 |
CN105812791B (zh) * | 2016-04-08 | 2017-10-20 | 中国西安卫星测控中心 | 一种光学跟踪测量数据系统误差补偿方法 |
KR20190044322A (ko) * | 2017-10-20 | 2019-04-30 | 국방과학연구소 | 관성항법장치의 고도 보정 방법 및 장치 |
KR101974522B1 (ko) * | 2017-10-20 | 2019-05-02 | 국방과학연구소 | 관성항법장치의 고도 보정 방법 및 장치 |
Also Published As
Publication number | Publication date |
---|---|
JP5094195B2 (ja) | 2012-12-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8340400B2 (en) | Systems and methods for extracting planar features, matching the planar features, and estimating motion from the planar features | |
EP3795109B1 (en) | A method of calibrating an inertial measurement unit | |
JP5746477B2 (ja) | モデル生成装置、3次元計測装置、それらの制御方法及びプログラム | |
Liu et al. | Automated matching of multiple terrestrial laser scans for stem mapping without the use of artificial references | |
EP1870856B1 (en) | Information-processing method and apparatus for calculating information regarding measurement target on the basis of captured images | |
US8711214B2 (en) | Position and orientation measurement apparatus, position and orientation measurement method, and storage medium | |
US7698094B2 (en) | Position and orientation measurement method and apparatus | |
EP3033875B1 (en) | Image processing apparatus, image processing system, image processing method, and computer program | |
US20160063717A1 (en) | Point cloud position data processing device, point cloud position data processing system, point cloud position data processing method, and program therefor | |
US8355531B2 (en) | Position and orientation measurement method and position and orientation measurement apparatus | |
WO2015098971A1 (ja) | キャリブレーション装置、キャリブレーション方法およびキャリブレーションプログラム | |
JP5094195B2 (ja) | システム航跡測定装置および航跡割当・航跡誤差補正処理方法 | |
Wang et al. | An adaptive UKF based SLAM method for unmanned underwater vehicle | |
EP3727158B1 (en) | Combining image based and inertial probe tracking | |
US11911213B2 (en) | Techniques for determining ultrasound probe motion | |
Schütz et al. | Precise positioning through a loosely-coupled sensor fusion of GNSS-RTK, INS and LiDAR for autonomous driving | |
Li et al. | Vision-based positioning with a single camera and 3D maps: accuracy and reliability analysis | |
CN104075710B (zh) | 一种基于航迹预测的机动扩展目标轴向姿态实时估计方法 | |
KR102572546B1 (ko) | 단일 주파수 수신기에서 다중 채널에서 발생하는 신호의 차이를 감지하는 장치 및 방법 | |
CN109459723B (zh) | 一种基于元启发算法的纯方位被动定位方法 | |
Hasheminasab et al. | Linear Feature-based image/LiDAR integration for a stockpile monitoring and reporting technology | |
Abbas et al. | A self-calibration of the Leica ScanStation C10 scanner | |
Avitzour | Novel scene calibration procedure for video surveillance systems | |
WO2021111613A1 (ja) | 3次元地図作成装置、3次元地図作成方法、及び3次元地図作成プログラム | |
CN117668574B (zh) | 光影秀的数据模型优化方法、装置、设备及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20070911 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20080612 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100224 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20111129 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120515 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120620 |
|
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: 20120821 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120918 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5094195 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150928 Year of fee payment: 3 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |