JP3583666B2 - Tracking device - Google Patents
Tracking device Download PDFInfo
- Publication number
- JP3583666B2 JP3583666B2 JP26341599A JP26341599A JP3583666B2 JP 3583666 B2 JP3583666 B2 JP 3583666B2 JP 26341599 A JP26341599 A JP 26341599A JP 26341599 A JP26341599 A JP 26341599A JP 3583666 B2 JP3583666 B2 JP 3583666B2
- Authority
- JP
- Japan
- Prior art keywords
- tracking
- coordinate system
- output
- target
- gate
- 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]
TECHNICAL FIELD OF THE INVENTION
The present invention relates to a target tracking technique using a radar sensor, and relates to a tracking device that selects a coordinate system and performs tracking processing in the selected coordinate system.
[0002]
[Prior art]
In a conventional tracking device, a coordinate system to be tracked is selected, the tracking process is performed in the selected coordinate system, and the motion data of the target is estimated.
FIG. S. FIG. 26 is a block diagram showing a configuration of a tracking device shown in Blackman, “Multiple Target Tracking with Radar Applications”, Arttech House, Dedham, 1986. In order to describe the tracking device having the configuration shown in FIG. k Is the target observation vector at C k far.
[0003]
As shown in FIG. 11, the tracking device receives the output of the inside / outside gate determining means 30 and outputs a tracking filter means 10 for outputting the motion data of the tracking target and an area in which an observation value vector of the tracking target is obtained. It comprises a gate calculating
[0004]
Here, the tracking filter means 10 first selects a coordinate system for performing tracking processing. The state variables of the tracking filter are defined based on the selected coordinate system, and the motion parameters are estimated. However, this is a process performed before operation, and once the coordinate system is determined, it is not changed. Here, description will be made assuming that the north reference rectangular coordinate system is selected as the coordinate system.
[0005]
The tracking filter means 10 inputs the observation value vector from the radar converted into the north reference rectangular coordinate system by the gate inside / outside determination means 30 described later, and estimates the motion specification of the tracking target at the time when the observation value vector is obtained. A smoothing unit 101, a
[0006]
The gate calculation means 20 receives the output of the tracking filter means 10 and outputs a tracking gate determined by an area where the next observation value vector of the tracking target is obtained and its center.
[0007]
The inside / outside
[0008]
Next, the operation according to the above configuration will be described with reference to the flowchart shown in FIG.
First, in ST40, a coordinate system to be tracked before operation is selected. Based on the selected coordinate system, a state variable vector of the tracking target, that is, a motion parameter to be estimated is defined. At the same time, a motion model and an observation model are defined.
Here, the motion model describes how the state variable vector of the tracking target changes with time when the motion of the tracking target is assumed.
The observation model describes a relationship between an observation value vector, a state variable of the tracking target, and an observation error when the tracking target is observed by a radar or the like.
[0009]
In ST0, an observation value vector from the radar is input. At this time, the observation value vector is defined in the polar coordinate system. Here, the observed value vector in the polar coordinate system is represented by C k far. Here, the subscript k indicates that the observation value vector is the sampling time t k Represents that obtained in
[0010]
In ST10c, the
[0011]
In ST20, the gate calculation means 20 inputs the output of the tracking filter means 10 and calculates the effective range and the center in which the observation value vector of the tracking target can be obtained. The center of the tracking gate and its area are D k (-), S k (-).
[0012]
In ST30, the inside / outside gate judging means 30 extracts an observation value vector in the area obtained by the gate calculating
When there are a plurality of observation value vectors in the area, various processing methods are conceivable. Here, the observation value vector closest to the center of the gate calculation unit described below is the target of the tracking processing.
[0013]
In ST10c, the observation value vector D extracted by the inside / outside gate determination means 30 by the smoothing unit 101 is determined. k And the observation value vector D k Is calculated and the error covariance thereof is calculated. These are respectively expressed as a smoothed value vector A k (+), Smooth error covariance matrix P k Call it (+).
[0014]
If the processing is not completed, in ST10b, the smoothed value vector A obtained in ST10a is obtained from the
[0015]
[Problems to be solved by the invention]
As described above, the conventional tracking device first selects a coordinate system before operation, and performs tracking processing in the selected coordinate system. However, at the time of tracking processing in the selected coordinate system, the selected coordinates have advantages and disadvantages in either the north reference rectangular coordinate system or the polar coordinate system. For example, in the north reference rectangular coordinate system, the description of the motion model is accurate, but the observation model cannot be accurately described. This effect appears when tracking a distant target or when the angle error is large. In the polar coordinate system, the description of the observation model is accurate, but the motion model cannot be accurately described. This effect appears when tracking a close target or at a low sampling rate.
[0016]
The present invention has been made to solve the above problems, and an object of the present invention is to provide a tracking device capable of selecting a tracking output of a coordinate system having preferable characteristics according to tracking conditions and maintaining tracking performance. I do.
[0017]
[Means for Solving the Problems]
A tracking device according to the present invention includes: a gate inside / outside determination unit that extracts and outputs an observation value vector present in a tracking gate from an input tracking target observation value vector; Tracking reference means for outputting a motion parameter of the tracking target defined in the north reference rectangular coordinate system based on the observed value vector of the tracking target to be tracked, and tracking input via the inside / outside gate determining means. Polar coordinate system tracking filter means that outputs the motion parameters of the tracking target defined in the polar coordinate system based on the observation value vector of the target, and tracking in either the north reference rectangular coordinate system or the polar coordinate system depending on the relative distance to the tracking target Tracking output selection means for selecting the output of the filter means; and a tracking gate for an area in which an observation value vector of the tracking target is obtained based on the output of the tracking output selection means. It is obtained by a gate determining means for outputting to the gate outside judgment unit out.
[0018]
Further, the tracking output selecting means selects the output of the tracking filter means in either the north reference rectangular coordinate system or the polar coordinate system according to the angular accuracy of the radar.
[0019]
Further, the tracking output selecting means selects the output of the tracking filter means of either the north reference rectangular coordinate system or the polar coordinate system according to the sampling number of the tracking processing.
[0020]
Further, the tracking output selecting means selects the output of the tracking filter means of either the north reference rectangular coordinate system or the polar coordinate system according to the estimated speed of the tracking target and the sampling number of the tracking processing. .
[0021]
Further, the tracking output selecting means is characterized in that the output of the tracking filter means of the north reference rectangular coordinate system and the polar coordinate system is weighted and integrated by the relative distance from the tracking target with respect to the predicted value vector among the outputs. It is.
[0022]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
For the sake of explanation, the sampling time t k Is the target observation vector in polar coordinates at k , And the state variable vector of the tracking target is B k , The target observation vector in north reference Cartesian coordinates is D k , And the state variable vector is A k And
[0023]
FIG. 1 is a block diagram showing a configuration of a tracking device according to
As shown in FIG. 1, this tracking device inputs an observation value vector in a tracking gate among observation value vectors obtained from a radar, and outputs a motion target of a tracking target defined in a north reference rectangular coordinate system. Tracking filter means 1, tracking filter means 2 which inputs an observation value vector in a tracking gate and outputs a motion target of a tracking target defined in a polar coordinate system, and tracking filter means 1 in a north reference rectangular coordinate system and a polar coordinate system And output of the tracking output selecting means 3 for selecting the output of the tracking filter means 1 or 2 of either the north reference rectangular coordinate or the polar coordinate based on the relative distance from the tracking target. A gate calculating means 4 for inputting an output, calculating and outputting a tracking gate in an area where an observation value vector of a tracking target is obtained; Composed of the gate outside
[0024]
Here, the tracking filter means 1 defines a state variable of the tracking filter based on the north reference rectangular coordinate system, and estimates a motion parameter. The function itself of the tracking filter means 1 is the same as that of the conventional tracking filter means, and outputs a smoothed value and a predicted value.
That is, the tracking
Note that the motion specification indicates a position, a speed, and the like of the tracking target in the north reference rectangular coordinate system.
[0025]
Further, the tracking filter means 2 defines a state variable vector in a polar coordinate system and estimates a motion parameter. The function itself of the tracking filter means 2 is the same as that of the conventional tracking filter means, and outputs a smoothed value and a predicted value.
That is, the tracking
[0026]
The tracking output selecting means 3 inputs the outputs of the tracking filter means 1 and 2 in the north reference rectangular coordinate system and the polar coordinate system, and selects either the north reference rectangular coordinate system or the polar coordinate system depending on the relative distance to the tracking target. The output of the tracking filter means is selected.
[0027]
Further, the gate calculating means 4 receives the output of the tracking output selecting means 3 and outputs the area based on the coordinate system of the tracking output selected by the tracking output selecting means 3 with respect to the area where the observation value vector of the tracking target is obtained. .
[0028]
Further, the gate calculating means 4 includes a polar coordinate
[0029]
Further, the inside / outside gate determining means receives the output of the gate calculating means 4 and extracts an observed value vector present in the tracking gate from among observed value vectors obtained from the radar. That is, the inside / outside gate judging means 5 extracts an observation value vector in the tracking gate based on the selected coordinate system based on the selection result of the tracking output selecting means 3.
[0030]
Next, the operation of the above configuration will be described with reference to the flowchart of FIG.
First, in ST0, an observation value vector from a radar is input. At this time, the observation value vector is defined in the polar coordinate system. This observation value vector is expressed as C k far. Where the subscript k Is the observation value vector at the sampling time t k Represents that obtained in
[0031]
In ST1c, the prediction unit 13 defined in the north reference rectangular coordinate system inputs the output of the
[0032]
In ST2c, the
[0033]
In ST3, the tracking output selecting means 3 receives the predicted value output of the tracking filter means 1 and the tracking filter means 2 and, based on the relative distance from the tracking target, the tracking filter means of either the north reference rectangular coordinate system or the polar coordinate system. Select 1 or 2 outputs.
[0034]
That is, the specified distance M is determined before operation, and if any of the predicted distances calculated from the tracking filter means 1 and the tracking filter means 2 is equal to or longer than the specified distance M, the output of the tracking filter means 2, ie, B k (-), Q k Select (-).
Otherwise, the output of the tracking filter means 1, ie, A k (-), P k Select (-).
[0035]
In ST4, the gate calculation means 4 inputs the output of the tracking output selection means 3 and outputs the effective range and the center where the observed value vector of the tracking target is obtained based on the coordinate system selected by the tracking output selection means 3. Here, when the north reference rectangular coordinate system is selected, the gate center and its area are denoted by D, respectively. k (-), S k (-), The gate center and its area when the polar coordinate system is selected are represented by C, respectively. k (-), R k (-).
[0036]
In ST5, the inside / outside
When there are a plurality of observation value vectors in the area, various processing methods are conceivable. Here, the observation value vector closest to the center of the gate calculation unit described below is the target of the tracking processing.
[0037]
In ST1a, the smoothing unit 13 generates the observation value vector D extracted by the gate inside /
[0038]
In ST2a, the smoothing
[0039]
In ST1b, the
[0040]
In ST2b, the
[0041]
When selecting one of the outputs of the smoothing
If the processing is not completed, the process returns to ST0 via ST1b and ST2b described above. If the processing is completed, the processing ends.
[0042]
Therefore, according to the first embodiment, in the target tracking, the tracking filters based on the polar coordinate system and the north reference rectangular coordinate system are operated in parallel, and the tracking output is selected based on the relative distance to the tracking target. For the target, the tracking output of the polar coordinate system having preferable characteristics can be selected, and for the close target, the tracking output of the north reference orthogonal coordinate system having preferable characteristics can be selected, so that the tracking performance can be maintained.
[0043]
Next, FIG. 3 is a block diagram showing a configuration of a tracking device according to
3, the same parts as those in the first embodiment shown in FIG. 1 are denoted by the same reference numerals, and the description thereof will be omitted. As a new code, reference numeral 6 denotes a tracking output selection unit according to the second embodiment, which selects the output of the tracking
[0044]
That is, the tracking output selection means 6 receives the outputs of the tracking filter means 1 and 2 in the north reference rectangular coordinate system and the polar coordinate system, and obtains the north reference rectangular coordinate system or Select the output of any tracking filter means in the polar coordinate system.
[0045]
The operation of the second embodiment will be described with reference to the flowchart of FIG.
In ST6, the tracking output selecting means 6 receives the predicted value output of the tracking filter means 1 and the tracking filter means 2 and, based on the relative distance from the tracking target, the tracking filter means of either the north reference rectangular coordinate system or the polar coordinate system. Select 1 or 2 outputs.
[0046]
That is, the specified angular accuracy N is determined before operation, and when the radar angular accuracy obtained from the radar signal processing is equal to or greater than the specified accuracy N, the output of the tracking filter means 2, ie, B k (-), Q k Select (-).
Otherwise, the output of the tracking filter means 1, ie, A k (-), P k Select (-).
Other operations are the same as those in the flowchart of the first embodiment shown in FIG.
[0047]
Therefore, according to the second embodiment, since the tracking output is selected based on the angle accuracy of the radar, the tracking output of the polar coordinate system which operates relatively stably even when the angle accuracy is poor is selected, and the angle accuracy is selected. In a good case, it is possible to select a tracking output of a north reference rectangular coordinate system having preferable characteristics, and it is possible to maintain tracking performance.
[0048]
Embodiment 3 FIG.
Next, FIG. 5 is a block diagram showing a configuration of a tracking device according to Embodiment 3 of the present invention.
5, the same components as those in the first embodiment shown in FIG. 1 are denoted by the same reference numerals, and the description thereof will be omitted. As a new code, reference numeral 7 denotes a tracking output selection unit according to the third embodiment, which selects the output of the tracking
[0049]
That is, the tracking output selecting means 7 inputs the outputs of the tracking filter means 1 and 2 in the north reference rectangular coordinate system and the polar coordinate system, and selects either the north reference rectangular coordinate system or the polar coordinate system depending on the number of samplings of the tracking processing. The output of the tracking filter means 1 or 2 is selected.
[0050]
The operation of the third embodiment will be described with reference to the flowchart of FIG.
In ST7, the tracking output selecting means 7 receives the predicted value output of the tracking filter means 1 and the tracking filter means 2 and inputs the predicted value output of the tracking filter means 1 or 2 of either the north reference rectangular coordinate system or the polar coordinate system according to the number of samplings. Select output.
[0051]
That is, the specified sampling number k before operation 0 Is determined, and the number of samplings of the tracking process is the specified number of samplings k. 0 In the above case, the output of the tracking filter means 2, that is, B k (-), Q k Select (-). This is because at the start of tracking, the tracking output of the north reference rectangular coordinate system greatly fluctuates due to an observation error, particularly an angle error.
Otherwise, the output of the tracking filter means 1, ie, A k (-), P k Select (-).
Other operations are the same as those in the flowchart of the first embodiment shown in FIG.
[0052]
Therefore, according to the third embodiment, the tracking output is selected according to the number of times of sampling, so that the tracking output of the polar coordinate system, which operates relatively stably in a time zone where the tracking output near the tracking start is not stable, is selected. After a sufficient time elapses, a tracking output of the north reference rectangular coordinate system having preferable characteristics can be selected in a time zone in which the operation is stable, and the tracking performance can be maintained.
[0053]
Next, FIG. 7 is a block diagram showing a configuration of a tracking device according to
7, the same components as those in the first embodiment shown in FIG. 1 are denoted by the same reference numerals, and description thereof will be omitted. As a new code, reference numeral 8 denotes a tracking output selecting means according to the fourth embodiment, and the tracking
[0054]
That is, the tracking output selection means 8 receives the outputs of the tracking filter means 1 and 2 in the north reference rectangular coordinate system and the polar coordinate system, and calculates the north reference based on the number of sampling times and the estimated speed of the tracking target output from the tracking filter means. The output of the tracking filter means 1 or 2 in either the rectangular coordinate system or the polar coordinate system is selected.
[0055]
The operation of the present embodiment will be described with reference to the flowchart of FIG.
In ST8, the tracking output selecting means 7 inputs the predicted value output of the tracking filter means 1 and the tracking filter means 2, and performs tracking of either the north reference rectangular coordinate system or the polar coordinate system according to the number of samplings and the estimated speed of the tracking target. The output of the filter means 1 or 2 is selected.
[0056]
That is, the specified sampling number k before operation 0 And specified speed V 0 Is determined, and the number of samplings of the tracking process is the specified number of samplings k. 0 Below or specified speed V 0 In the following case, the output of the tracking filter means 2, ie, B k (-), Q k Select (-). This is because the tracking output of the north reference rectangular coordinate system greatly fluctuates due to an observation error, particularly an angle error, at the time of low-speed target tracking at the start of tracking.
Otherwise, the output of the tracking filter means 1, ie, A k (-), P k Select (-).
Other operations are the same as those in the flowchart of the first embodiment shown in FIG.
[0057]
Therefore, according to the fourth embodiment, since the tracking output is selected based on the number of samplings and the estimated speed of the tracking target, the tracking output is relatively stable in a time zone where the tracking output near the start of tracking is not stable or during low-speed target tracking. The tracking output of the operating polar coordinate system is selected, and after sufficient time elapses, the tracking output of the north reference orthogonal coordinate system with preferable characteristics can be selected during the time period of stable operation or during high-speed target tracking, and the tracking performance is maintained. Can be achieved.
[0058]
Next, FIG. 9 is a block diagram showing a configuration of a tracking device according to
9, the same components as those in the first embodiment shown in FIG. 1 are denoted by the same reference numerals, and the description thereof will be omitted. As a new code,
[0059]
That is, the tracking
[0060]
Next, the operation will be described with reference to the flowchart of FIG.
In ST9, the tracking
[0061]
That is, the specified distance M is determined before operation, and when either of the predicted distances calculated from the tracking filter means 1 and the tracking filter means 2 is equal to or longer than the specified distance M, the output of the tracking filter means 2, ie, B k (-), Q k Select (-).
Otherwise, the tracking filter means A k (-), P k Select (-).
[0062]
However, among the outputs, the predicted value vector A k (-), B k Regarding (−), if the output of the tracking filter means 1 and 2 for the north reference rectangular coordinate and the polar coordinate is selected based on the relative distance to the tracking target, the output of the polar coordinate system is selected according to the equation (1). When the output of the coordinate system is selected, weighting and integration are performed according to equation (2).
[0063]
(Equation 1)
Where r k Is the relative distance from the tracking target, Γ k Is a conversion matrix from the polar coordinate system to the north reference rectangular coordinate system, and h is a conversion function from the north reference rectangular coordinate system to the polar coordinate system.
By this processing, when the selected output is switched, the output can be smoothly connected.
Other operations are the same as those in the flowchart of the first embodiment shown in FIG. Note that the processing for smoothly connecting the selected outputs as in the fifth embodiment can be similarly applied to the second to fourth embodiments.
[0065]
Therefore, according to the fifth embodiment, the outputs of the tracking filter means for the north reference rectangular coordinates and the polar coordinates are weighted and integrated according to the relative distance to the tracking target. Select the output, select the tracking output of the north reference rectangular coordinate system with preferable characteristics for the proximity target, and maintain the tracking performance, and track the polar coordinate system and the north reference rectangular coordinate system based on the relative distance. Since the outputs are weighted and integrated, the output can be switched smoothly.
[0066]
【The invention's effect】
As described above, according to the present invention, a tracking output selection unit that operates a tracking filter based on a polar coordinate system and a north reference rectangular coordinate system in parallel in target tracking and selects a tracking output based on a relative distance to a tracking target is provided. Thus, the tracking output of the polar coordinate system having preferable characteristics is selected for the distant target, and the tracking output of the north reference orthogonal coordinate system having the preferable characteristics is selected for the close target, so that the tracking performance can be maintained.
[0067]
In addition, since the tracking output is selected according to the angle accuracy of the radar, the tracking output of the polar coordinate system which operates relatively stably even when the angle accuracy is poor, and the north reference orthogonal coordinates having preferable characteristics when the angle accuracy is good. The tracking output of the system can be selected to maintain the tracking performance.
[0068]
In addition, since the tracking output is selected according to the number of samplings, the tracking output of the polar coordinate system, which operates relatively stably in a time zone where the tracking output is not stable near the tracking start, is changed to a time zone in which the stable operation is performed after a sufficient time has elapsed. Thus, it is possible to select the tracking output of the north reference rectangular coordinate system having preferable characteristics and maintain the tracking performance.
[0069]
In addition, since the tracking output is selected based on the number of times of sampling and the estimated speed of the tracking target, the tracking output of the polar coordinate system that operates relatively stably in a time zone where the tracking output is not stable near the start of tracking or at the time of low-speed target tracking, After a sufficient time elapses, a tracking output of the north reference rectangular coordinate system having preferable characteristics can be selected in a time zone during which stable operation is performed or during high-speed target tracking, and tracking performance can be maintained.
[0070]
Furthermore, the output of the tracking filter means of the north reference rectangular coordinate and the polar coordinate is weighted and integrated based on the relative distance from the tracking target for the predicted value vector, so that the output can be switched smoothly.
[Brief description of the drawings]
FIG. 1 is a block diagram showing a configuration of a tracking device according to
FIG. 2 is a flowchart showing the operation of FIG.
FIG. 3 is a block diagram showing a configuration of a tracking device according to
FIG. 4 is a flowchart showing the operation of FIG. 3;
FIG. 5 is a block diagram showing a configuration of a tracking device according to Embodiment 3 of the present invention.
FIG. 6 is a flowchart showing the operation of FIG.
FIG. 7 is a block diagram showing a configuration of a tracking device according to
FIG. 8 is a flowchart showing the operation of FIG. 7;
FIG. 9 is a block diagram showing a configuration of a tracking device according to
FIG. 10 is a flowchart showing the operation of FIG. 9;
FIG. 11 is a block diagram showing a conventional tracking device.
FIG. 12 is a flowchart showing the operation of FIG.
[Explanation of symbols]
REFERENCE SIGNS
Claims (5)
上記ゲート内外判定手段を介して入力される追尾目標の観測値ベクトルに基づいて北基準直交座標系で定義した追尾目標の運動緒元を出力する北基準直交座標系追尾フィルタ手段と、
上記ゲート内外判定手段を介して入力される追尾目標の観測値ベクトルに基づいて極座標系で定義した追尾目標の運動緒元を出力する極座標系追尾フィルタ手段と、
追尾目標との相対距離により、北基準直交座標系または極座標系のいずれかの追尾フィルタ手段の出力を選択する追尾出力選択手段と、
上記追尾出力選択手段の出力に基づいて追尾目標の観測値ベクトルが得られる領域の追尾ゲートを算出して上記ゲート内外判定手段に出力するゲート算出手段と
を備えた追尾装置。Among the input tracking target observation value vectors, a gate inside / outside determination means for extracting and outputting an observation value vector present in the tracking gate,
North reference rectangular coordinate system tracking filter means for outputting the motion target of the tracking target defined in the north reference rectangular coordinate system based on the observation value vector of the tracking target input via the gate inside / outside determination means,
Polar coordinate system tracking filter means for outputting a motion parameter of the tracking target defined in the polar coordinate system based on the observation value vector of the tracking target input via the inside / outside gate determination means,
A tracking output selecting means for selecting an output of the tracking filter means in either the north reference rectangular coordinate system or the polar coordinate system according to a relative distance to the tracking target,
A tracking device comprising: a gate calculating unit that calculates a tracking gate in an area where an observation value vector of a tracking target is obtained based on an output of the tracking output selecting unit and outputs the tracking gate to the inside / outside gate determining unit.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP26341599A JP3583666B2 (en) | 1999-09-17 | 1999-09-17 | Tracking device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP26341599A JP3583666B2 (en) | 1999-09-17 | 1999-09-17 | Tracking device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2001083240A JP2001083240A (en) | 2001-03-30 |
| JP3583666B2 true JP3583666B2 (en) | 2004-11-04 |
Family
ID=17389184
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP26341599A Expired - Fee Related JP3583666B2 (en) | 1999-09-17 | 1999-09-17 | Tracking device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3583666B2 (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP5193444B2 (en) * | 2006-08-11 | 2013-05-08 | 株式会社東芝 | Tracking device |
| JP5422727B2 (en) * | 2012-12-04 | 2014-02-19 | 株式会社東芝 | Tracking device |
-
1999
- 1999-09-17 JP JP26341599A patent/JP3583666B2/en not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2001083240A (en) | 2001-03-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Vo et al. | Multi-sensor joint detection and tracking with the Bernoulli filter | |
| CN105549049B (en) | A kind of adaptive Kalman filter algorithm applied to GPS navigation | |
| US6088295A (en) | Feature imaging and adaptive focusing for synthetic aperture processor | |
| CN110208792B (en) | Arbitrary straight line constraint tracking method for simultaneously estimating target state and track parameters | |
| CN110286357B (en) | Target motion positioning method based on underwater sound detection | |
| JP4116898B2 (en) | Target tracking device | |
| JP2005274300A (en) | Target tracking device | |
| US20220230350A1 (en) | Position recognition method and system based on visual information processing | |
| JP3333143B2 (en) | Tracking device and tracking processing method thereof | |
| JP3583666B2 (en) | Tracking device | |
| JP3641566B2 (en) | Tracking device | |
| JP2003329771A (en) | Tracking apparatus and tracking processing method | |
| JP3432737B2 (en) | Tracking device | |
| CN101118160A (en) | Low accuracy piezoelectric gyroscope zero-bias real-time estimation compensation process | |
| Li et al. | Tracking an underwater maneuvering target using an adaptive Kalman filter | |
| CN106405519B (en) | ISAR imaging time section selection method based on tracking information | |
| JP2002341024A (en) | Multiple target tracking device | |
| CN112083410A (en) | Maneuvering target tracking method | |
| JP6757227B2 (en) | Motion parameter estimation device, motion parameter estimation method and program | |
| JP3440010B2 (en) | Target tracking device | |
| CN113514823B (en) | Multi-model maneuvering target tracking-before-detection method based on pseudo-spectrum | |
| JP3627135B2 (en) | Tracking device | |
| JPH0643241A (en) | Multi-target tracking method and its device | |
| JPH0797135B2 (en) | Multi-target tracking method and apparatus | |
| JP3323415B2 (en) | Target tracking apparatus and target tracking method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20040721 |
|
| 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: 20040727 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20040729 |
|
| 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: 20070806 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080806 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080806 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090806 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090806 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100806 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110806 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110806 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120806 Year of fee payment: 8 |
|
| LAPS | Cancellation because of no payment of annual fees |