JP3750855B2 - 目標追尾装置 - Google Patents
目標追尾装置 Download PDFInfo
- Publication number
- JP3750855B2 JP3750855B2 JP2002194963A JP2002194963A JP3750855B2 JP 3750855 B2 JP3750855 B2 JP 3750855B2 JP 2002194963 A JP2002194963 A JP 2002194963A JP 2002194963 A JP2002194963 A JP 2002194963A JP 3750855 B2 JP3750855 B2 JP 3750855B2
- Authority
- JP
- Japan
- Prior art keywords
- observation
- vector
- target
- covariance matrix
- smoothing
- 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 - Lifetime
Links
Images
Description
【０００１】
【発明の属する技術分野】
この発明は、レーダ等のセンサから得られる複数の移動体目標の追尾を行う目標追尾装置に関するものである。
【０００２】
【従来の技術】
センサによって得られる複数の目標を、その位置の観測値に基づいて追尾するために、各目標の前時刻の運動諸元にもとづく推定演算の結果により、現時刻における目標の位置を予測し、さらに各目標に対する現時刻の観測値の存在期待領域(ゲート)を算出して、上記ゲート内に実際に取得された観測値と各目標との対応を判定（得られた観測目標が真に予測した目標と一致しているか否か）する相関処理が行われる。
【０００３】
ここで、実際の観測時には、センサが目標の観測値以外の誤信号を検出したり、逆に目標の観測に失敗して目標の観測値が得られなかったりすることがある。また、複数の目標が密集していると、一つの目標のゲート内に、複数の目標の観測値が得られる場合がある。このような状況においても、各目標を見失うことなく、正しく追尾を維持していくためには、どの観測値がどの目標のものであるかの判定（相関処理）を精度良く行う必要がある。
【０００４】
図５は例えば、T.E.Fortmann, Y.Bar-Shalom and M.Scheffe,“Mul ti-Target Tracking Using Joint Probabilistic Data Association”,Proceedings of the １９８０ IEEE Conference on Decision and Controlの中で“Joint Probabilistic Data Association”として示された従来の目標追尾装置の構成図である。
【０００５】
図５において、１は目標を観測し目標の位置情報を観測値として出力（任意の時間間隔でデータをサンプリング）する目標観測装置（具体例としては例えばレーダ装置）、３は予測処理部２（後述）の算出した予測ベクトル（予測位置と予測速度ベクトル）と予測誤差共分散を使用して観測値から追尾目標の存在確率分布を表す残差共分散行列を算出し、目標の存在の可能性のある領域(目標存在領域)の中にある観測値を追尾目標と相関の可能性があるとして選択するゲート処理部である。
４は観測値と追尾目標との対応付けの相関仮説を生成し、追尾目標の存在確率分布に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各追尾目標と相関する確率を探知データ相関信頼度として算出する相関処理部、５は上記探知データ相関信頼度と、上記ゲート処理部３からの残差ベクトル(目標の観測位置ベクトルと予測位置ベクトルの差ベクトル)および残差共分散行列と、予測処理部２からの予測誤差共分散行列とに基づいて、現サンプリング時刻の目標位置、速度等の推定値である平滑ベクトルおよび平滑誤差共分散行列を算出する平滑処理部で、これらは外部に出力され図示しない表示装置などで利用される。
【０００６】
６は平滑ベクトルおよび平滑誤差共分散を次サンプリング時刻まで保持する遅延回路である。２は現サンプリング時刻より１サンプリング時刻前に算出し、遅延回路６から遅延して出力された平滑ベクトルと平滑誤差共分散行列を基に、現時刻の目標位置、速度の推定値である予測ベクトルと、予測誤差の評価量である予測誤差共分散行列を算出する予測処理部である。
【０００７】
図５のものの動作を説明する前に、目標追尾装置７に実装された追尾アルゴリズムの理論的な前提となる運動モデルおよび観測モデルについて述べる。
今、Ｌ個の目標ｃを追尾しているとする。目標ｃ(ｃ=１,２,...,Ｌ)の運動モデルを次式で定義する。
【０００８】
【数１】
【０００９】
状態ベクトルの真値は、例えばx-y-z直交座標系における位置と速度からなる場合、次式のように書くことが出来る。なお、Ｔは行列の転置を意味する。
【００１０】
【数２】
【００１１】
状態ベクトルの推移行列は次式で与えられる。Ｉ(n)はn行n列の単位ベクトルである。
【００１２】
【数３】
【００１３】
駆動雑音ベクトルは、平均と共分散行列が次式を満たす６変量白色正規分布に従う。
【００１４】
【数４】
【００１５】
目標観測装置１による、目標ｃよりの探知データである観測ベクトルを表現した観測モデルを次式で定義する。
【００１６】
【数５】
【００１７】
観測雑音ベクトルは、平均と共分散行列が次式を満たす３変量白色正規分布に従う。
【００１８】
【数６】
【００１９】
時刻ｔkまでに得られた観測ベクトル全体の集合をＺ kと表す。Ｍ kをＺ kに対応する時刻ｔkまでの観測ベクトル数の情報とする。
【００２０】
なお、誤信号(クラッタなどの追尾目標以外からの信号)は空間に一様分布し、誤信号から得られる観測ベクトルの個数はポアソン分布に従うとし、時刻ｔkにおける単位体積あたりの平均個数をβFT kと設定する。
【００２１】
次に、図５のものの動作を説明する。
以下の説明で、Pr［.］は確率、Pr［.|.］は条件付き確率、E［.］は平均、
E［.|.］は条件付き平均を表す。
時刻ｔkにおいて、目標観測装置１から観測ベクトルｚk,j (j = １,２,...)が入力されると、予測処理部２に遅延回路６からすべての目標に対する前時刻ｔk-１の平滑ベクトルと平滑誤差共分散行列が入力され、次式に従って、各目標ｃの現時刻ｔkに対する予測ベクトルと予測誤差共分散行列を算出する。
【００２２】
【数７】
【００２３】
次にゲート処理部３が、各目標の予測ベクトルと予測誤差共分散行列を入力とし、各目標対応の観測ベクトルの存在確率分布である残差共分散行列を算出する。存在確率分布に対して所定のしきい値を設定し、これを越える範囲より求めた目標存在領域をゲートと呼ぶ。
【００２４】
【数８】
【００２５】
次に、各目標ごとにその目標のゲート内に存在するすべての観測ベクトルを選びだすことにより、各目標に相関可能な観測ベクトルを決定する。すなわち、各目標ｃに対して次式を満たす観測ベクトルを選択する。
【００２６】
【数９】
【００２７】
現時刻ｔkにおいて、全目標(Ｌ個)に対して、ゲート処理部３で選択された観測ベクトルの集合を次のように表す。
【００２８】
【数１０】
【００２９】
次に、相関処理部で各目標と観測ベクトルとの相関に関する仮説を洗い出す。複数の目標が近接していたり、目標以外からの不要信号も発生するような環境では、どの観測ベクトルがどの目標のものであるのかを判定する必要がある。
目標追尾におけるこの機能を相関と言う。ここで、相関の仮説とは、得られた観測ベクトルと追尾目標とを１対１に対応づけたものである。仮説の総数をＩk個とし、仮説の全体を以下のように表す。
【００３０】
【数１１】
【００３１】
各仮説は、以下のように行列表示する。行列の各要素は１または０である。ただし、下記行列の第１列(Ｌ=０)は観測ベクトルが不要信号であることを示すための列である。
【００３２】
【数１２】
【００３３】
各仮説の行列は以下の３つの基準を同時に満たすものをすべて導出する。
１ 観測ベクトルが目標のソフトウェアゲート内に存在する場合のみ両者を対応づけることができる。
２ 各追尾目標には高々１つの観測ベクトルが相関する。
３ 各観測ベクトルには１つの追尾目標または不要信号が対応する。
【００３４】
例えば、２目標を追尾していて、時刻ｔkで、目標１のゲート内に観測ベクトルｚ１、ｚ２を得て、目標２のゲート内にｚ２を得た場合を考える。なお。ｚ２は目標１のゲート内にも目標２のゲート内にも入っているという状況である。この状況で相関の仮説を洗い出すと以下の４つの仮説が得られる。
【００３５】
【数１３】
【００３６】
仮説１が表しているのは、目標１が観測ベクトルｚ１と相関し、目標２が観測ベクトルｚ２と相関するという仮説である。
仮説２が表しているのは、目標１が観測ベクトルｚ２と相関し、目標２は相関する観測ベクトルがなく、観測ベクトルｚ１は不要信号であるという仮説である。
仮説３が表しているのは、目標１は相関する観測ベクトルがなく、目標２が観測ベクトルｚ２と相関し、観測ベクトルｚ１は不要信号であるという仮説である。
仮説４が表しているのは、２目標とも相関する観測ベクトルがなく、観測ベクトルはｚ１,ｚ２とも不要信号であるという仮説である。
このようにして得られた各仮説に対して、追尾目標の識別を次式で定義する。
【００３７】
【数１４】
【００３８】
これは追尾目標が探知されたか否かの識別結果を示し、仮説における目標への観測ベクトルの関連付けに応じて次式の値となる。
【００３９】
【数１５】
【００４０】
また、仮説における観測ベクトルの識別を式（２２）で定義する。
次式は、観測ベクトルが追尾目標からの信号であるか、不要信号であるかの識別結果を示し、仮説における観測ベクトルの関連付けに応じて次式の値となる。
【００４１】
【数１６】
【００４２】
また、各仮説において、不要信号よりの観測ベクトルの総数を式（２４）で表す。
【００４３】
【数１７】
【００４４】
各仮説の成立する確率(仮説信頼度)を次式に基づいて算出する。
【００４５】
【数１８】
【００４６】
続いて、上記仮説信頼度を用いて、各観測ベクトルが追尾目標と相関する確率を探知データ相関信頼度として以下のように計算する。
【００４７】
【数１９】
【００４８】
次に、平滑処理部５において、予測処理部２より予測誤差共分散行列を入力し、ゲート処理部３より残差ベクトルと残差共分散行列を入力し、相関処理部４より探知データ相関信頼度を入力し、各目標の平滑ベクトルおよび平滑誤差共分散行列を次式に従い算出する。この結果は外部に出力されて図示しない表示装置などで利用される。
【００４９】
【数２０】
【００５０】
なお、ゲート内に探知データを捕えられなかった目標については、平滑処理部５において次式を実行し、予測処理の結果をそのまま平滑結果とする。この処理をメモリトラックと呼ぶ。
【００５１】
【数２１】
【００５２】
以上のように算出された平滑ベクトルおよび平滑誤差共分散行列は、外部へ出力され、図示しない表示システムなどにより追尾目標の特性として表示されるとともに、上記に説明した以後の処理に用いるため、遅延回路６に入力され保持される。
【００５３】
目標観測装置１から全目標を観測した観測ベクトルが入力されるたびに、上記一連の動作を追尾終了まで繰り返す。
【００５４】
【発明が解決しようとする課題】
従来の目標追尾装置においては、各サンプリング時刻において全追尾目標が同時に観測されることを想定してシステムが構成されている。しかし実際には、目標の存在する領域全体を同時には観測できない場合があり、その場合には、例えば、目標存在領域を覆うために目標存在領域を複数に分割して、レーダビームをこの分割領域ごとに照射し、その照射領域ごとに時分割に観測値が得られる。このように、全追尾目標の観測値が時分割に得られることは従来の目標追尾装置では想定していないので、このような場合には、精度よく追尾状態を維持することが出来ないと言う課題があった。
この発明は上記のような課題を解決するためになされたもので、追尾処理に必要な観測情報が同一時刻に得られない場合にも、精度良く追尾を維持できる目標追尾装置を得ることを目的としている。
【００５５】
【課題を解決するための手段】
この発明の目標追尾装置は、任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記第１の遅延手段の出力した前記平滑ベクトルと前記平滑誤差共分散行列とを保持し遅延して出力する第２の遅延手段、
前記第２の遅延手段の出力した前記平滑ベクトルと前記平滑誤差共分散行列を現観測時刻まで外挿予測し、外挿予測ベクトルおよび外挿予測誤差共分散行列を算出する外挿処理手段、
前記予測処理手段の算出した前記予測ベクトルと予測誤差共分散行列、または前記外挿処理手段の算出した前記外挿予測ベクトルと外挿予測誤差共分散行列とのいずれか一方を前記ゲート処理手段と前記平滑処理手段とに入力する第２の入力手段とを備えたものである。
【００５６】
また、任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記第１の遅延手段から出力された前記平滑ベクトルと前記平滑誤差共分散行列とを分離して出力する第１の入力手段、
前記平滑誤差共分散行列を現サンプリング区間内の任意の時刻まで外挿処理を行い外挿予測誤差共分散行列を算出する誤差共分散外挿処理手段、
前記平滑ベクトルと前記誤差共分散行列とを保持し遅延して出力する第２の遅延手段、
前記第２の遅延手段の出力した前記平滑ベクトルを現観測時刻まで外挿予測し、外挿予測ベクトルを算出する位置外挿処理手段、
前記予測処理手段からの予測ベクトルと上記誤差共分散外挿処理手段からの外挿予測誤差共分散行列、または、上記位置外挿処理手段からの外挿予測ベクトルと上記第２の遅延手段からの外挿予測誤差共分散行列のいずれか一方を前記ゲート処理手段と前記平滑処理手段とに入力する第２の入力手段を備えたものである。
【００５７】
また、任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記平滑ベクトルと平滑誤差共分散行列とを現サンプリング区間内の任意の時刻まで外挿予測し、外挿予測ベクトルおよび外挿予測誤差共分散行列を算出する外挿処理手段、
前記外挿予測ベクトルおよび外挿予測誤差共分散行列を保持する第２の遅延手段、
前記外挿処理手段または前記第２の遅延手段のいずれか一方から出力した前記外挿予測ベクトルと前記外挿予測誤差共分散行列を前記ゲート処理手段および前記平滑処理手段に入力する第２の入力手段を備えたものである。
【００５８】
また、前記目標観測手段が異なる時刻に観測した複数の観測値を蓄積してから出力する観測値蓄積手段、
前記複数の観測値に対して、これらが同一時刻に得られたとみなすための１つの観測時刻を決定する観測時刻決定手段を備えたものである。
【００５９】
【発明の実施の形態】
従来の目標追尾装置では、サンプリング時刻ｔkにおいて、全追尾目標を同一時刻に観測した観測ベクトルが同時に得られると想定していた。本発明の目標追尾装置は、これをより現実的な場合に対応するために、全追尾目標が時分割に観測され、観測値が入力されるたびに目標追尾装置が動作するように構成する。このために、時刻について以下の記述を導入する。
目標観測装置は、時刻ｔkから時刻ｔk+１の１サンプリング区間で全目標を観測する。１サンプリング区間は一定間隔でなくてもよい。追尾目標数や必要な追尾精度に応じて変えてもよい。目標観測装置は１サンプリング区間の間に全追尾目標を観測するために、目標が存在すると思われる領域(追尾目標の周辺)をＵk個の領域に分けて順に観測するとする。このとき、時刻ｔkから時刻ｔk+１の間における各領域ごとの観測時刻をｔk,u、(u=１,２,...,Ｕk)と書く。例えば、目標観測装置がレーダであれば、追尾目標の周辺にＵk本のレーダビームを順に照射して全追尾目標を観測したと考える。このとき、時刻に関して次式が成立するとする。
なお、記述の都合上ｔk,０=ｔk-１,Uk-１とする。
【００６０】
【数２２】
【００６１】
実施の形態１．
図１はこの発明の実施の形態１の目標追尾装置の構成を示す構成図である。
図１において、１は移動体の位置を観測するセンサである目標観測装置（目標観測手段）、１７は目標追尾装置である。
目標追尾装置１７内において、８は現観測時刻より１観測時刻前に算出しておいた第１の遅延回路からの平滑ベクトルおよび平滑誤差共分散を基に現観測時刻の目標位置、速度の推定値である予測ベクトルおよび予測誤差の評価量である予測誤差共分散を算出する予測処理部（予測処理手段）、９は第１の遅延回路１６より入力される平滑ベクトルと平滑誤差共分散行列を第２の遅延回路１０に入力する第１の入力部、１０は第１の入力部９から送られてくる平滑ベクトルおよび平滑誤差共分散行列を保持する第２の遅延回路（第２の遅延手段）である。
１１は第２の遅延回路１０からの平滑ベクトルおよび平滑誤差共分散行列を現観測時刻まで外挿予測する外挿処理部（外挿処理手段）、１２は、予測処理部８あるいは外挿処理部１１のいずれかからの外挿予測ベクトルおよび外挿予測誤差共分散行列をゲート処理部１３および平滑処理部１５に入力する第２の入力部（第２の入力手段）、１３は外挿予測ベクトルおよび外挿予測誤差共分散を使用して追尾目標の存在確率分布を表す残差共分散行列を算出し、目標の存在の可能性のある領域(目標存在領域)の中にある観測値を追尾目標と相関の可能性があるとして選択するゲート処理部（ゲート処理手段）である。
１４は観測値と追尾目標との対応付けの相関仮説を生成し、追尾目標の存在確率分布に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各追尾目標と相関する確率を探知データ相関信頼度として算出する相関処理部（相関処理手段）、１５は上記探知データ相関信頼度と、ゲート処理部１３からの残差ベクトル(目標の観測位置ベクトルと予測位置ベクトルの差ベクトル)および残差共分散行列と、予測処理部８からの予測誤差共分散行列と、第２の入力部１２からの外挿予測誤差共分散行列とに基づいて、現観測時刻の目標位置、速度等の推定値である平滑ベクトルおよび平滑誤差の評価量である平滑誤差共分散行列を算出する平滑処理部（平滑処理手段）、１６は平滑ベクトルおよび平滑誤差共分散を次の観測時刻まで保持する第１の遅延回路（第１の遅延手段）である。
【００６２】
次に、動作について説明する。
運動モデルおよび観測モデルは従来技術で説明したものと同じ設定を使用する。ただし、サンプリング時刻ｔkのかわりに観測時刻ｔk,uを用いるため、従来技術の運動モデルと観測モデルにおける添字のkおよびk-１を、それぞれk,uおよびk,u-１と置き換える。
観測時刻ｔk,uにおいて、目標観測装置１から観測ベクトルｚk,u,j (j = １,２,...)が入力されると、予測処理部８に第１の遅延回路１６からすべての目標に対する前観測時刻ｔk,u-１の平滑ベクトルと平滑誤差共分散行列が入力され、次式に従って、各目標ｃの現観測時刻ｔk,uに対する予測ベクトルと予測誤差共分散行列を算出する。
【００６３】
【数２３】
【００６４】
次に、第１の入力部９は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１の場合)、第１の遅延回路１６からの平滑ベクトルと平滑誤差共分散行列を第２の遅延回路１０に入力する。２回目以降(u=２,３,...,Ｕk)の場合は、何も出力しない。すなわち、第２の遅延回路１０の内容は変化しない。なお、第２の遅延回路１０には前サンプリング区間の最後の観測時刻ｔk-１,uk-１における平滑ベクトルと平滑誤差共分散行列が格納されていることになる。
【００６５】
次に、外挿処理部１１に第２の遅延回路１０からすべての目標の平滑ベクトルと平滑誤差共分散行列が入力され、次式に従って、各目標ｃの現観測時刻ｔk,uに対する外挿予測ベクトルと外挿予測誤差共分散行列を算出する。
【００６６】
【数２４】
【００６７】
次に、第２の入力部１２は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において、１回目の観測ベクトルの入力時刻である場合(u=１の場合)、予測処理部８からの予測ベクトルと予測誤差共分散行列を出力する。２回目以降(u=２,３,...,Ｕkの場合は、外挿処理部１１からの外挿予測ベクトルと外挿予測誤差共分散行列を出力する。なお、u=１の場合の外挿予測ベクトルおよび外挿予測誤差共分散行列の式はu=１のときに出力する予測ベクトルおよび予測誤差共分散行列の式と同一となるので、ここで出力される予測ベクトルおよび予測誤差共分散行列をすべて外挿予測ベクトルおよび外挿予測誤差共分散行列と言うことにする。
【００６８】
次にゲート処理部１３が、各目標の外挿予測ベクトルと外挿予測誤差共分散行列を入力とし、各目標対応の観測ベクトルの存在確率分布である残差共分散行列を算出する。
【００６９】
【数２５】
【００７０】
次に、各目標ごとにその目標のゲート内に存在するすべての観測ベクトルを選びだすことにより、各目標に相関可能な観測ベクトルを決定する。すなわち、各目標ｃに対して次式を満たす観測ベクトルを選択する。
【００７１】
【数２６】
【００７２】
現観測時刻ｔk,u,jにおいて、全目標(L個とする)に対してゲート処理部１３で選択された観測ベクトルの集合を次のように表す。
【００７３】
【数２７】
【００７４】
次に、相関処理部で各目標と観測ベクトルとの相関に関する仮説を洗い出す。仮説の総数をＩk,u個とし、仮説の全体を以下のように表す。
【００７５】
【数２８】
【００７６】
各仮説は、以下のように行列表示する。行列の各要素は１または０である。ただし、下記行列の第１列(l=０)は観測ベクトルが不要信号であることを示すための列である。
【００７７】
【数２９】
【００７８】
各仮説の行列は以下の３つの基準を同時に満たすものをすべて導出する。
１ 観測ベクトルが目標のソフトウェアゲート内に存在する場合のみ両者を対応づけることができる。
２ 各追尾目標には高々１つの観測ベクトルが相関する。
３ 各観測ベクトルには１つの追尾目標または不要信号が対応する。
【００７９】
例えば、２目標を追尾していて、観測時刻ｔk,uで、目標１のゲート内に観測ベクトルｚ１,ｚ２を得て、目標２のゲート内にｚ２を得た場合を考える。（即ち、ｚ２は目標１のゲート内にも目標２のゲート内にも入っているという状況である）この状況で相関の仮説を洗い出すと以下の４つの仮説が得られる。
【００８０】
【数３０】
【００８１】
仮説１が表しているのは、目標１が観測ベクトルｚ１と相関し、目標２が観測ベクトルｚ２と相関するという仮説である。
仮説２が表しているのは、目標１が観測ベクトルｚ２と相関し、目標２は相関する観測ベクトルがなく、観測ベクトルｚ１は不要信号であるという仮説である。仮説３が表しているのは、目標１は相関する観測ベクトルがなく、目標２が観測ベクトルｚ２と相関し、観測ベクトルｚ１は不要信号であるという仮説である。仮説４が表しているのは、２目標とも相関する観測ベクトルがなく、観測ベクトルはｚ１,ｚ２とも不要信号であるという仮説である。
このようにして得られた各仮説に対して、追尾目標の識別を次式で定義する。
【００８２】
【数３１】
【００８３】
これは追尾目標が探知されたか否かの識別結果を示し、仮説における目標への観測ベクトルの関連付けに応じて次式の値となる。
【００８４】
【数３２】
【００８５】
また、仮説における観測ベクトルの識別を次式で定義する。
【００８６】
【数３３】
【００８７】
これは観測ベクトルが追尾目標からの信号か不要信号かの識別結果を示し、仮説における観測ベクトルの関連付けに応じて次式の値となる。
【００８８】
【数３４】
【００８９】
また、各仮説において、不要信号よりの観測ベクトルの総数を次式で表す。
【００９０】
【数３５】
【００９１】
各仮説の成立する確率(仮説信頼度)を次式に基づいて算出する。
【００９２】
【数３６】
【００９３】
続いて、上記仮説信頼度を用いて、各観測ベクトルが追尾目標と相関する確率を探知データ相関信頼度として以下のように計算する。
【００９４】
【数３７】
【００９５】
次に、平滑処理部８において、予測処理部８より予測誤差共分散行列を入力し、ゲート処理部１３より残差ベクトルと残差共分散行列を入力し、相関処理部１４より探知データ相関信頼度を入力し、第２の入力部１２から外挿予測共分散行列を入力し、現観測時刻における各目標の平滑ベクトルおよび平滑誤差共分散行列を次式に従い算出する。
【００９６】
【数３８】
【００９７】
なお、ゲート内に探知データを捕えられなかった目標については、平滑処理部１５において次式を実行し、予測処理の結果をそのまま平滑結果とする。
この処理をメモリトラックと呼ぶ。
【００９８】
【数３９】
【００９９】
以上のように算出された平滑ベクトルおよび平滑誤差共分散行列は第１の遅延回路１６に保持される。
目標観測装置１から観測ベクトルが入力されるたびに、上記一連の動作を追尾終了まで繰り返す。
【０１００】
以上説明した本発明の実施の形態１の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
また、同一サンプリング区間では、ゲートを外挿処理により算出するようにしたので、ゲートの急激な変動を抑え、追尾維持の失敗を防ぐことができる。
【０１０１】
なお、実施の形態１では、観測時刻ごとに全追尾目標の追尾処理を行っているが、観測した領域の近傍に存在する目標のみを選んで追尾処理を実行するように構成することも容易に可能である。
【０１０２】
実施の形態２．
以下に、実施の形態２の目標追尾装置を図２により説明する。
実施の形態１の図１と同様の構成部分は同じ符合を付して、再度の説明を省略する。
【０１０３】
１８は、第１の遅延回路１６より入力される平滑ベクトルと平滑誤差共分散行列とを分離して出力し、平滑ベクトルを第２の遅延回路２０に入力し、平滑誤差共分散行列を誤差共分散外挿処理部１９に入力する第１の入力部（第１の入力手段）、１９は第１の入力部１８より送られてくる平滑誤差共分散行列の外挿処理を行う誤差共分散外挿処理部（誤差共分散外挿処理手段）、２０は第１の入力部１８および誤差共分散外挿処理部１９からそれぞれ送られてくる平滑ベクトルおよび外挿予測誤差共分散行列を保持する第２の遅延回路、２１は第２の遅延回路２０からの平滑ベクトルを現観測時刻まで外挿予測する位置外挿処理部（位置外挿処理手段）、２２は予測処理部８からの外挿予測ベクトルと誤差共分散外挿処理部１９からの外挿予測誤差共分散行列、あるいは位置外挿処理部２１からの外挿予測ベクトルと第２の遅延回路２０からの外挿予測誤差共分散行列のいずれかをゲート処理部１３および平滑処理部１５に入力する第２の入力部である。
【０１０４】
次に動作について説明する。
第１の入力部１８、誤差共分散外挿処理部１９、第２の遅延回路２０、位置外挿処理部２１、第２の入力部２２以外のものは実施の形態１の図１のものと動作が同じなので、その説明を省略する。
【０１０５】
第１の入力部１８は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１の場合)、第１の遅延回路１６からの平滑ベクトルを第２の遅延回路２０に入力し、平滑誤差共分散行列を誤差共分散外挿処理部１９に入力する。２回目以降(u=２,３,...,Ｕkの場合)は、何も出力しない。すなわち、第２の遅延回路２０の内容は変化しない。
【０１０６】
誤差共分散外挿処理部１９は、第１の入力部１８からの平滑誤差共分散行列を現サンプリング区間ｔk〜ｔk+１のある時刻(例えば以下のように設定する)まで外挿し、第２の入力部２２および第２の遅延回路２０に出力する。
本誤差共分散外挿処理部１９は第１の入力部１８より平滑誤差共分散行列が入力された場合のみ動作する。
【０１０７】
【数４０】
【０１０８】
第２の遅延回路２０は第１の入力部１８から送られてくる平滑ベクトルと誤差共分散外挿処理部１９から送られてくる外挿予測誤差共分散行列を１サンプリング期間保持する。
【０１０９】
位置外挿処理部２１は、第２の遅延回路から送られてくる平滑ベクトルを運動モデルに従って現観測時刻まで外挿し、外挿予測ベクトルを算出する。算出式は実施の形態１の式(３８)と同じである。
【０１１０】
第２の入力部２２は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１の場合)、予測処理部８からの予測ベクトルと誤差共分散外挿処理部１９からの外挿予測誤差共分散行列とを出力する。２回目以降(u=２,３,...,Ｕkの場合)は、位置外挿処理部２１からの外挿予測ベクトルと第２の遅延回路２０からの外挿予測誤差共分散行列を出力する。
【０１１１】
以降の処理では、現サンプリング区間(ｔk〜ｔk+１)における外挿予測誤差共分散行列および残差共分散行列は観測時刻によらず一定の値を持つ。よって、それぞれの実施の形態１の式を以下のように読み替える。
【０１１２】
【数４１】
【０１１３】
以上説明した本発明の実施の形態２の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
【０１１４】
同一サンプリング区間では、ゲートの大きさを固定するようにしたので、ゲートあるいはゲインの急激な変動により追尾維持の失敗が起こることを防ぐことができる。
【０１１５】
観測時刻ごとに実行する外挿処理を状態ベクトルの外挿のみとしたので、演算量を減らすことができる。
【０１１６】
なお、実施の形態２でも、観測時刻ごとに全追尾目標の追尾処理を行っているが、観測した領域の近傍に存在する目標のみを選んで追尾処理を実行するように構成することも容易に可能である。
【０１１７】
実施の形態３．
以下に、実施の形態３の目標追尾装置を図３により説明する。
実施の形態１の図１と同じ構成部分は同じ符合を付して、再度の説明を省略する。
【０１１８】
２４は、第１の遅延回路１６より入力される平滑ベクトルと平滑誤差共分散行列を外挿処理部２５に入力する第１の入力部、２５は第１の入力部２４からの平滑ベクトルおよび平滑誤差共分散行列を現サンプリング区間のある時刻まで外挿予測し、外挿予測ベクトルおよび外挿予測誤差共分散行列を算出する外挿処理部、２６は外挿処理部２５から送られてくる外挿予測ベクトルおよび外挿予測誤差共分散行列を保持する第２の遅延回路、２７は外挿処理部２５からの外挿予測ベクトルと外挿予測誤差共分散行列、あるいは第２の遅延回路２６からの外挿予測ベクトルと外挿予測誤差共分散行列のいずれかをゲート処理部１３および平滑処理部１５に入力する第２の入力部である。
【０１１９】
次に動作について説明する。第１の入力部２４、外挿処理部２５、第２の遅延回路２６、第２の入力部２７以外は実施の形態１と動作が同じであるため、第１の入力部２４、外挿処理部２５、第２の遅延回路２６、第２の入力部２７についてのみ説明する。
【０１２０】
第１の入力部２４は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１)の場合、第１の遅延回路１６からの平滑ベクトルと平滑誤差共分散行列を外挿処理部２５に入力する。２回目以降(u=２,３,...,Ｕkの場合)は、何も出力しない。
【０１２１】
外挿処理部２５は第１の入力部２４からのすべての目標の平滑ベクトルと平滑誤差共分散行列を現サンプリング区間ｔk〜ｔk+１のある時刻(例えば以下のように設定する)まで外挿して外挿予測ベクトルと外挿予測誤差共分散行列を算出し、第２の入力部２７および第２の遅延回路２６に出力する。本外挿処理部２５は第１の入力部２４からの入力があった場合のみ動作する。
【０１２２】
【数４２】
【０１２３】
なお、第２の遅延回路２６には外挿予測ベクトルと外挿予測誤差共分散行列が格納されていることになる。
【０１２４】
次に、第２の入力部２７は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１)の場合、外挿処理部２５からの外挿予測ベクトルと外挿予測誤差共分散行列を出力する。２回目以降(u=２,３,...,Ｕk)の場合は、第２の遅延回路２６からの外挿予測ベクトルと外挿予測誤差共分散行列を出力する。
【０１２５】
実施の形態３の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
また、同一サンプリング区間では、ゲートの位置と大きさを固定するようにしたので、ゲートあるいはゲインの変動により追尾維持の失敗が起こることを防ぐことができる。
【０１２６】
外挿処理の実行を１サンプリング区間に１回にしたので、演算量を減らすことができる。
【０１２７】
なお、実施の形態３でも、観測時刻ごとに全追尾目標の追尾処理を行っているが、観測した領域の近傍に存在する目標のみを選んで追尾処理を実行するように構成することも容易に可能である。
【０１２８】
実施の形態４．
以下に、この発明の実施の形態４の目標追尾装置について説明する。
図４はこの発明の実施の形態４を示す構成図である。ここでは例として実施の形態１の図１の構成に適用した場合を説明するが、本実施の形態は図２、図３の構成のものにも同様に適用することが出来る。図４において実施の形態１の図１と同様の構成部分は同じ符合を付して、再度の説明を省略する。
【０１２９】
２９は目標観測装置１から送られてくる観測値をある程度蓄積してから目標追尾装置に入力する観測値蓄積部（観測値蓄積手段）である。
３０は観測値蓄積部２９から送られてくる観測値に対して、これらが同一時刻に得られたとみなし、その１つの観測時刻を決定する観測時刻決定部（観測時刻決定手段）である。
【０１３０】
次に動作について説明する。観測値蓄積部２９、観測時刻決定部３０以外の部部は実施の形態１の図１のものと構成／動作が同じであるため、観測値蓄積部２９、観測時刻決定部３０についてのみ説明する。
【０１３１】
観測値蓄積部２９は、目標観測装置１から送られてくる観測値を複数の観測時刻分蓄積しておいて目標追尾装置に入力する。なお、いつ観測されたものかの観測時刻も観測値といっしょに蓄積する。サンプリング区間をまたがっては蓄積しないものとする。蓄積する観測値の数は、観測時刻の数で決めてもよいし、観測値自体の数で決めてもよい。
【０１３２】
観測時刻決定部３０は、観測値蓄積部２９から送られてくる観測値を受けて、複数の観測時刻にまたがる観測値をある１時刻に得られたとみなし、そのみなしの観測時刻を決定する。以後、目標追尾装置３１はこの観測時刻に従って動作する。みなしの観測時刻は、例えば、複数の観測時刻の平均値や中間値とする。
【０１３３】
実施の形態４の目標追尾装置３１によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。
【０１３４】
複数の観測時刻にまたがる観測値をまとめて処理するようにしたので、蓄積する観測値の数を決めることで演算量を調整することが可能となる。
【０１３５】
なお、実施の形態４では、観測時刻ごとに全追尾目標の追尾処理を行っているが、観測した領域の近傍に存在する目標のみを選んで追尾処理を実行するように構成することも容易に可能である。
【０１３６】
【発明の効果】
実施の形態１の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
また、同一サンプリング区間では、ゲートを外挿処理により算出するようにしたので、ゲートの急激な変動を抑え、追尾維持の失敗を防ぐことができる。
【０１３７】
実施の形態２の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。また、同一サンプリング区間では、ゲートの大きさを固定するようにしたので、ゲートあるいはゲインの急激な変動により追尾維持の失敗が起こることを防ぐことができる。更に、観測時刻ごとに実行する外挿処理を状態ベクトルの外挿のみとしたので、演算量を減らすことができる。
【０１３８】
実施の形態３の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
また、同一サンプリング区間では、ゲートの位置と大きさを固定するようにしたので、ゲートあるいはゲインの変動により追尾維持の失敗が起こることを防ぐことができる。更に、外挿処理の実行を１サンプリング区間に１回にしたので、演算量を減らすことができる。
【０１３９】
実施の形態４の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、複数の観測時刻にまたがる観測値をまとめて処理するようにしたので、蓄積する観測値の数を決めることで演算量を調整することが可能となる。
【図面の簡単な説明】
【図１】 本発明の実施の形態１の目標追尾装置の構成図である。
【図２】 本発明の実施の形態２の目標追尾装置の構成図である。
【図３】 本発明の実施の形態３の目標追尾装置の構成図である。
【図４】 本発明の実施の形態４の目標追尾装置の構成図である。
【図５】 従来の目標追尾装置の構成図である。
【符号の説明】
１ 目標観測装置、 ８ 予測処理部、
９、１８、２４ 第１の入力部、
１０、２０、２６ 第２の遅延回路、
１１、２５ 外挿処理部、 １２、２２ 第２の入力部、
１３ ゲート処理部、 １４ 相関処理部、
１５ 平滑処理部、 １６ 第１の遅延回路、
２９ 観測値蓄積部、 ３０ 観測時刻決定部。
【発明の属する技術分野】
この発明は、レーダ等のセンサから得られる複数の移動体目標の追尾を行う目標追尾装置に関するものである。
【０００２】
【従来の技術】
センサによって得られる複数の目標を、その位置の観測値に基づいて追尾するために、各目標の前時刻の運動諸元にもとづく推定演算の結果により、現時刻における目標の位置を予測し、さらに各目標に対する現時刻の観測値の存在期待領域(ゲート)を算出して、上記ゲート内に実際に取得された観測値と各目標との対応を判定（得られた観測目標が真に予測した目標と一致しているか否か）する相関処理が行われる。
【０００３】
ここで、実際の観測時には、センサが目標の観測値以外の誤信号を検出したり、逆に目標の観測に失敗して目標の観測値が得られなかったりすることがある。また、複数の目標が密集していると、一つの目標のゲート内に、複数の目標の観測値が得られる場合がある。このような状況においても、各目標を見失うことなく、正しく追尾を維持していくためには、どの観測値がどの目標のものであるかの判定（相関処理）を精度良く行う必要がある。
【０００４】
図５は例えば、T.E.Fortmann, Y.Bar-Shalom and M.Scheffe,“Mul ti-Target Tracking Using Joint Probabilistic Data Association”,Proceedings of the １９８０ IEEE Conference on Decision and Controlの中で“Joint Probabilistic Data Association”として示された従来の目標追尾装置の構成図である。
【０００５】
図５において、１は目標を観測し目標の位置情報を観測値として出力（任意の時間間隔でデータをサンプリング）する目標観測装置（具体例としては例えばレーダ装置）、３は予測処理部２（後述）の算出した予測ベクトル（予測位置と予測速度ベクトル）と予測誤差共分散を使用して観測値から追尾目標の存在確率分布を表す残差共分散行列を算出し、目標の存在の可能性のある領域(目標存在領域)の中にある観測値を追尾目標と相関の可能性があるとして選択するゲート処理部である。
４は観測値と追尾目標との対応付けの相関仮説を生成し、追尾目標の存在確率分布に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各追尾目標と相関する確率を探知データ相関信頼度として算出する相関処理部、５は上記探知データ相関信頼度と、上記ゲート処理部３からの残差ベクトル(目標の観測位置ベクトルと予測位置ベクトルの差ベクトル)および残差共分散行列と、予測処理部２からの予測誤差共分散行列とに基づいて、現サンプリング時刻の目標位置、速度等の推定値である平滑ベクトルおよび平滑誤差共分散行列を算出する平滑処理部で、これらは外部に出力され図示しない表示装置などで利用される。
【０００６】
６は平滑ベクトルおよび平滑誤差共分散を次サンプリング時刻まで保持する遅延回路である。２は現サンプリング時刻より１サンプリング時刻前に算出し、遅延回路６から遅延して出力された平滑ベクトルと平滑誤差共分散行列を基に、現時刻の目標位置、速度の推定値である予測ベクトルと、予測誤差の評価量である予測誤差共分散行列を算出する予測処理部である。
【０００７】
図５のものの動作を説明する前に、目標追尾装置７に実装された追尾アルゴリズムの理論的な前提となる運動モデルおよび観測モデルについて述べる。
今、Ｌ個の目標ｃを追尾しているとする。目標ｃ(ｃ=１,２,...,Ｌ)の運動モデルを次式で定義する。
【０００８】
【数１】
状態ベクトルの真値は、例えばx-y-z直交座標系における位置と速度からなる場合、次式のように書くことが出来る。なお、Ｔは行列の転置を意味する。
【００１０】
【数２】
状態ベクトルの推移行列は次式で与えられる。Ｉ(n)はn行n列の単位ベクトルである。
【００１２】
【数３】
駆動雑音ベクトルは、平均と共分散行列が次式を満たす６変量白色正規分布に従う。
【００１４】
【数４】
目標観測装置１による、目標ｃよりの探知データである観測ベクトルを表現した観測モデルを次式で定義する。
【００１６】
【数５】
観測雑音ベクトルは、平均と共分散行列が次式を満たす３変量白色正規分布に従う。
【００１８】
【数６】
時刻ｔkまでに得られた観測ベクトル全体の集合をＺ kと表す。Ｍ kをＺ kに対応する時刻ｔkまでの観測ベクトル数の情報とする。
【００２０】
なお、誤信号(クラッタなどの追尾目標以外からの信号)は空間に一様分布し、誤信号から得られる観測ベクトルの個数はポアソン分布に従うとし、時刻ｔkにおける単位体積あたりの平均個数をβFT kと設定する。
【００２１】
次に、図５のものの動作を説明する。
以下の説明で、Pr［.］は確率、Pr［.|.］は条件付き確率、E［.］は平均、
E［.|.］は条件付き平均を表す。
時刻ｔkにおいて、目標観測装置１から観測ベクトルｚk,j (j = １,２,...)が入力されると、予測処理部２に遅延回路６からすべての目標に対する前時刻ｔk-１の平滑ベクトルと平滑誤差共分散行列が入力され、次式に従って、各目標ｃの現時刻ｔkに対する予測ベクトルと予測誤差共分散行列を算出する。
【００２２】
【数７】
次にゲート処理部３が、各目標の予測ベクトルと予測誤差共分散行列を入力とし、各目標対応の観測ベクトルの存在確率分布である残差共分散行列を算出する。存在確率分布に対して所定のしきい値を設定し、これを越える範囲より求めた目標存在領域をゲートと呼ぶ。
【００２４】
【数８】
次に、各目標ごとにその目標のゲート内に存在するすべての観測ベクトルを選びだすことにより、各目標に相関可能な観測ベクトルを決定する。すなわち、各目標ｃに対して次式を満たす観測ベクトルを選択する。
【００２６】
【数９】
現時刻ｔkにおいて、全目標(Ｌ個)に対して、ゲート処理部３で選択された観測ベクトルの集合を次のように表す。
【００２８】
【数１０】
次に、相関処理部で各目標と観測ベクトルとの相関に関する仮説を洗い出す。複数の目標が近接していたり、目標以外からの不要信号も発生するような環境では、どの観測ベクトルがどの目標のものであるのかを判定する必要がある。
目標追尾におけるこの機能を相関と言う。ここで、相関の仮説とは、得られた観測ベクトルと追尾目標とを１対１に対応づけたものである。仮説の総数をＩk個とし、仮説の全体を以下のように表す。
【００３０】
【数１１】
各仮説は、以下のように行列表示する。行列の各要素は１または０である。ただし、下記行列の第１列(Ｌ=０)は観測ベクトルが不要信号であることを示すための列である。
【００３２】
【数１２】
各仮説の行列は以下の３つの基準を同時に満たすものをすべて導出する。
１ 観測ベクトルが目標のソフトウェアゲート内に存在する場合のみ両者を対応づけることができる。
２ 各追尾目標には高々１つの観測ベクトルが相関する。
３ 各観測ベクトルには１つの追尾目標または不要信号が対応する。
【００３４】
例えば、２目標を追尾していて、時刻ｔkで、目標１のゲート内に観測ベクトルｚ１、ｚ２を得て、目標２のゲート内にｚ２を得た場合を考える。なお。ｚ２は目標１のゲート内にも目標２のゲート内にも入っているという状況である。この状況で相関の仮説を洗い出すと以下の４つの仮説が得られる。
【００３５】
【数１３】
仮説１が表しているのは、目標１が観測ベクトルｚ１と相関し、目標２が観測ベクトルｚ２と相関するという仮説である。
仮説２が表しているのは、目標１が観測ベクトルｚ２と相関し、目標２は相関する観測ベクトルがなく、観測ベクトルｚ１は不要信号であるという仮説である。
仮説３が表しているのは、目標１は相関する観測ベクトルがなく、目標２が観測ベクトルｚ２と相関し、観測ベクトルｚ１は不要信号であるという仮説である。
仮説４が表しているのは、２目標とも相関する観測ベクトルがなく、観測ベクトルはｚ１,ｚ２とも不要信号であるという仮説である。
このようにして得られた各仮説に対して、追尾目標の識別を次式で定義する。
【００３７】
【数１４】
これは追尾目標が探知されたか否かの識別結果を示し、仮説における目標への観測ベクトルの関連付けに応じて次式の値となる。
【００３９】
【数１５】
また、仮説における観測ベクトルの識別を式（２２）で定義する。
次式は、観測ベクトルが追尾目標からの信号であるか、不要信号であるかの識別結果を示し、仮説における観測ベクトルの関連付けに応じて次式の値となる。
【００４１】
【数１６】
また、各仮説において、不要信号よりの観測ベクトルの総数を式（２４）で表す。
【００４３】
【数１７】
各仮説の成立する確率(仮説信頼度)を次式に基づいて算出する。
【００４５】
【数１８】
続いて、上記仮説信頼度を用いて、各観測ベクトルが追尾目標と相関する確率を探知データ相関信頼度として以下のように計算する。
【００４７】
【数１９】
次に、平滑処理部５において、予測処理部２より予測誤差共分散行列を入力し、ゲート処理部３より残差ベクトルと残差共分散行列を入力し、相関処理部４より探知データ相関信頼度を入力し、各目標の平滑ベクトルおよび平滑誤差共分散行列を次式に従い算出する。この結果は外部に出力されて図示しない表示装置などで利用される。
【００４９】
【数２０】
なお、ゲート内に探知データを捕えられなかった目標については、平滑処理部５において次式を実行し、予測処理の結果をそのまま平滑結果とする。この処理をメモリトラックと呼ぶ。
【００５１】
【数２１】
以上のように算出された平滑ベクトルおよび平滑誤差共分散行列は、外部へ出力され、図示しない表示システムなどにより追尾目標の特性として表示されるとともに、上記に説明した以後の処理に用いるため、遅延回路６に入力され保持される。
【００５３】
目標観測装置１から全目標を観測した観測ベクトルが入力されるたびに、上記一連の動作を追尾終了まで繰り返す。
【００５４】
【発明が解決しようとする課題】
従来の目標追尾装置においては、各サンプリング時刻において全追尾目標が同時に観測されることを想定してシステムが構成されている。しかし実際には、目標の存在する領域全体を同時には観測できない場合があり、その場合には、例えば、目標存在領域を覆うために目標存在領域を複数に分割して、レーダビームをこの分割領域ごとに照射し、その照射領域ごとに時分割に観測値が得られる。このように、全追尾目標の観測値が時分割に得られることは従来の目標追尾装置では想定していないので、このような場合には、精度よく追尾状態を維持することが出来ないと言う課題があった。
この発明は上記のような課題を解決するためになされたもので、追尾処理に必要な観測情報が同一時刻に得られない場合にも、精度良く追尾を維持できる目標追尾装置を得ることを目的としている。
【００５５】
【課題を解決するための手段】
この発明の目標追尾装置は、任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記第１の遅延手段の出力した前記平滑ベクトルと前記平滑誤差共分散行列とを保持し遅延して出力する第２の遅延手段、
前記第２の遅延手段の出力した前記平滑ベクトルと前記平滑誤差共分散行列を現観測時刻まで外挿予測し、外挿予測ベクトルおよび外挿予測誤差共分散行列を算出する外挿処理手段、
前記予測処理手段の算出した前記予測ベクトルと予測誤差共分散行列、または前記外挿処理手段の算出した前記外挿予測ベクトルと外挿予測誤差共分散行列とのいずれか一方を前記ゲート処理手段と前記平滑処理手段とに入力する第２の入力手段とを備えたものである。
【００５６】
また、任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記第１の遅延手段から出力された前記平滑ベクトルと前記平滑誤差共分散行列とを分離して出力する第１の入力手段、
前記平滑誤差共分散行列を現サンプリング区間内の任意の時刻まで外挿処理を行い外挿予測誤差共分散行列を算出する誤差共分散外挿処理手段、
前記平滑ベクトルと前記誤差共分散行列とを保持し遅延して出力する第２の遅延手段、
前記第２の遅延手段の出力した前記平滑ベクトルを現観測時刻まで外挿予測し、外挿予測ベクトルを算出する位置外挿処理手段、
前記予測処理手段からの予測ベクトルと上記誤差共分散外挿処理手段からの外挿予測誤差共分散行列、または、上記位置外挿処理手段からの外挿予測ベクトルと上記第２の遅延手段からの外挿予測誤差共分散行列のいずれか一方を前記ゲート処理手段と前記平滑処理手段とに入力する第２の入力手段を備えたものである。
【００５７】
また、任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記平滑ベクトルと平滑誤差共分散行列とを現サンプリング区間内の任意の時刻まで外挿予測し、外挿予測ベクトルおよび外挿予測誤差共分散行列を算出する外挿処理手段、
前記外挿予測ベクトルおよび外挿予測誤差共分散行列を保持する第２の遅延手段、
前記外挿処理手段または前記第２の遅延手段のいずれか一方から出力した前記外挿予測ベクトルと前記外挿予測誤差共分散行列を前記ゲート処理手段および前記平滑処理手段に入力する第２の入力手段を備えたものである。
【００５８】
また、前記目標観測手段が異なる時刻に観測した複数の観測値を蓄積してから出力する観測値蓄積手段、
前記複数の観測値に対して、これらが同一時刻に得られたとみなすための１つの観測時刻を決定する観測時刻決定手段を備えたものである。
【００５９】
【発明の実施の形態】
従来の目標追尾装置では、サンプリング時刻ｔkにおいて、全追尾目標を同一時刻に観測した観測ベクトルが同時に得られると想定していた。本発明の目標追尾装置は、これをより現実的な場合に対応するために、全追尾目標が時分割に観測され、観測値が入力されるたびに目標追尾装置が動作するように構成する。このために、時刻について以下の記述を導入する。
目標観測装置は、時刻ｔkから時刻ｔk+１の１サンプリング区間で全目標を観測する。１サンプリング区間は一定間隔でなくてもよい。追尾目標数や必要な追尾精度に応じて変えてもよい。目標観測装置は１サンプリング区間の間に全追尾目標を観測するために、目標が存在すると思われる領域(追尾目標の周辺)をＵk個の領域に分けて順に観測するとする。このとき、時刻ｔkから時刻ｔk+１の間における各領域ごとの観測時刻をｔk,u、(u=１,２,...,Ｕk)と書く。例えば、目標観測装置がレーダであれば、追尾目標の周辺にＵk本のレーダビームを順に照射して全追尾目標を観測したと考える。このとき、時刻に関して次式が成立するとする。
なお、記述の都合上ｔk,０=ｔk-１,Uk-１とする。
【００６０】
【数２２】
実施の形態１．
図１はこの発明の実施の形態１の目標追尾装置の構成を示す構成図である。
図１において、１は移動体の位置を観測するセンサである目標観測装置（目標観測手段）、１７は目標追尾装置である。
目標追尾装置１７内において、８は現観測時刻より１観測時刻前に算出しておいた第１の遅延回路からの平滑ベクトルおよび平滑誤差共分散を基に現観測時刻の目標位置、速度の推定値である予測ベクトルおよび予測誤差の評価量である予測誤差共分散を算出する予測処理部（予測処理手段）、９は第１の遅延回路１６より入力される平滑ベクトルと平滑誤差共分散行列を第２の遅延回路１０に入力する第１の入力部、１０は第１の入力部９から送られてくる平滑ベクトルおよび平滑誤差共分散行列を保持する第２の遅延回路（第２の遅延手段）である。
１１は第２の遅延回路１０からの平滑ベクトルおよび平滑誤差共分散行列を現観測時刻まで外挿予測する外挿処理部（外挿処理手段）、１２は、予測処理部８あるいは外挿処理部１１のいずれかからの外挿予測ベクトルおよび外挿予測誤差共分散行列をゲート処理部１３および平滑処理部１５に入力する第２の入力部（第２の入力手段）、１３は外挿予測ベクトルおよび外挿予測誤差共分散を使用して追尾目標の存在確率分布を表す残差共分散行列を算出し、目標の存在の可能性のある領域(目標存在領域)の中にある観測値を追尾目標と相関の可能性があるとして選択するゲート処理部（ゲート処理手段）である。
１４は観測値と追尾目標との対応付けの相関仮説を生成し、追尾目標の存在確率分布に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各追尾目標と相関する確率を探知データ相関信頼度として算出する相関処理部（相関処理手段）、１５は上記探知データ相関信頼度と、ゲート処理部１３からの残差ベクトル(目標の観測位置ベクトルと予測位置ベクトルの差ベクトル)および残差共分散行列と、予測処理部８からの予測誤差共分散行列と、第２の入力部１２からの外挿予測誤差共分散行列とに基づいて、現観測時刻の目標位置、速度等の推定値である平滑ベクトルおよび平滑誤差の評価量である平滑誤差共分散行列を算出する平滑処理部（平滑処理手段）、１６は平滑ベクトルおよび平滑誤差共分散を次の観測時刻まで保持する第１の遅延回路（第１の遅延手段）である。
【００６２】
次に、動作について説明する。
運動モデルおよび観測モデルは従来技術で説明したものと同じ設定を使用する。ただし、サンプリング時刻ｔkのかわりに観測時刻ｔk,uを用いるため、従来技術の運動モデルと観測モデルにおける添字のkおよびk-１を、それぞれk,uおよびk,u-１と置き換える。
観測時刻ｔk,uにおいて、目標観測装置１から観測ベクトルｚk,u,j (j = １,２,...)が入力されると、予測処理部８に第１の遅延回路１６からすべての目標に対する前観測時刻ｔk,u-１の平滑ベクトルと平滑誤差共分散行列が入力され、次式に従って、各目標ｃの現観測時刻ｔk,uに対する予測ベクトルと予測誤差共分散行列を算出する。
【００６３】
【数２３】
次に、第１の入力部９は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１の場合)、第１の遅延回路１６からの平滑ベクトルと平滑誤差共分散行列を第２の遅延回路１０に入力する。２回目以降(u=２,３,...,Ｕk)の場合は、何も出力しない。すなわち、第２の遅延回路１０の内容は変化しない。なお、第２の遅延回路１０には前サンプリング区間の最後の観測時刻ｔk-１,uk-１における平滑ベクトルと平滑誤差共分散行列が格納されていることになる。
【００６５】
次に、外挿処理部１１に第２の遅延回路１０からすべての目標の平滑ベクトルと平滑誤差共分散行列が入力され、次式に従って、各目標ｃの現観測時刻ｔk,uに対する外挿予測ベクトルと外挿予測誤差共分散行列を算出する。
【００６６】
【数２４】
次に、第２の入力部１２は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において、１回目の観測ベクトルの入力時刻である場合(u=１の場合)、予測処理部８からの予測ベクトルと予測誤差共分散行列を出力する。２回目以降(u=２,３,...,Ｕkの場合は、外挿処理部１１からの外挿予測ベクトルと外挿予測誤差共分散行列を出力する。なお、u=１の場合の外挿予測ベクトルおよび外挿予測誤差共分散行列の式はu=１のときに出力する予測ベクトルおよび予測誤差共分散行列の式と同一となるので、ここで出力される予測ベクトルおよび予測誤差共分散行列をすべて外挿予測ベクトルおよび外挿予測誤差共分散行列と言うことにする。
【００６８】
次にゲート処理部１３が、各目標の外挿予測ベクトルと外挿予測誤差共分散行列を入力とし、各目標対応の観測ベクトルの存在確率分布である残差共分散行列を算出する。
【００６９】
【数２５】
次に、各目標ごとにその目標のゲート内に存在するすべての観測ベクトルを選びだすことにより、各目標に相関可能な観測ベクトルを決定する。すなわち、各目標ｃに対して次式を満たす観測ベクトルを選択する。
【００７１】
【数２６】
現観測時刻ｔk,u,jにおいて、全目標(L個とする)に対してゲート処理部１３で選択された観測ベクトルの集合を次のように表す。
【００７３】
【数２７】
次に、相関処理部で各目標と観測ベクトルとの相関に関する仮説を洗い出す。仮説の総数をＩk,u個とし、仮説の全体を以下のように表す。
【００７５】
【数２８】
各仮説は、以下のように行列表示する。行列の各要素は１または０である。ただし、下記行列の第１列(l=０)は観測ベクトルが不要信号であることを示すための列である。
【００７７】
【数２９】
各仮説の行列は以下の３つの基準を同時に満たすものをすべて導出する。
１ 観測ベクトルが目標のソフトウェアゲート内に存在する場合のみ両者を対応づけることができる。
２ 各追尾目標には高々１つの観測ベクトルが相関する。
３ 各観測ベクトルには１つの追尾目標または不要信号が対応する。
【００７９】
例えば、２目標を追尾していて、観測時刻ｔk,uで、目標１のゲート内に観測ベクトルｚ１,ｚ２を得て、目標２のゲート内にｚ２を得た場合を考える。（即ち、ｚ２は目標１のゲート内にも目標２のゲート内にも入っているという状況である）この状況で相関の仮説を洗い出すと以下の４つの仮説が得られる。
【００８０】
【数３０】
仮説１が表しているのは、目標１が観測ベクトルｚ１と相関し、目標２が観測ベクトルｚ２と相関するという仮説である。
仮説２が表しているのは、目標１が観測ベクトルｚ２と相関し、目標２は相関する観測ベクトルがなく、観測ベクトルｚ１は不要信号であるという仮説である。仮説３が表しているのは、目標１は相関する観測ベクトルがなく、目標２が観測ベクトルｚ２と相関し、観測ベクトルｚ１は不要信号であるという仮説である。仮説４が表しているのは、２目標とも相関する観測ベクトルがなく、観測ベクトルはｚ１,ｚ２とも不要信号であるという仮説である。
このようにして得られた各仮説に対して、追尾目標の識別を次式で定義する。
【００８２】
【数３１】
これは追尾目標が探知されたか否かの識別結果を示し、仮説における目標への観測ベクトルの関連付けに応じて次式の値となる。
【００８４】
【数３２】
また、仮説における観測ベクトルの識別を次式で定義する。
【００８６】
【数３３】
これは観測ベクトルが追尾目標からの信号か不要信号かの識別結果を示し、仮説における観測ベクトルの関連付けに応じて次式の値となる。
【００８８】
【数３４】
また、各仮説において、不要信号よりの観測ベクトルの総数を次式で表す。
【００９０】
【数３５】
各仮説の成立する確率(仮説信頼度)を次式に基づいて算出する。
【００９２】
【数３６】
続いて、上記仮説信頼度を用いて、各観測ベクトルが追尾目標と相関する確率を探知データ相関信頼度として以下のように計算する。
【００９４】
【数３７】
次に、平滑処理部８において、予測処理部８より予測誤差共分散行列を入力し、ゲート処理部１３より残差ベクトルと残差共分散行列を入力し、相関処理部１４より探知データ相関信頼度を入力し、第２の入力部１２から外挿予測共分散行列を入力し、現観測時刻における各目標の平滑ベクトルおよび平滑誤差共分散行列を次式に従い算出する。
【００９６】
【数３８】
なお、ゲート内に探知データを捕えられなかった目標については、平滑処理部１５において次式を実行し、予測処理の結果をそのまま平滑結果とする。
この処理をメモリトラックと呼ぶ。
【００９８】
【数３９】
以上のように算出された平滑ベクトルおよび平滑誤差共分散行列は第１の遅延回路１６に保持される。
目標観測装置１から観測ベクトルが入力されるたびに、上記一連の動作を追尾終了まで繰り返す。
【０１００】
以上説明した本発明の実施の形態１の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
また、同一サンプリング区間では、ゲートを外挿処理により算出するようにしたので、ゲートの急激な変動を抑え、追尾維持の失敗を防ぐことができる。
【０１０１】
なお、実施の形態１では、観測時刻ごとに全追尾目標の追尾処理を行っているが、観測した領域の近傍に存在する目標のみを選んで追尾処理を実行するように構成することも容易に可能である。
【０１０２】
実施の形態２．
以下に、実施の形態２の目標追尾装置を図２により説明する。
実施の形態１の図１と同様の構成部分は同じ符合を付して、再度の説明を省略する。
【０１０３】
１８は、第１の遅延回路１６より入力される平滑ベクトルと平滑誤差共分散行列とを分離して出力し、平滑ベクトルを第２の遅延回路２０に入力し、平滑誤差共分散行列を誤差共分散外挿処理部１９に入力する第１の入力部（第１の入力手段）、１９は第１の入力部１８より送られてくる平滑誤差共分散行列の外挿処理を行う誤差共分散外挿処理部（誤差共分散外挿処理手段）、２０は第１の入力部１８および誤差共分散外挿処理部１９からそれぞれ送られてくる平滑ベクトルおよび外挿予測誤差共分散行列を保持する第２の遅延回路、２１は第２の遅延回路２０からの平滑ベクトルを現観測時刻まで外挿予測する位置外挿処理部（位置外挿処理手段）、２２は予測処理部８からの外挿予測ベクトルと誤差共分散外挿処理部１９からの外挿予測誤差共分散行列、あるいは位置外挿処理部２１からの外挿予測ベクトルと第２の遅延回路２０からの外挿予測誤差共分散行列のいずれかをゲート処理部１３および平滑処理部１５に入力する第２の入力部である。
【０１０４】
次に動作について説明する。
第１の入力部１８、誤差共分散外挿処理部１９、第２の遅延回路２０、位置外挿処理部２１、第２の入力部２２以外のものは実施の形態１の図１のものと動作が同じなので、その説明を省略する。
【０１０５】
第１の入力部１８は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１の場合)、第１の遅延回路１６からの平滑ベクトルを第２の遅延回路２０に入力し、平滑誤差共分散行列を誤差共分散外挿処理部１９に入力する。２回目以降(u=２,３,...,Ｕkの場合)は、何も出力しない。すなわち、第２の遅延回路２０の内容は変化しない。
【０１０６】
誤差共分散外挿処理部１９は、第１の入力部１８からの平滑誤差共分散行列を現サンプリング区間ｔk〜ｔk+１のある時刻(例えば以下のように設定する)まで外挿し、第２の入力部２２および第２の遅延回路２０に出力する。
本誤差共分散外挿処理部１９は第１の入力部１８より平滑誤差共分散行列が入力された場合のみ動作する。
【０１０７】
【数４０】
第２の遅延回路２０は第１の入力部１８から送られてくる平滑ベクトルと誤差共分散外挿処理部１９から送られてくる外挿予測誤差共分散行列を１サンプリング期間保持する。
【０１０９】
位置外挿処理部２１は、第２の遅延回路から送られてくる平滑ベクトルを運動モデルに従って現観測時刻まで外挿し、外挿予測ベクトルを算出する。算出式は実施の形態１の式(３８)と同じである。
【０１１０】
第２の入力部２２は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１の場合)、予測処理部８からの予測ベクトルと誤差共分散外挿処理部１９からの外挿予測誤差共分散行列とを出力する。２回目以降(u=２,３,...,Ｕkの場合)は、位置外挿処理部２１からの外挿予測ベクトルと第２の遅延回路２０からの外挿予測誤差共分散行列を出力する。
【０１１１】
以降の処理では、現サンプリング区間(ｔk〜ｔk+１)における外挿予測誤差共分散行列および残差共分散行列は観測時刻によらず一定の値を持つ。よって、それぞれの実施の形態１の式を以下のように読み替える。
【０１１２】
【数４１】
以上説明した本発明の実施の形態２の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
【０１１４】
同一サンプリング区間では、ゲートの大きさを固定するようにしたので、ゲートあるいはゲインの急激な変動により追尾維持の失敗が起こることを防ぐことができる。
【０１１５】
観測時刻ごとに実行する外挿処理を状態ベクトルの外挿のみとしたので、演算量を減らすことができる。
【０１１６】
なお、実施の形態２でも、観測時刻ごとに全追尾目標の追尾処理を行っているが、観測した領域の近傍に存在する目標のみを選んで追尾処理を実行するように構成することも容易に可能である。
【０１１７】
実施の形態３．
以下に、実施の形態３の目標追尾装置を図３により説明する。
実施の形態１の図１と同じ構成部分は同じ符合を付して、再度の説明を省略する。
【０１１８】
２４は、第１の遅延回路１６より入力される平滑ベクトルと平滑誤差共分散行列を外挿処理部２５に入力する第１の入力部、２５は第１の入力部２４からの平滑ベクトルおよび平滑誤差共分散行列を現サンプリング区間のある時刻まで外挿予測し、外挿予測ベクトルおよび外挿予測誤差共分散行列を算出する外挿処理部、２６は外挿処理部２５から送られてくる外挿予測ベクトルおよび外挿予測誤差共分散行列を保持する第２の遅延回路、２７は外挿処理部２５からの外挿予測ベクトルと外挿予測誤差共分散行列、あるいは第２の遅延回路２６からの外挿予測ベクトルと外挿予測誤差共分散行列のいずれかをゲート処理部１３および平滑処理部１５に入力する第２の入力部である。
【０１１９】
次に動作について説明する。第１の入力部２４、外挿処理部２５、第２の遅延回路２６、第２の入力部２７以外は実施の形態１と動作が同じであるため、第１の入力部２４、外挿処理部２５、第２の遅延回路２６、第２の入力部２７についてのみ説明する。
【０１２０】
第１の入力部２４は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１)の場合、第１の遅延回路１６からの平滑ベクトルと平滑誤差共分散行列を外挿処理部２５に入力する。２回目以降(u=２,３,...,Ｕkの場合)は、何も出力しない。
【０１２１】
外挿処理部２５は第１の入力部２４からのすべての目標の平滑ベクトルと平滑誤差共分散行列を現サンプリング区間ｔk〜ｔk+１のある時刻(例えば以下のように設定する)まで外挿して外挿予測ベクトルと外挿予測誤差共分散行列を算出し、第２の入力部２７および第２の遅延回路２６に出力する。本外挿処理部２５は第１の入力部２４からの入力があった場合のみ動作する。
【０１２２】
【数４２】
なお、第２の遅延回路２６には外挿予測ベクトルと外挿予測誤差共分散行列が格納されていることになる。
【０１２４】
次に、第２の入力部２７は、現観測時刻が現サンプリング区間ｔk〜ｔk+１において１回目の観測ベクトルの入力時刻である場合(u=１)の場合、外挿処理部２５からの外挿予測ベクトルと外挿予測誤差共分散行列を出力する。２回目以降(u=２,３,...,Ｕk)の場合は、第２の遅延回路２６からの外挿予測ベクトルと外挿予測誤差共分散行列を出力する。
【０１２５】
実施の形態３の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
また、同一サンプリング区間では、ゲートの位置と大きさを固定するようにしたので、ゲートあるいはゲインの変動により追尾維持の失敗が起こることを防ぐことができる。
【０１２６】
外挿処理の実行を１サンプリング区間に１回にしたので、演算量を減らすことができる。
【０１２７】
なお、実施の形態３でも、観測時刻ごとに全追尾目標の追尾処理を行っているが、観測した領域の近傍に存在する目標のみを選んで追尾処理を実行するように構成することも容易に可能である。
【０１２８】
実施の形態４．
以下に、この発明の実施の形態４の目標追尾装置について説明する。
図４はこの発明の実施の形態４を示す構成図である。ここでは例として実施の形態１の図１の構成に適用した場合を説明するが、本実施の形態は図２、図３の構成のものにも同様に適用することが出来る。図４において実施の形態１の図１と同様の構成部分は同じ符合を付して、再度の説明を省略する。
【０１２９】
２９は目標観測装置１から送られてくる観測値をある程度蓄積してから目標追尾装置に入力する観測値蓄積部（観測値蓄積手段）である。
３０は観測値蓄積部２９から送られてくる観測値に対して、これらが同一時刻に得られたとみなし、その１つの観測時刻を決定する観測時刻決定部（観測時刻決定手段）である。
【０１３０】
次に動作について説明する。観測値蓄積部２９、観測時刻決定部３０以外の部部は実施の形態１の図１のものと構成／動作が同じであるため、観測値蓄積部２９、観測時刻決定部３０についてのみ説明する。
【０１３１】
観測値蓄積部２９は、目標観測装置１から送られてくる観測値を複数の観測時刻分蓄積しておいて目標追尾装置に入力する。なお、いつ観測されたものかの観測時刻も観測値といっしょに蓄積する。サンプリング区間をまたがっては蓄積しないものとする。蓄積する観測値の数は、観測時刻の数で決めてもよいし、観測値自体の数で決めてもよい。
【０１３２】
観測時刻決定部３０は、観測値蓄積部２９から送られてくる観測値を受けて、複数の観測時刻にまたがる観測値をある１時刻に得られたとみなし、そのみなしの観測時刻を決定する。以後、目標追尾装置３１はこの観測時刻に従って動作する。みなしの観測時刻は、例えば、複数の観測時刻の平均値や中間値とする。
【０１３３】
実施の形態４の目標追尾装置３１によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。
【０１３４】
複数の観測時刻にまたがる観測値をまとめて処理するようにしたので、蓄積する観測値の数を決めることで演算量を調整することが可能となる。
【０１３５】
なお、実施の形態４では、観測時刻ごとに全追尾目標の追尾処理を行っているが、観測した領域の近傍に存在する目標のみを選んで追尾処理を実行するように構成することも容易に可能である。
【０１３６】
【発明の効果】
実施の形態１の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
また、同一サンプリング区間では、ゲートを外挿処理により算出するようにしたので、ゲートの急激な変動を抑え、追尾維持の失敗を防ぐことができる。
【０１３７】
実施の形態２の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。また、同一サンプリング区間では、ゲートの大きさを固定するようにしたので、ゲートあるいはゲインの急激な変動により追尾維持の失敗が起こることを防ぐことができる。更に、観測時刻ごとに実行する外挿処理を状態ベクトルの外挿のみとしたので、演算量を減らすことができる。
【０１３８】
実施の形態３の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、同一サンプリング区間であっても、観測時刻ごとに追尾処理を行うので、全目標の観測ベクトルが到着するのを待つ必要がない。
また、同一サンプリング区間では、ゲートの位置と大きさを固定するようにしたので、ゲートあるいはゲインの変動により追尾維持の失敗が起こることを防ぐことができる。更に、外挿処理の実行を１サンプリング区間に１回にしたので、演算量を減らすことができる。
【０１３９】
実施の形態４の目標追尾装置によれば、観測時刻ごと、すなわち観測領域ごとに追尾処理を実行するようにしたので、全目標の観測ベクトルが同一時刻に得られない場合でも精度良く追尾処理を実行することが可能である。また、複数の観測時刻にまたがる観測値をまとめて処理するようにしたので、蓄積する観測値の数を決めることで演算量を調整することが可能となる。
【図面の簡単な説明】
【図１】 本発明の実施の形態１の目標追尾装置の構成図である。
【図２】 本発明の実施の形態２の目標追尾装置の構成図である。
【図３】 本発明の実施の形態３の目標追尾装置の構成図である。
【図４】 本発明の実施の形態４の目標追尾装置の構成図である。
【図５】 従来の目標追尾装置の構成図である。
【符号の説明】
１ 目標観測装置、 ８ 予測処理部、
９、１８、２４ 第１の入力部、
１０、２０、２６ 第２の遅延回路、
１１、２５ 外挿処理部、 １２、２２ 第２の入力部、
１３ ゲート処理部、 １４ 相関処理部、
１５ 平滑処理部、 １６ 第１の遅延回路、
２９ 観測値蓄積部、 ３０ 観測時刻決定部。
Claims (4)
- 任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記第１の遅延手段の出力した前記平滑ベクトルと前記平滑誤差共分散行列とを保持し遅延して出力する第２の遅延手段、
前記第２の遅延手段の出力した前記平滑ベクトルと前記平滑誤差共分散行列を現観測時刻まで外挿予測し、外挿予測ベクトルおよび外挿予測誤差共分散行列を算出する外挿処理手段、
前記予測処理手段の算出した前記予測ベクトルと予測誤差共分散行列、または前記外挿処理手段の算出した前記外挿予測ベクトルと外挿予測誤差共分散行列とのいずれか一方を前記ゲート処理手段と前記平滑処理手段とに入力する第２の入力手段とを備え、各観測時刻ごとに追尾処理を実行するようにしたことを特徴とする目標追尾装置。 - 任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記第１の遅延手段から出力された前記平滑ベクトルと前記平滑誤差共分散行列とを分離して出力する第１の入力手段、
前記平滑誤差共分散行列を現サンプリング区間内の任意の時刻まで外挿処理を行い外挿予測誤差共分散行列を算出する誤差共分散外挿処理手段、
前記平滑ベクトルと前記誤差共分散行列とを保持し遅延して出力する第２の遅延手段、
前記第２の遅延手段の出力した前記平滑ベクトルを現観測時刻まで外挿予測し、外挿予測ベクトルを算出する位置外挿処理手段、
前記予測処理手段からの予測ベクトルと上記誤差共分散外挿処理手段からの外挿予測誤差共分散行列、または、上記位置外挿処理手段からの外挿予測ベクトルと上記第２の遅延手段からの外挿予測誤差共分散行列のいずれか一方を前記ゲート処理手段と前記平滑処理手段とに入力する第２の入力手段を備え、各観測時刻ごとに追尾処理を実行するようにしたことを特徴とする目標追尾装置。 - 任意の時間間隔で複数の目標の位置を空間内で観測し、前記各観測ごとに前記目標の位置観測値を出力する目標観測手段、
入力されたデータを用いて前記空間内における前記目標の位置の存在確率分布を算出し、前記位置観測値の内から前記存在確率の高い領域の中にある前記位置観測値を選択して、その残差ベクトルと残差共分散行列とを出力するゲート処理手段、
前記選択した位置観測値と前記目標の位置との相関仮説を生成するとともに、前記残差共分散行列に基づいて各相関仮説の成立する確率を仮説信頼度として算出し、さらに、各観測値が各目標の位置と相関する確率を探知データ相関信頼度として算出する相関処理手段、
少なくとも前記探知データ相関信頼度と、前記残差ベクトルおよび残差共分散行列とを用いて、現観測時刻の前記目標の位置と速度の推定値である平滑ベクトルと、平滑誤差の評価量である平滑誤差共分散行列とを算出し、外部に出力する平滑処理手段、
前記平滑処理手段の出力を次の観測時刻まで保持し、遅延して出力する第１の遅延手段、
前記第１の遅延手段から出力される前記位置観測値の平滑ベクトルと前記平滑誤差共分散を基に、現観測時刻の予測ベクトル、および予測誤差共分散行列を算出する予測処理手段、
前記平滑ベクトルと平滑誤差共分散行列とを現サンプリング区間内の任意の時刻まで外挿予測し、外挿予測ベクトルおよび外挿予測誤差共分散行列を算出する外挿処理手段、
前記外挿予測ベクトルおよび外挿予測誤差共分散行列を保持する第２の遅延手段、
前記外挿処理手段または前記第２の遅延手段のいずれか一方から出力した前記外挿予測ベクトルと前記外挿予測誤差共分散行列を前記ゲート処理手段および前記平滑処理手段に入力する第２の入力手段を備え、各観測時刻ごとに追尾処理を実行するようにしたことを特徴とする目標追尾装置。 - 前記目標観測手段が異なる時刻に観測した複数の観測値を蓄積してから出力する観測値蓄積手段、
前記複数の観測値に対して、これらが同一時刻に得られたとみなすための１つの観測時刻を決定する観測時刻決定手段を備えたことを特徴とする請求項１〜３のいずれか一項に記載の目標追尾装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002194963A JP3750855B2 (ja) | 2002-07-03 | 2002-07-03 | 目標追尾装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2002194963A JP3750855B2 (ja) | 2002-07-03 | 2002-07-03 | 目標追尾装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004037262A JP2004037262A (ja) | 2004-02-05 |
| JP3750855B2 true JP3750855B2 (ja) | 2006-03-01 |
Family
ID=31703522
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2002194963A Expired - Lifetime JP3750855B2 (ja) | 2002-07-03 | 2002-07-03 | 目標追尾装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3750855B2 (ja) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5047534B2 (ja) * | 2006-04-24 | 2012-10-10 | 三菱電機株式会社 | 多目標追尾装置 |
| JP2008128777A (ja) * | 2006-11-20 | 2008-06-05 | Mitsubishi Electric Corp | 航空管制システム |
| JP5229126B2 (ja) * | 2009-06-17 | 2013-07-03 | 日本電気株式会社 | 目標追尾処理器及びそれに用いる誤差共分散行列の補正方法 |
| WO2019012575A1 (ja) * | 2017-07-10 | 2019-01-17 | 三菱電機株式会社 | 目標追尾装置 |
| WO2019138443A1 (ja) * | 2018-01-09 | 2019-07-18 | 三菱電機株式会社 | 移動経路推定装置、移動経路推定システムおよび移動経路推定方法 |
| JP6747461B2 (ja) * | 2018-01-30 | 2020-08-26 | 株式会社豊田中央研究所 | 対応付け装置、物体追跡装置、及びプログラム |
-
2002
- 2002-07-03 JP JP2002194963A patent/JP3750855B2/ja not_active Expired - Lifetime
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004037262A (ja) | 2004-02-05 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP2599300B2 (ja) | レ−ダビデオ検出方法及びレ−ダビデオ検出装置 | |
| EP2495583B1 (en) | Target tracking system and target tracking method | |
| Clark et al. | Group target tracking with the gaussian mixture probability hypothesis density filter | |
| JP6186834B2 (ja) | 目標追尾装置及び目標追尾プログラム | |
| CN110286357B (zh) | 一种基于水声探测的目标运动定位方法 | |
| KR101813790B1 (ko) | 특징 기반 다중 센서 정보 융합 장치 및 방법 | |
| JP3750855B2 (ja) | 目標追尾装置 | |
| KR101833238B1 (ko) | 비동기식 센서들을 이용한 표적 추적 시스템 및 방법 | |
| JP2018205229A (ja) | 信号追尾装置及び信号追尾方法 | |
| JP5701152B2 (ja) | 追尾装置及びコンピュータプログラム及び追尾方法 | |
| JP3616029B2 (ja) | 追尾装置 | |
| JP2004219300A (ja) | 目標追尾装置 | |
| JP2893176B2 (ja) | 多目標追尾装置 | |
| JP5675273B2 (ja) | 目標検出装置および目標検出方法 | |
| JP2018146351A (ja) | マルチセンサシステム、センサバイアス推定装置、センサバイアス推定方法及びセンサバイアス推定プログラム | |
| JPH05297947A (ja) | 多目標追尾装置 | |
| JP2004233136A (ja) | 目標追尾装置 | |
| CN113589252B (zh) | 一种基于mht算法的多雷达传感器多目标跟踪方法 | |
| JP7481237B2 (ja) | 物標検出装置 | |
| JP3411485B2 (ja) | 目標追尾装置 | |
| JP3440010B2 (ja) | 目標追尾装置 | |
| WO2024004113A1 (ja) | 目標追尾装置、目標追尾方法、および目標追尾プログラム | |
| JPH05288840A (ja) | 多目標追尾装置 | |
| JP3859908B2 (ja) | 目標追尾装置 | |
| JP7207050B2 (ja) | 移動物状態量推定装置及びプログラム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20040108 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20050802 |
|
| 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: 20051122 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20051201 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 3750855 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091216 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091216 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101216 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111216 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20111216 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121216 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20121216 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131216 Year of fee payment: 8 |
|
| 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 |
|
| EXPY | Cancellation because of completion of term |