(57)【特許請求の範囲】
【請求項１】
周波数変調型のレーダにより得られるビート周波数の観測値と目標の追尾に使用するカルマンフィルタの観測モデルにおける観測行列及び上記目標の航跡候補の積との差分を示す行列の転置行列と、上記カルマンフィルタの予測誤差共分散行列から求まる残差共分散行列の逆行列と、上記差分を示す行列との積が設定値より小さければ、上記ビート周波数の観測値と上記目標の航跡候補との間に相関があると認定する相関判定を実施し、相関が認められる航跡候補の有無から、上記目標が観測領域に存在しているか否かを判定する目標有無判定手段と、
上記目標有無判定手段により目標が観測領域に存在していると判定された場合、上記レーダの最大探索距離が上記目標までの距離、上記レーダのビーム中心が上記レーダのビームが向いている方向であるとして、上記目標の運動諸元である位置及び速度を推定する際に上記カルマンフィルタが用いる上記目標の運動諸元の初期値として、上記最大探索距離と上記ビームが向いている方向から上記目標の初期位置を設定するとともに、初探索時刻におけるビート周波数の観測値と上記最大探索距離から上記目標の初期速度を設定する初期値設定手段と、
上記初期値設定手段により設定された初期値を非線形最小自乗法による運動諸元の状態探索の初期点に設定し、上記ビート周波数の観測値の時系列を用いて、上記非線形最小自乗法による運動諸元の状態探索を実施することで、上記目標の運動諸元を推定する運動諸元推定手段と
を備えた目標追尾装置。
【請求項２】
上記運動諸元推定手段は、上記レーダにより観測されたビート周波数のサンプリング数が所定数に満たない場合、推定する運動諸元の数を減らすことを特徴とする請求項１記載の目標追尾装置。
【請求項３】
上記目標有無判定手段は、上記レーダにより得られるビート周波数の観測値と上記目標の航跡候補との間の相関判定を実施するとともに、上記レーダから上記目標まで距離であるＰＲＩ内距離の観測値と上記目標の航跡候補との間の相関判定を実施し、上記ビート周波数の観測値との相関が認められ、かつ、上記ＰＲＩ内距離の観測値との相関が認められる航跡候補の有無から、上記目標が観測領域に存在しているか否かを判定することを特徴とする請求項１または請求項２記載の目標追尾装置。
【発明の詳細な説明】
【技術分野】
【０００１】
この発明は、ＦＭ変調（周波数変調）型のレーダにより得られるビート周波数の観測値から目標の運動諸元（目標の位置、速度など）を推定する目標追尾装置に関するものである。
【背景技術】
【０００２】
例えば、レーダ等のセンサシステムでは、目標の位置を観測するセンサより得られる観測値の時系列から目標の有無を判定し、目標が存在すれば、目標の位置や速度を推定する追尾処理によって目標航跡を抽出することが必要になる場合がある。
センサより得られる観測値を用いて、目標を追尾する技術は、多くの論文や特許文献などで取り挙げられており、それらを実現する装置や方法についても、様々な提案がなされている。
【０００３】
レーダからは、目標の観測値の他に、目標以外の反射信号に起因するクラッタが得られる。
このクラッタを用いて、目標の追尾処理を行うと、誤った運動諸元の推定値が算出されてしまうため、このクラッタを除去する必要がある。
このクラッタを除去する方法として、レーダからパルスを高頻度に送信させながら、追尾処理の前段の信号処理で周波数解析を行うことで、目標とクラッタを区別するパルスドップラ方式が知られている。
【０００４】
レーダの送信信号をパルス状の信号とするレーダ方式では、図８に示すように、送信パルスと受信パルスの時間差から、目標の距離情報を算出することができる。以下、目標の距離情報を「ＰＲＩ内距離」と称する。
ただし、高頻度でパルスを送信する場合、受信される複数のパルスが、どの送信パルスに対応するものであるかを特定することができず、目標の距離情報であるＰＲＩ内距離に複数の候補が発生する。
複数の候補が発生することはアンビギュイティと呼ばれ、ＰＲＩ内距離にアンビギュイティが発生すると、信号処理の後段にある追尾処理では、ＰＲＩ内距離の観測値を利用することができない。
【０００５】
レーダの送信波形の一つとして、図９に示すように、周波数を時間に対して直線的に変化させるＦＭ変調がある。
この送信波形を適用した場合の同一時刻における送受信波の周波数の違いは、ビート周波数と呼ばれ、このビート周波数ｆｂｋは、下記の式（１）に示すように、目標の距離と距離変化率の一次結合であるため、ドップラ周波数から決まる距離変化率を代入することで、目標の距離が得られる。
0005904775.tif 000002
式（１）において、Ｒｋは第ｋサンプリング時刻における目標の距離、Ｒｋドット（ここでは、電子出願の都合上、Ｒの上部に・の記号を表記することができないため、Ｒｋドットのように表記している）は第ｋサンプリング時刻における目標の距離変化率である。
また、ＢはＦＭ変調の帯域幅、ｃは光速、Ｔは観測時間、ｆ０は送信周波数である。
【０００６】
ここでは、この送信波形を適用した場合に得られる複数スキャンのビート周波数ｆｂｋから目標の距離と距離変化率を算出することを考える。
このビート周波数ｆｂｋの観測値を用いて、カルマンフィルタによって目標の距離と距離変化率を推定する方式が以下の特許文献１に開示されている。
この方式は、図１０に示すような装置構成によって、本出願の発明が前提とするパルス繰り返し周波数が高いレーダに適用することができる。
【０００７】
この方式では、最初に、初期２サンプリング時刻分のビート周波数の観測値ｚｆｂ０，ｚｆｂ１から以下の連立方程式を解くことにより、目標の距離及び距離変化率の初期推定値を算出する。
0005904775.tif 000003
ただし、Δｔはサンプリング間隔である。上記の例では、サンプリング間隔分の時間内での目標の距離変化率の変化が極めて小さいと仮定している。
【０００８】
上記の初期推定値を出発点として、ビート周波数の観測値ｚｆｂｋが得られる度に、カルマンフィルタを用いて推定値を更新する。
このカルマンフィルタの状態変数は以下の通りである。
0005904775.tif 000004
初期の推定値である式（４）の各成分は式（２）（３）の連立方程式の解であるため、初期２サンプリング時刻のビート周波数の観測値ｚｆｂ０，ｚｆｂ１の線形結合となる。
このため、以降のカルマンフィルタに基づく処理で必要となる推定誤差共分散行列の初期値Ｐ１（＋）の各成分は、ビート周波数の観測誤差標準偏差より算出することができる。
【０００９】
以下、サンプリング時刻ｋ（≧２）のビート周波数ｆｂｋを用いた推定値の更新処理について説明する。
推定値の更新処理では予測処理を行うが、カルマンフィルタでは以下の状態遷移モデルを仮定する。
0005904775.tif 000005
ただし、Φｋは状態遷移行列であり、下記の式（６）で定義される。
0005904775.tif 000006
また、ｗｋは運動に加わる外乱であり、以下の共分散を持つガウス分布に従うものとする。
0005904775.tif 000007
ただし、Ｑｋは事前に設定されるパラメータである。
【００１０】
上記の状態遷移モデルに基づき、サンプリング時刻ｋ（≧２）の予測値ｘｋ（−）ハット（ここでは、電子出願の都合上、ｘの上部に＾の記号を表記することができないため、ｘハットのように表記している）は、下記の式（８）に示すように、１つ前のサンプリング時刻ｋ−１の平滑値ｘｋ−１（＋）ハットから算出され、サンプリング時刻ｋ（≧２）の予測誤差共分散行列Ｐｋ（−）は、下記の式（９）に示すように、１つ前のサンプリング時刻ｋ−１の平滑誤差共分散行列Ｐｋ−１（＋）から算出される。
0005904775.tif 000008
【００１１】
予測処理の後の平滑処理を実施して、最終的な推定値を算出するが、ここでは、以下の観測モデルを仮定する。
0005904775.tif 000009
ただし、Ｈは観測行列であり、下記の式（１１）で定義される。
0005904775.tif 000010
また、ｅｆｂはビート周波数の観測誤差であり、その分散Ｒｆｂがパラメータとして事前に与えられる。
0005904775.tif 000011
【００１２】
この観測モデルに基づき、サンプリング時刻ｋ（≧２）の平滑値ｘｋ（＋）ハット，Ｐｋ（＋）は、同サンプリング時刻の予測値ｘｋ（−）ハット，予測誤差共分散行列Ｐｋ（−），ビート周波数の観測値ｚｆｂｋから、下記の式（１３）（１４）のように算出される。
0005904775.tif 000012
ただし、Ｉは単位行列、Ｋｋはカルマンゲインであり、下記の式（１５）から算出される。
0005904775.tif 000013
【００１３】
観測領域に複数の目標が存在する状況や、目標信号と一緒に誤警報等の不要信号が得られる状況では、各スキャンでビート周波数の観測値が複数得られるのが一般的である。
このような場合には、観測領域における目標の有無を判定し、目標が存在すると判定されれば、その運動諸元を出力する必要がある。
この場合、各スキャンでビート周波数の観測値を選択し、上記の従来技術の追尾処理によって運動諸元を推定しながら、この航跡候補の尤度によって、目標の存在の有無を判定することができる。
【００１４】
航跡候補と観測値の相関可能性は、以下のように判定することができる。
0005904775.tif 000014
ただし、ｄは事前に設定されるゲートサイズパラメータである。また、Ｓｋは残差共分散行列であり、下記の式（１７）で算出される。
0005904775.tif 000015
上記の式（１６）を満たす観測値が複数ある場合、式（１６）の左辺の値が最も小さくなる観測値を選択して、航跡候補に割り当てる方法や、複数の割り当てを考えて、航跡候補を複数生成するといった観測値の割り当て方法がある。
【００１５】
このようにして生成した航跡候補のうち、ある航跡候補の尤度γｋが、予め設定している航跡抽出のための尤度の閾値を超えれば、目標の存在を確定し、その時点での運動諸元の推定値を出力する。
ここで、尤度γｋは、ある観測値を用いて更新した場合、下記の式（１８）で算出される。
0005904775.tif 000016
ただし、γｋ−１は１サンプリング時刻前の当該航跡候補の尤度である。尤度の初期値γ１は事前に設定されるパラメータである。
【先行技術文献】
【特許文献】
【００１６】
【特許文献１】特開２０１０−１９８２４号公報
【発明の概要】
【発明が解決しようとする課題】
【００１７】
従来の目標追尾装置は以上のように構成されているので、目標の運動諸元を推定しながら、目標が存在しているか否かが判定される。このため、目標の運動諸元の推定誤差に伴って相関判定の正解率が低下すると、目標の検出が遅れてしまうなどの課題があった。
【００１８】
この発明は上記のような課題を解決するためになされたもので、運動諸元の推定精度の影響を受けることなく、速やかに目標を検出することができる目標追尾装置を得ることを目的とする。
【課題を解決するための手段】
【００１９】
この発明に係る目標追尾装置は、周波数変調型のレーダにより得られるビート周波数の観測値と目標の追尾に使用するカルマンフィルタの観測モデルにおける観測行列及び目標の航跡候補の積との差分を示す行列の転置行列と、カルマンフィルタの予測誤差共分散行列から求まる残差共分散行列の逆行列と、その差分を示す行列との積が設定値より小さければ、そのビート周波数の観測値と目標の航跡候補との間に相関があると認定する相関判定を実施し、相関が認められる航跡候補の有無から、目標が観測領域に存在しているか否かを判定する目標有無判定手段と、目標有無判定手段により目標が観測領域に存在していると判定された場合、レーダの最大探索距離が目標までの距離、レーダのビーム中心がレーダのビームが向いている方向であるとして、目標の運動諸元である位置及び速度を推定する際にカルマンフィルタが用いる目標の運動諸元の初期値として、その最大探索距離とビームが向いている方向から目標の初期位置を設定するとともに、初探索時刻におけるビート周波数の観測値と最大探索距離から目標の初期速度を設定する初期値設定手段とを設け、運動諸元推定手段が、初期値設定手段により設定された初期値を非線形最小自乗法による運動諸元の状態探索の初期点に設定し、そのビート周波数の観測値の時系列を用いて、非線形最小自乗法による運動諸元の状態探索を実施することで、目標の運動諸元を推定するようにしたものである。
【発明の効果】
【００２０】
この発明によれば、周波数変調型のレーダにより得られるビート周波数の観測値と目標の追尾に使用するカルマンフィルタの観測モデルにおける観測行列及び目標の航跡候補の積との差分を示す行列の転置行列と、カルマンフィルタの予測誤差共分散行列から求まる残差共分散行列の逆行列と、その差分を示す行列との積が設定値より小さければ、そのビート周波数の観測値と目標の航跡候補との間に相関があると認定する相関判定を実施し、相関が認められる航跡候補の有無から、目標が観測領域に存在しているか否かを判定する目標有無判定手段を設け、その目標有無判定手段が、運動諸元推定手段により目標の運動諸元が推定される前に、目標が観測領域に存在しているか否かを判定するように構成したので、運動諸元の推定精度の影響を受けることなく、速やかに目標を検出することができるとともに、目標の運動諸元の推定精度を高めることができる効果がある。
【図面の簡単な説明】
【００２１】
【図１】この発明の実施の形態１による目標追尾装置を示す構成図である。
【図２】この発明の実施の形態１による目標追尾装置の処理内容を示すフローチャートである。
【図３】初期値設定部１２による運動諸元の状態探索の初期値の設定例を示す説明図である。
【図４】初期値設定部１２による運動諸元の状態探索の初期値の設定例を示す説明図である。
【図５】Ｎｅｗｔｏｎ法による運動諸元の推定値の探索処理を示す説明図である。
【図６】この発明の実施の形態２による目標追尾装置を示す構成図である。
【図７】この発明の実施の形態２による目標追尾装置の処理内容を示すフローチャートである。
【図８】ＰＲＩ内距離にアンビギュイティが発生する例を示す説明図である。
【図９】ＦＭ変調による送信波形制御を示す説明図である。
【図１０】従来の目標追尾装置を示す構成図である。
【発明を実施するための形態】
【００２２】
実施の形態１．
図１はこの発明の実施の形態１による目標追尾装置を示す構成図である。
図１において、レーダ１はＦＭ変調型（周波数変調型）のレーダであり、観測値としてビート周波数ｆｂｋを観測し、その観測値を目標追尾装置２に出力する。
目標追尾装置２の航跡抽出決定部１１はレーダ１により得られるビート周波数ｆｂｋの観測値から目標の航跡候補を抽出するとともに、ビート周波数ｆｂｋの観測値と目標の航跡候補との相関判定を実施し、相関が認められる航跡候補の有無から、目標が観測領域に存在しているか否かを判定する処理を実施する。
また、航跡抽出決定部１１は目標の存在の有無を示す判定結果を初期値設定部１２に出力するとともに、例えば、その判定結果を図示せぬディスプレイに表示するなどの方法で、目標の有無をユーザに知らせる処理を実施する。
なお、航跡抽出決定部１１は目標有無判定手段を構成している。
【００２３】
初期値設定部１２は航跡抽出決定部１１により目標が観測領域に存在していると判定された場合、レーダ１の観測条件を示す事前情報にしたがって目標の運動諸元を推定する際に用いる運動諸元の状態探索の初期値を設定する処理を実施する。なお、初期値設定部１２は初期値設定手段を構成している。
運動諸元推定部１３は初期値設定部１２により設定された初期値を運動諸元の状態探索の初期点に設定し、ビート周波数ｆｂｋの観測値の時系列を用いて、運動諸元の状態探索を実施することで、目標の運動諸元を推定する処理を実施する。なお、運動諸元推定部１３は運動諸元推定手段を構成している。
【００２４】
図１の例では、目標追尾装置の構成要素である航跡抽出決定部１１、初期値設定部１２及び運動諸元推定部１３のそれぞれが専用のハードウェア（例えば、ＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなど）で構成されているものを想定しているが、目標追尾装置がコンピュータで構成されていてもよい。
目標追尾装置がコンピュータで構成されている場合、航跡抽出決定部１１、初期値設定部１２及び運動諸元推定部１３の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。
図２はこの発明の実施の形態１による目標追尾装置の処理内容を示すフローチャートである。
【００２５】
次に動作について説明する。
目標追尾装置２が使用するカルマンフィルタの状態変数、状態遷移モデル及び観測モデルは、下記の通りである。
状態変数は、下記の式（１９）に示すように、ビート周波数ｆｂｋと、ビート周波数ｆｂｋの変化率で構成されている。
0005904775.tif 000017
【００２６】
状態遷移モデルは、下記の式（２０）に示す通りである。
0005904775.tif 000018
ただし、Φｋは状態遷移行列であり、下記の式（２１）で定義される。
0005904775.tif 000019
また、ｗｋは運動に加わる外乱であり、下記の共分散を持つガウス分布に従うものとする。
0005904775.tif 000020
ただし、Ｑｋは事前に設定されるパラメータである。
【００２７】
観測モデルは、下記の式（２２）に示す通りである。
0005904775.tif 000021
ただし、Ｈｆｂは観測行列であり、下記の式（２４）で定義される。
0005904775.tif 000022
また、ｅｆｂはビート周波数の観測誤差であり、その分散Ｒｆｂがパラメータとして事前に与えられる。
0005904775.tif 000023
【００２８】
以下、１サンプリング時刻分の処理を詳細に説明する。
航跡抽出決定部１１は、レーダ１により得られるビート周波数ｆｂｋの観測値から目標の航跡候補を抽出するとともに、ビート周波数ｆｂｋの観測値と目標の航跡候補との相関判定を実施し、相関が認められる航跡候補の有無から、目標が観測領域に存在しているか否かを判定する。
具体的には、以下の通りである。
【００２９】
まず、航跡抽出決定部１１は、「ゲート内外判定」として、下記の式（２６）に示すようなビート周波数ｆｂｋの観測値と目標の航跡候補との相関判定を実施する（図２のステップＳＴ１）。
0005904775.tif 000024
ただし、ｘｋ（−）ハットは航跡候補の予測値であり、下記の式（２７）で算出される。
0005904775.tif 000025
また、Ｓｋは残差共分散行列であり、下記の式（２８）で算出される。
0005904775.tif 000026
ただし、Ｐｋ（−）は予測誤差共分散行列であり、下記の式（２９）で算出される。
0005904775.tif 000027
【００３０】
航跡抽出決定部１１は、ビート周波数ｆｂｋの観測値と目標の航跡候補との相関判定を実施すると、「航跡候補相関決定」として、ゲート内に入っている観測値を選択する（ステップＳＴ２）。
観測値の選択方法として、式（２６）の左辺の値が最も小さくなる観測値を選択して航跡候補に割り当てる方法や、ゲート内の観測値の全てついて、各々を割り当てた航跡候補を複数生成する方法などが考えられる。
【００３１】
航跡抽出決定部１１は、ゲート内に入っている観測値を選択すると、「フィルタ内状態更新」として、航跡候補に割り当てた観測値によって、カルマンフィルタの状態推定値を更新する（ステップＳＴ３）。
例えば、現在の処理が航跡候補にとって、２番目のサンプリング時刻である場合、状態推定値は、下記の式（３０）に示すように、２サンプリング時刻分のビート周波数の観測値ｚｆｂ０，ｚｆｂ１より算出することができる。
0005904775.tif 000028
ただし、Δｔはサンプリング間隔である。
２つのビート周波数の観測値ｚｆｂ０，ｚｆｂ１の線形結合であるため、以降のカルマンフィルタに基づく処理で必要となる推定誤差共分散行列の初期値Ｐ１（＋）の各成分は、ビート周波数の観測誤差標準偏差より算出することができる。
【００３２】
現在の処理が航跡候補にとって、３番目以降のサンプリング時刻である場合、状態推定値は、下記の式（３１）に示すように、ビート周波数の観測値ｚｆｂｋより算出することができる。
0005904775.tif 000029
ただし、Ｉは単位行列、Ｋｋはカルマンゲインであり、下記の式（３３）で算出される。
0005904775.tif 000030
【００３３】
航跡抽出決定部１１は、カルマンフィルタの状態推定値を更新すると、航跡候補の尤度γｋを更新する（ステップＳＴ４）。
航跡候補の尤度γｋは、ある観測値を用いて更新する場合、下記の式（３４）で算出される。
0005904775.tif 000031
ただし、γｋ−１は１サンプリング時刻前の当該航跡候補の尤度であり、尤度の初期値γ１は事前に設定されるパラメータである。
【００３４】
航跡候補の尤度γｋが、予め設定されている閾値ｔｈを越えない場合（ステップＳＴ５）、この時点で１サンプリング時刻分の処理を終了する。
一方、航跡候補の尤度γｋが、予め設定されている閾値ｔｈを越える場合（ステップＳＴ５）、ステップＳＴ６の「運動諸元推定初期値生成」の処理に移行する。
即ち、航跡候補の尤度γｋが、予め設定されている閾値ｔｈを越える場合、航跡抽出決定部１１により目標が観測領域に存在していると判定されて、ステップＳＴ６の「運動諸元推定初期値生成」の処理に移行する。
【００３５】
航跡抽出決定部１１により目標が観測領域に存在していると判定された場合、後述するステップＳＴ６，ＳＴ７において、これまでの間に、航跡候補に蓄積されたビート周波数ｆｂｋの観測値の時系列を用いて、目標の３次元空間上の位置と速度を推定する。推定する運動諸元を以下の現サンプリング時刻ｎにおける３次元空間上の位置，速度とする。
0005904775.tif 000032
【００３６】
初期値設定部１２は、航跡抽出決定部１１により目標が観測領域に存在していると判定されると、レーダ１の観測条件を示す事前情報にしたがって目標の運動諸元を推定する際に用いる運動諸元の状態探索の初期値ｘｎ＿１ハットを設定する（ステップＳＴ６）。
即ち、初期値設定部１２は、図３に示すように、レーダ１の最大探索距離、レーダ１のビームが向いている方向及び初探索時刻におけるビート周波数の観測値（第１サンプリング時刻におけるビート周波数の観測値ｚｆｂ０）を用いて、運動諸元の状態探索の初期値ｘｎ＿１ハットを設定する。
図３に示すように、目標までの距離Ｒ０をレーダ１の最大探索距離、仰角及び方位角をビーム中心とすると、目標の３次元位置が決まる。
また、目標までの距離Ｒ０と、この航跡候補の第１サンプリング時刻におけるビート周波数の観測値ｚｆｂ０から、下記の式（３６）に示すように、目標の距離変化率Ｒ０ドットを算出することができる。
0005904775.tif 000033
【００３７】
目標速度の横行成分を０として、初探索時刻の運動諸元が決まる。この初探索時刻の運動諸元から、等速直進運動を仮定して最新時刻ｎに外挿し、探索の初期値とする。
レーダ１より仰角が得られない場合、上記のような初期値の設定が困難となる。この場合、目標高度は０と見做し、図４に示すように、地球の丸みから算出される観測可能領域の境界から初期値を算出する。
即ち、レーダ１の設置高度から求まる見通し角、方位角及び初探索時刻におけるビート周波数の観測値を用いて、運動諸元の状態探索の初期値ｘｎ＿１ハットを設定する。
【００３８】
運動諸元推定部１３は、初期値設定部１２が運動諸元の状態探索の初期値ｘｎ＿１ハットを設定すると、その初期値ｘｎ＿１ハットを運動諸元の状態探索の初期点に設定し、これまでの間に、航跡候補に蓄積されたビート周波数ｆｂｋの観測値の時系列を用いて、運動諸元の状態探索を実施することで、目標の運動諸元を推定する（ステップＳＴ７）。
これにより、正確な運動諸元が推定されるが、以下、推定精度が改善される原理について説明する。
【００３９】
目標の運動として等速直進運動を仮定すると、最新時刻ｎにおける目標運動諸元が決まれば、下記の式（３７）に示すように、それ以前のサンプリング時刻ｋの運動諸元は一意に決まるので、目標の検出では、下記の式（３８）のように、ビート周波数列が抽出されるものとする。
0005904775.tif 000034
【００４０】
最新時刻ｎにおける推定値から、観測値は、下記の式（３９）に示すように予測することができる。
0005904775.tif 000035
上記の予測観測値と実際の観測値の差異が最も小さくなる推定値は、非線形最小自乗法により算出される。
0005904775.tif 000036
ここで、最小とする関数は、下記の式（４１）で定義される。
0005904775.tif 000037
【００４１】
運動諸元推定部１３は、初期値設定部１２により設定された初期値を出発点として、最適な状態をＮｅｗｔｏｎ法に従って探索する。
即ち、運動諸元推定部１３は、図５に示すように、状態探索の初期点ｘｎ＿１ハットから出発し、その初期点における目的関数の値Ｆ（ｆｂ１，…，ｆｂｎ，ｘｎ＿１ハット）と、その接平面の傾きから、次の探索点ｘｎ＿２ハットが決まる。
次の探索点ｘｎ＿３ハットについても探索点ｘｎ＿２ハットと同様に決まる（探索点ｘｎ＿３ハットについては、初期点ｘｎ＿１ハットの代わりに探索点ｘｎ＿２ハットを出発とする）。
探索点を繰り返し決定することで、目的関数が最小となる点ｘｎ＿ｏｐｔハットが決まり、点ｘｎ＿ｏｐｔハットが目標の運動諸元の推定値として出力される。
【００４２】
なお、運動諸元推定部１３が解く必要がある変数は、３次元の位置と速度であるため、合計で６個である。
よって、可観測性を得るには、６以上のスキャン数が必要となる。したがって、６スキャン分のビート周波数の観測値が得られない場合、追尾対象を海面より僅か上を接近する目標に限定して、高度方向の速度を０とするなどにより、推定する状態変数を限定して、少ないビート周波数の観測値でも推定できるようにする。
【００４３】
以上で明らかなように、この実施の形態１によれば、レーダ１により得られるビート周波数の観測値と目標の航跡候補との相関判定を実施し、相関が認められる航跡候補の有無から、目標が観測領域に存在しているか否かを判定する航跡抽出決定部１１を設け、航跡抽出決定部１１が、運動諸元推定部１３により目標の運動諸元が推定される前に、目標が観測領域に存在しているか否かを判定するように構成したので、運動諸元の推定精度の影響を受けることなく、速やかに目標を検出することができるとともに、目標の運動諸元の推定精度を高めることができる効果を奏する。
【００４４】
即ち、この実施の形態１によれば、ビート周波数の観測値の時系列から目標の有無を判断し、目標の存在が確定してから運動諸元の推定を行うようにしているため、目標の運動諸元の推定誤差によって誤相関が起きて、目標航跡の抽出が遅れる場合でも、早期に目標航跡を抽出することができる。
また、推定される運動は３次元上空間上の運動であり、距離方向のみの運動を推定する従来方式と比べて、より正確な運動諸元の情報をユーザに提供することができる。
また、非線形最小自乗法における探索の初期点をレーダの観測条件の事前情報から決めるため、最適な状態変数の探索において収束が早くなり、かつ生成される解の推定精度が高くなる。
【００４５】
実施の形態２．
図６はこの発明の実施の形態２による目標追尾装置を示す構成図であり、図において、図１と同一符号は同一または相当部分を示すので説明を省略する。
ＰＲＩ内距離相関決定部２１はレーダ１から目標まで距離であるＰＲＩ内距離の観測値と目標の航跡候補との相関判定を実施する。
航跡抽出決定部２２はレーダ１により得られるビート周波数ｆｂｋの観測値から目標の航跡候補を抽出するとともに、ビート周波数ｆｂｋの観測値と目標の航跡候補との相関判定を実施し、ビート周波数ｆｂｋの観測値との相関が認められ、かつ、ＰＲＩ内距離相関決定部２１によりＰＲＩ内距離の観測値との相関が認められる航跡候補の有無から、目標が観測領域に存在しているか否かを判定する処理を実施する。
また、航跡抽出決定部２２は目標の存在の有無を示す判定結果を初期値設定部１２に出力するとともに、例えば、その判定結果を図示せぬディスプレイに表示するなどの方法で、目標の有無をユーザに知らせる処理を実施する。
なお、ＰＲＩ内距離相関決定部２１及び航跡抽出決定部２２から目標有無判定手段が構成されている。
【００４６】
図６の例では、目標追尾装置の構成要素であるＰＲＩ内距離相関決定部２１、航跡抽出決定部２２、初期値設定部１２及び運動諸元推定部１３のそれぞれが専用のハードウェア（例えば、ＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなど）で構成されているものを想定しているが、目標追尾装置がコンピュータで構成されていてもよい。
目標追尾装置がコンピュータで構成されている場合、ＰＲＩ内距離相関決定部２１、航跡抽出決定部２２、初期値設定部１２及び運動諸元推定部１３の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。
図７はこの発明の実施の形態２による目標追尾装置の処理内容を示すフローチャートである。
【００４７】
次に動作について説明する。
目標追尾装置２が使用するカルマンフィルタの状態変数、状態遷移モデル及び観測モデルは、下記の通りである。
状態変数は、下記の式（４２）に示すように、ビート周波数ｆｂｋ、方位角Ａｚｋ、仰角Ｅｌｋ及びそれらの変化率で構成されている。
0005904775.tif 000038
【００４８】
状態遷移モデルは、下記の式（４３）に示す通りである。
0005904775.tif 000039
ただし、Φｋは状態遷移行列であり、下記の式（４４）で定義される。
0005904775.tif 000040
また、ｗｋは運動に加わる外乱であり、下記の共分散を持つガウス分布に従うものとする。
0005904775.tif 000041
ただし、Ｑｋは事前に設定されるパラメータである。
【００４９】
観測モデルは、下記の式（４６）に示す通りである。
0005904775.tif 000042
観測値ｚｋは、下記の式（４７）に示すように、ビート周波数の観測値ｚｆｂｋ、方位角の観測値ｚＡｚｋ及び仰角の観測値ｚＥｌｋで構成される。
0005904775.tif 000043
また、ＨｆｂＡｚＥｌは観測行列であり、下記の式（４８）で定義される。
0005904775.tif 000044
【００５０】
また、ｅｆｂＡｚＥｌはビート周波数ｆｂｋ、方位角Ａｚｋ、仰角Ｅｌｋの観測誤差標準偏差で構成されるベクトルである。
0005904775.tif 000045
このｅｆｂＡｚＥｌの共分散ＲｆｂＡｚＥｌは、下記の式（５０）で示され、パラメータとして事前に与えられる。
0005904775.tif 000046
【００５１】
以下、１サンプリング時刻分の処理を詳細に説明する。
まず、航跡抽出決定部１１は、「ゲート内外判定」として、下記の式（５１）に示すようなビート周波数ｆｂｋの観測値と目標の航跡候補との相関判定を実施する（図７のステップＳＴ１１）。
0005904775.tif 000047
ただし、ｘｋ（−）ハットは航跡候補の予測値であり、下記の式（５２）で算出される。
0005904775.tif 000048
また、Ｓｋは残差共分散行列であり、下記の式（５３）で算出される。
0005904775.tif 000049
ただし、Ｐｋ（−）は予測誤差共分散行列であり、下記の式（５４）で算出される。
0005904775.tif 000050
【００５２】
ＰＲＩ内距離相関決定部２１は、レーダ１から目標まで距離であるＰＲＩ内距離の観測値と目標の航跡候補との相関判定を実施する（ステップＳＴ１２）。
具体的には、以下の通りである。
ＰＲＩ内距離の観測値から得られる距離情報の候補は、下記の式（５５）のように表される。
0005904775.tif 000051
ただし、ｒｐｒｉｋは候補中最短の距離であり、既知である。ΔＲｐｒｉはパルス間隔によって定まる折り返し幅であり、既知である。
これに対して、折り返し回数ｎは未知である。１サンプリング時刻前のＰＲＩ内距離についても同様に表現することができる。
0005904775.tif 000052
【００５３】
距離変化率が一定であると仮定すると、２サンプリング時刻のビート周波数の期待値は、以下のように算出することができる。
0005904775.tif 000053
【００５４】
ＰＲＩ内距離の相関可否は、以下の式の成否により決定される。
0005904775.tif 000054
0005904775.tif 000055
ただし、σ2ｆｂはビート周波数の観測値の観測誤差標準偏差、σ2ＲｐｒｉはＰＲＩ内距離の観測値の観測誤差標準偏差である。また、ｄｆｂｓは事前に設定されるパラメータである。
【００５５】
航跡抽出決定部２２は、ビート周波数ｆｂｋの観測値と目標の航跡候補との相関判定を実施し、ＰＲＩ内距離相関決定部２１がＰＲＩ内距離の観測値と目標の航跡候補との相関判定を実施すると、「航跡候補相関決定」として、ゲート内に入っている観測値を選択する（ステップＳＴ１３）。
観測値の選択方法として、式（５９）が成立する条件の下で、式（５１）の左辺の値が最も小さくなる観測値を選択して航跡候補に割り当てる方法や、ゲート内の観測値の全てついて、各々を割り当てた航跡候補を複数生成する方法などが考えられる。
【００５６】
航跡抽出決定部２２は、ゲート内に入っている観測値を選択すると、「フィルタ内状態更新」として、航跡候補に割り当てた観測値によって、カルマンフィルタの状態推定値を更新する（ステップＳＴ１４）。
例えば、現在の処理が航跡候補にとって、２番目のサンプリング時刻である場合、状態推定値は、下記の式（６３）に示すように、２サンプリング時刻分のビート周波数の観測値ｚｆｂ０，ｚｆｂ１より算出することができる。
0005904775.tif 000056
ただし、Δｔはサンプリング間隔である。
２つのビート周波数の観測値ｚｆｂ０，ｚｆｂ１の線形結合であるため、以降のカルマンフィルタに基づく処理で必要となる推定誤差共分散行列の初期値Ｐ１（＋）の各成分は、ビート周波数の観測誤差標準偏差より算出することができる。
【００５７】
現在の処理が航跡候補にとって、３番目以降のサンプリング時刻である場合、状態推定値は、下記の式（６４）に示すように、ビート周波数の観測値ｚｆｂｋより算出することができる。
0005904775.tif 000057
ただし、Ｉは単位行列、Ｋｋはカルマンゲインであり、下記の式（６６）で算出される。
0005904775.tif 000058
【００５８】
航跡抽出決定部２２は、カルマンフィルタの状態推定値を更新すると、航跡候補の尤度γｋを更新する（ステップＳＴ１５）。
航跡候補の尤度γｋは、ある観測値を用いて更新する場合、下記の式（６７）で算出される。
0005904775.tif 000059
ただし、γｋ−１は１サンプリング時刻前の当該航跡候補の尤度であり、尤度の初期値γ１は事前に設定されるパラメータである。
【００５９】
航跡候補の尤度γｋが、予め設定されている閾値ｔｈを越えない場合（ステップＳＴ１６）、この時点で１サンプリング時刻分の処理を終了する。
一方、航跡候補の尤度γｋが、予め設定されている閾値ｔｈを越える場合（ステップＳＴ１６）、ステップＳＴ１７の「運動諸元推定初期値生成」の処理に移行する。
即ち、航跡候補の尤度γｋが、予め設定されている閾値ｔｈを越える場合、航跡抽出決定部２２により目標が観測領域に存在していると判定されて、ステップＳＴ１７の「運動諸元推定初期値生成」の処理に移行する。
【００６０】
航跡抽出決定部２２により目標が観測領域に存在していると判定された場合、後述するステップＳＴ１７，ＳＴ１８において、これまでの間に、航跡候補に蓄積されたビート周波数ｆｂｋの観測値の時系列を用いて、目標の３次元空間上の位置と速度を推定する。推定する運動諸元を以下の現サンプリング時刻ｎにおける３次元空間上の位置，速度とする。
0005904775.tif 000060
【００６１】
初期値設定部１２は、航跡抽出決定部２２により目標が観測領域に存在していると判定されると、レーダ１の観測条件を示す事前情報にしたがって目標の運動諸元を推定する際に用いる運動諸元の状態探索の初期値ｘｎ＿１ハットを設定する（ステップＳＴ１７）。
即ち、初期値設定部１２は、図３に示すように、レーダ１の最大探索距離、レーダ１のビームが向いている方向及び初探索時刻におけるビート周波数の観測値（第１サンプリング時刻におけるビート周波数の観測値ｚｆｂ０）を用いて、運動諸元の状態探索の初期値ｘｎ＿１ハットを設定する。
図３に示すように、目標までの距離Ｒ０をレーダ１の最大探索距離、仰角及び方位角をビーム中心とすると、目標の３次元位置が決まる。
また、目標までの距離Ｒ０と、この航跡候補の第１サンプリング時刻におけるビート周波数の観測値ｚｆｂ０から、下記の式（６９）に示すように、目標の距離変化率Ｒ０ドットを算出することができる。
0005904775.tif 000061
【００６２】
目標速度の横行成分を０として、初探索時刻の運動諸元が決まる。この初探索時刻の運動諸元から、等速直進運動を仮定して最新時刻ｎに外挿し、探索の初期値とする。
レーダ１より仰角が得られない場合、上記のような初期値の設定が困難となる。この場合、目標高度は０と見做し、図４に示すように、地球の丸みから算出される観測可能領域の境界から初期値を算出する。
即ち、レーダ１の設置高度から求まる見通し角、方位角及び初探索時刻におけるビート周波数の観測値を用いて、運動諸元の状態探索の初期値ｘｎ＿１ハットを設定する。
【００６３】
運動諸元推定部１３は、初期値設定部１２が運動諸元の状態探索の初期値ｘｎ＿１ハットを設定すると、その初期値ｘｎ＿１ハットを運動諸元の状態探索の初期点に設定し、これまでの間に、航跡候補に蓄積されたビート周波数ｆｂｋの観測値の時系列を用いて、運動諸元の状態探索を実施することで、目標の運動諸元を推定する（ステップＳＴ１８）。
これにより、正確な運動諸元が推定されるが、以下、推定精度が改善される原理について説明する。
【００６４】
目標の運動として等速直進運動を仮定すると、最新時刻ｎにおける目標運動諸元が決まれば、下記の式（７０）に示すように、それ以前のサンプリング時刻ｋの運動諸元は一意に決まるので、目標の検出では、下記の式（７１）のように、ビート周波数列が抽出されるものとする。
0005904775.tif 000062
【００６５】
最新時刻ｎにおける推定値から、観測値は、下記の式（７２）に示すように予測することができる。
0005904775.tif 000063
上記の予測観測値と実際の観測値の差異が最も小さくなる推定値は、非線形最小自乗法により算出される。
0005904775.tif 000064
ここで、最小とする関数は、下記の式（７４）で定義される。
0005904775.tif 000065
ただし、σｆｂはビート周波数の観測値の観測誤差標準偏差、σａｚは方位角の観測値の観測誤差標準偏差、σｅｌは仰角の観測値の観測誤差標準偏差、σＲｐｒｉはＰＲＩ内距離の観測値の観測誤差標準偏差である。
【００６６】
運動諸元推定部１３は、初期値設定部１２により設定された初期値（距離は最大探索距離、速度は典型値であり、センサ方向に向かって直進しているときの速度）を出発点として、最適な状態をＮｅｗｔｏｎ法に従って探索する。
即ち、運動諸元推定部１３は、図５に示すように、状態探索の初期点ｘｎ＿１ハットから出発し、その初期点における目的関数の値Ｆ（ｚ１，…，ｚｎ，ｘｎ＿１ハット）と、その接平面の傾きから、次の探索点ｘｎ＿２ハットが決まる。
次の探索点ｘｎ＿３ハットについても探索点ｘｎ＿２ハットと同様に決まる（探索点ｘｎ＿３ハットについては、初期点ｘｎ＿１ハットの代わりに探索点ｘｎ＿２ハットを出発とする）。
探索点を繰り返し決定することで、目的関数が最小となる点ｘｎ＿ｏｐｔハットが決まり、点ｘｎ＿ｏｐｔハットが目標の運動諸元の推定値として出力される。
【００６７】
以上で明らかなように、この実施の形態２によれば、航跡抽出決定部２２が、レーダ１により得られるビート周波数ｆｂｋの観測値と目標の航跡候補との相関判定を実施し、ビート周波数ｆｂｋの観測値との相関が認められ、かつ、ＰＲＩ内距離相関決定部２１によりＰＲＩ内距離の観測値との相関が認められる航跡候補の有無から、目標が観測領域に存在しているか否かを判定するように構成したので、上記実施の形態１よりも、目標の検出精度を高めることができる効果を奏する。
即ち、ビート周波数ｆｂｋの観測値だけでは、誤相関が起きて目標航跡の抽出が遅れる場合でも、早期に目標航跡を抽出することができる。
また、運動諸元の推定における探索で、ビート周波数の観測値に加えて、方位角，仰角及びＰＲＩ内距離の観測値を利用するため、より高精度の解が得られる効果がある。
【００６８】
なお、本願発明はその発明の範囲内において、各実施の形態の自由な組み合わせ、あるいは各実施の形態の任意の構成要素の変形、もしくは各実施の形態において任意の構成要素の省略が可能である。
【符号の説明】
【００６９】
１  レーダ、２  目標追尾装置、１１  航跡抽出決定部（目標有無判定手段）、１２  初期値設定部（初期値設定手段）、１３  運動諸元推定部（運動諸元推定手段）、２１  ＰＲＩ内距離相関決定部（目標有無判定手段）、２２  航跡抽出決定部（目標有無判定手段）。
【図１】
0005904775.tif 000066
【図２】
0005904775.tif 000067
【図３】
0005904775.tif 000068
【図４】
0005904775.tif 000069
【図５】
0005904775.tif 000070
【図６】
0005904775.tif 000071
【図７】
0005904775.tif 000072
【図８】
0005904775.tif 000073
【図９】
0005904775.tif 000074
【図１０】
0005904775.tif 000075