JP5744320B2 - Positioning tracking device - Google Patents
Positioning tracking device Download PDFInfo
- Publication number
- JP5744320B2 JP5744320B2 JP2014507753A JP2014507753A JP5744320B2 JP 5744320 B2 JP5744320 B2 JP 5744320B2 JP 2014507753 A JP2014507753 A JP 2014507753A JP 2014507753 A JP2014507753 A JP 2014507753A JP 5744320 B2 JP5744320 B2 JP 5744320B2
- Authority
- JP
- Japan
- Prior art keywords
- tracking
- target
- processing unit
- positioning
- time difference
- 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.)
- Active
Links
- 238000012545 processing Methods 0.000 claims description 629
- 238000000034 method Methods 0.000 claims description 173
- 230000008569 process Effects 0.000 claims description 162
- 230000033001 locomotion Effects 0.000 claims description 154
- 230000007704 transition Effects 0.000 claims description 81
- 239000011159 matrix material Substances 0.000 claims description 21
- 230000000903 blocking effect Effects 0.000 claims description 17
- 230000001174 ascending effect Effects 0.000 claims description 12
- 238000005070 sampling Methods 0.000 claims description 10
- 230000001133 acceleration Effects 0.000 claims description 9
- 230000000694 effects Effects 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 3
- 238000004886 process control Methods 0.000 claims 4
- 238000010586 diagram Methods 0.000 description 37
- 239000004065 semiconductor Substances 0.000 description 24
- 238000009499 grossing Methods 0.000 description 14
- 238000001514 detection method Methods 0.000 description 6
- 238000009434 installation Methods 0.000 description 2
- 238000012876 topography Methods 0.000 description 2
- 238000004260 weight control Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 102100028285 DNA repair protein REV1 Human genes 0.000 description 1
- 230000001364 causal effect Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000006866 deterioration Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/06—Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/74—Systems using reradiation of radio waves, e.g. secondary radar systems; Analogous systems
- G01S13/76—Systems using reradiation of radio waves, e.g. secondary radar systems; Analogous systems wherein pulse-type signals are transmitted
- G01S13/78—Systems using reradiation of radio waves, e.g. secondary radar systems; Analogous systems wherein pulse-type signals are transmitted discriminating between different kinds of targets, e.g. IFF-radar, i.e. identification of friend or foe
- G01S13/781—Secondary Surveillance Radar [SSR] in general
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S3/00—Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received
- G01S3/02—Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received using radio waves
- G01S3/14—Systems for determining direction or deviation from predetermined direction
- G01S3/46—Systems for determining direction or deviation from predetermined direction using antennas spaced apart and measuring phase or time difference between signals therefrom, i.e. path-difference systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar Systems Or Details Thereof (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
この発明は、目標の位置の測位や目標の航跡を予測する測位追尾装置に関するものである。 The present invention relates to a positioning tracking device that predicts the positioning of a target position and the track of a target.
例えば、目標である航空機が、空港の滑走路や誘導路を旋回している状況では、図２５に示すように、目標の上方に設置されているトランスポンダ（ＴＲＡＮ１）又は目標の下方に設置されているトランスポンダ（ＴＲＡＮ２）のアンテナから送信される信号を、空港に設置されている複数の受信局（ＲＥＶ１〜ＲＥＶ６）が受信することで、その信号の到来時刻であるＴＯＡ（Ｔｉｍｅ Ｏｆ Ａｒｒｉｖａｌ）を取得する。
ここで、トランスポンダのアンテナは、一般的に、縦，横，高さが数１０ｃｍである。
また、航空機が目標である場合、一般的に、航空機の全長や尾翼が数１０ｍの大きさである。このため、トランスポンダのアンテナは、目標である航空機と比べて十分小さい。For example, in a situation where the target aircraft is turning on a runway or taxiway at an airport, as shown in FIG. 25, a transponder (TRAN1) installed above the target or below the target is installed. A signal transmitted from the antenna of the existing transponder (TRAN2) is received by a plurality of receiving stations (REV1 to REV6) installed at the airport, and the time of arrival (TOA) that is the arrival time of the signal is obtained. To do.
Here, the transponder antenna is generally several tens of centimeters in length, width, and height.
Moreover, when an aircraft is a target, generally, the total length of the aircraft and the tail are several tens of meters in size. For this reason, the antenna of the transponder is sufficiently small compared to the target aircraft.
このように、トランスポンダのアンテナが航空機と比べて十分小さいため、航空機が旋回している状況下において、航空機の尾翼などが、トランスポンダのアンテナから送信された信号を遮蔽して、受信局が信号を受信できない場合がある。図２５の例では、受信局（ＲＥＶ５，ＲＥＶ６）が信号を受信できていない。
また、図２５の例では、建物がトランスポンダのアンテナから送信された信号を遮蔽することで、受信局（ＲＥＶ４）が信号を受信できていない。In this way, since the antenna of the transponder is sufficiently small compared to the aircraft, under the circumstance where the aircraft is turning, the tail of the aircraft shields the signal transmitted from the antenna of the transponder, and the receiving station transmits the signal. You may not be able to receive. In the example of FIG. 25, the receiving stations (REV5 and REV6) cannot receive signals.
In the example of FIG. 25, the building blocks the signal transmitted from the antenna of the transponder, so that the receiving station (REV4) cannot receive the signal.
なお、目標である航空機が、空港の滑走路や誘導路を移動している場合、目標の下方に設置されているトランスポンダ（ＴＲＡＮ２）のアンテナから送信される信号は遮蔽されやすい状況にあるため、目標の上方に設置されているトランスポンダ（ＴＲＡＮ１）のアンテナから送信される信号が機能して、受信局が信号を受信すると思われる。
図２５は目標である航空機が、空港の滑走路や誘導路を旋回している状況を示しているが、目標である航空機が飛行中の場合、図２６に示すように、航空機の機体が、トランスポンダのアンテナから送信された信号を遮蔽して、受信局が信号を受信できない状況も考えられる。If the target aircraft is moving on a runway or taxiway at the airport, the signal transmitted from the antenna of the transponder (TRAN2) installed below the target is in a situation where it is easily shielded. It seems that the signal transmitted from the antenna of the transponder (TRAN1) installed above the target functions and the receiving station receives the signal.
FIG. 25 shows a situation in which the target aircraft is turning on a runway or taxiway at the airport. When the target aircraft is in flight, as shown in FIG. There may be a situation where the signal transmitted from the antenna of the transponder is shielded and the receiving station cannot receive the signal.
図２７は以下の非特許文献１に開示されている測位追尾装置を示す構成図である。
図２７の例では、（Ｎ＋１）個の受信局＃０，＃１，・・・，＃ｉ，・・・，＃Ｎが、目標である航空機に設置されているトランスポンダのアンテナから送信される信号を受信して、その信号の到来時刻であるＴＯＡを出力する。
以下、受信局＃０から出力されるＴＯＡをＴＯＡ（０）、受信局＃ｉから出力されるＴＯＡをＴＯＡ（ｉ）のように表記する。FIG. 27 is a configuration diagram showing a positioning tracking device disclosed in Non-Patent
In the example of FIG. 27, (N + 1)
Hereinafter, TOA output from the
ＴＤＯＡ算出処理部１０１は、基準の受信局から出力されるＴＯＡと、他の受信局から出力されるＴＯＡとの時刻差である到来時刻差（ＴＤＯＡ：Ｔｉｍｅ Ｄｉｆｆｅｒｅｎｃｅ Ｏｆ Ａｒｒｉｖａｌ）を算出する。
例えば、基準の受信局が受信局＃０である場合、受信局＃０から出力されるＴＯＡ（０）と、受信局＃ｉから出力されるＴＯＡ（ｉ）から、ＴＤＯＡ（ｉ）を算出する。
ＴＤＯＡ（ｉ）＝ＴＯＡ（ｉ）−ＴＯＡ（０）
ただし、ｉ＝１，２，・・・，Ｎである。The TDOA
For example, when the reference receiving station is receiving
TDOA (i) = TOA (i) -TOA (0)
However, i = 1, 2,..., N.
測位位置算出処理部１０２は、ＴＤＯＡ算出処理部１０１がＴＤＯＡ（ｉ）を算出すると、例えば、最小２乗法などの方法で、そのＴＤＯＡ（ｉ）から目標の測位位置を算出する。
ここでは、目標の測位位置として、目標の位置に関する３次元のベクトル（ｘ，ｙ，ｚ）を算出することを想定するが、目標の位置に関する２次元のベクトル（ｘ，ｙ）や、時刻バイアスｔｂと位置（ｘ，ｙ，ｚ）に関する４次元のベクトル（ｘ，ｙ，ｚ，ｔｂ）を算出することもできる。When the TDOA
Here, it is assumed that a three-dimensional vector (x, y, z) related to the target position is calculated as the target positioning position, but a two-dimensional vector (x, y) related to the target position, time bias A four-dimensional vector (x, y, z, tb) relating to tb and position (x, y, z) can also be calculated.
測位位置追尾処理部１０３は、測位位置算出処理部１０２が目標の測位位置を算出すると、目標の測位位置を線形カルマンフィルタに代入して、目標の追尾処理を実施することで、目標の航跡予測値と航跡平滑値を算出する。
ここで、目標の航跡は、目標の位置、速度、加速度等の次元を有する状態ベクトルと、誤差共分散行列（航跡予測値と測位位置の誤差を示す行列）とから構成される。
表示処理部１０４は、測位位置追尾処理部１０３が目標の航跡予測値と航跡平滑値を算出すると、目標の航跡予測値と航跡平滑値をディスプレイ等に表示する。When the positioning position
Here, the target wake is composed of a state vector having dimensions such as the target position, velocity, and acceleration, and an error covariance matrix (matrix indicating an error between the wake prediction value and the positioning position).
When the positioning position
ここで、測位位置算出処理部１０２により算出される測位位置の次元数がｎであるとすると、（ｎ＋１）個の受信局がトランスポンダから送信された信号を受信してＴＯＡを出力している必要がある。
例えば、２次元の位置を測位する場合は、ｎ＝２であり、３個の受信局がＴＯＡを出力している必要がある。
同様に、３次元の位置を測位する場合は、ｎ＝３であり、４個の受信局がＴＯＡを出力している必要がある。Here, assuming that the dimension number of the positioning position calculated by the positioning position
For example, when positioning a two-dimensional position, n = 2 and three receiving stations need to output TOA.
Similarly, when positioning a three-dimensional position, n = 3 and four receiving stations need to output TOA.
このため、測位位置算出処理部１０２では、例えば、４個の受信局＃０〜＃３が設置されている場合に、ある１個の受信局が信号を受信できずにＴＯＡを出力しなければ、３次元の位置を測位することができない。
また、４個の受信局が信号を受信してＴＯＡを出力していても、そのうちの２個の受信局が近接している場合、２個の受信局から出力されるＴＯＡには情報量の差がないため、実質的には、３個の受信局が信号を受信してＴＯＡを出力している場合と等価となり、１個の受信局が信号を受信できずにＴＯＡを出力していない状況下と同じになる。このような状況下では、３次元の位置を測位することができない。
また、遠方に設置されている受信局が信号を受信している場合、信号の受信電力が低くなり、ＴＯＡの精度が劣化することがある。このような場合、推定誤差が規定誤差に収まらないため、受信局が信号を受信できずにＴＯＡを出力していない状況下と同じになり、３次元の位置を測位することができない。For this reason, in the positioning position
Even if four receiving stations receive signals and output a TOA, if two of the receiving stations are close to each other, the TOA output from the two receiving stations has an amount of information. Since there is no difference, it is substantially equivalent to the case where three receiving stations receive signals and output TOA, and one receiving station cannot receive signals and does not output TOA. It will be the same as the situation. Under such circumstances, the three-dimensional position cannot be measured.
In addition, when a receiving station installed far away receives a signal, the received power of the signal is lowered, and the accuracy of TOA may be deteriorated. In such a case, since the estimation error does not fall within the specified error, it becomes the same as the situation where the receiving station cannot receive the signal and does not output the TOA, and the three-dimensional position cannot be measured.
したがって、図２５や図２６に示すように、目標である航空機の尾翼や機体、あるいは、建物による遮蔽によって、例えば、３次元の位置を測位する際に必要な４個の受信局がＴＯＡを出力していない場合、あるいは、ＴＯＡを出力している受信局が近接している状況下などでは、３次元の位置を測位することができない。
２次元の位置を測位する場合も、必要な受信局の個数が異なるだけで、３次元の位置を測位する場合と同様である。Therefore, as shown in FIG. 25 and FIG. 26, for example, four receiving stations required for positioning a three-dimensional position output TOA by shielding the target aircraft's tail, aircraft, or building. If it is not, or if the receiving station that outputs the TOA is close, the three-dimensional position cannot be measured.
The positioning of a two-dimensional position is the same as the case of positioning a three-dimensional position, except that the number of necessary receiving stations is different.
測位位置追尾処理部１０３は、上述したように、測位位置算出処理部１０２が目標の測位位置を算出すると、目標の測位位置を線形カルマンフィルタに代入して、目標の追尾処理を実施するものである。
このため、トランスポンダのアンテナから送信される信号を受信してＴＯＡを出力している受信局の個数が減少して、目標の位置を測位することができない状況下（信号の遮蔽が発生している状況）では、目標の航跡を正確に算出することが困難になる。
なお、測位位置追尾処理部１０３が目標の航跡予測値を算出する際、前回算出している航跡平滑値を用いるため、その航跡平滑値の算出精度が劣化していれば、現時点では目標の位置を測位できる状況（信号の遮蔽が解消している状況）になっていても、目標の航跡予測値の算出精度が劣化する。As described above, when the positioning position
For this reason, the number of receiving stations that receive signals transmitted from the antenna of the transponder and output the TOA decreases, and the target position cannot be measured (signal shielding occurs). Situation), it is difficult to accurately calculate the target track.
Note that when the positioning position
従来の測位追尾装置は以上のように構成されているので、トランスポンダのアンテナから送信される信号を受信してＴＯＡを出力している受信局の個数が減少して、目標の位置を測位することができない状況下（信号の遮蔽が発生している状況）になり、一旦、目標の航跡精度が劣化すると、その後、目標の位置を測位できる状況（信号の遮蔽が解消している状況）に戻っても、直ぐには、目標の航跡精度が元の航跡精度まで回復しないなどの課題があった。 Since the conventional positioning tracking device is configured as described above, the number of receiving stations that receive signals transmitted from the antenna of the transponder and output the TOA is reduced, and the target position is measured. Once the target track accuracy has deteriorated, the target position can be measured (signal blocking is eliminated). However, there was a problem that the target track accuracy did not recover to the original track accuracy immediately.
この発明は上記のような課題を解決するためになされたもので、目標の位置を測位することができない状況下になっても、その後、目標の位置を測位できる状況になれば、直ちに、目標の航跡を正確に算出することができる測位追尾装置を得ることを目的とする。 The present invention has been made to solve the above-described problems. Even when the target position cannot be measured, the target position can be determined immediately after the target position can be determined. An object of the present invention is to obtain a positioning tracking device capable of accurately calculating the wake of the vehicle.
この発明に係る測位追尾装置は、目標から送信される信号を受信して、信号の到来時刻を出力する複数の受信局と、複数の受信局から出力された到来時刻の時刻差である到来時刻差を算出する到来時刻差算出手段と、到来時刻差算出手段により算出された到来時刻差から目標の位置を測位する位置測位手段と、位置測位手段により測位された目標の位置を追尾処理用のフィルタに代入して、目標の追尾処理を実施することで、目標の航跡予測値と航跡平滑値を算出する目標追尾手段と、目標追尾手段により算出された目標の航跡予測値と航跡平滑値を表示する表示手段と、目標と複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段とを設け、フィルタリセット手段が、信号遮蔽判定手段により信号遮蔽が発生していると判定された場合、追尾処理用のフィルタによる航跡をリセットするようにしたものである。 The positioning tracking device according to the present invention receives a signal transmitted from a target and outputs a signal arrival time, and arrival times that are time differences between arrival times output from the plurality of reception stations. An arrival time difference calculating means for calculating a difference; a position positioning means for determining a target position from the arrival time difference calculated by the arrival time difference calculating means; and a target position determined by the position positioning means for tracking processing. By substituting into the filter and performing the target tracking process, the target tracking means for calculating the target track prediction value and the track smoothing value, and the target track prediction value and the track smoothing value calculated by the target tracking means are obtained. Display means for displaying and signal shielding determining means for determining whether or not signal shielding has occurred between the target and a plurality of receiving stations are provided, and the filter reset means has signal shielding caused by the signal shielding determining means. If it is determined that, in which so as to reset the track by the filter for the tracking process.
この発明によれば、目標と複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段を設け、フィルタリセット手段が、信号遮蔽判定手段により信号遮蔽が発生していると判定された場合、追尾処理用のフィルタによる航跡をリセットするように構成したので、目標の位置を測位することができない状況下になっても、その後、目標の位置を測位できる状況になれば、直ちに、目標の航跡を正確に算出することができる効果がある。 According to the present invention, the signal shielding determining means for determining whether or not signal shielding has occurred between the target and the plurality of receiving stations is provided, and the filter resetting means has the signal shielding caused by the signal shielding determining means. If it is determined that the track of the target is reset, the wake of the tracking process filter is reset. Immediately, the target track can be accurately calculated.
以下、この発明をより詳細に説明するために、この発明を実施するための形態について、添付の図面に従って説明する。
実施の形態１．
図１はこの発明の実施の形態１による測位追尾装置を示す構成図である。
図１において、（Ｎ＋１）個の受信局＃０，＃１，・・・，＃ｉ，・・・，＃Ｎは航空機（目標）に設置されているトランスポンダのアンテナから送信される信号を受信して、その信号の到来時刻であるＴＯＡ（Ｔｉｍｅ Ｏｆ Ａｒｒｉｖａｌ）を出力する。
以下、受信局＃０から出力されるＴＯＡをＴＯＡ（０）、受信局＃ｉから出力されるＴＯＡをＴＯＡ（ｉ）のように表記する。Hereinafter, in order to explain the present invention in more detail, modes for carrying out the present invention will be described with reference to the accompanying drawings.
1 is a block diagram showing a positioning tracking device according to
In FIG. 1, (N + 1) receiving
Hereinafter, TOA output from the receiving
ＴＤＯＡ算出処理部１は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、基準の受信局から出力されるＴＯＡと、他の受信局から出力されるＴＯＡとの時刻差である到来時刻差（ＴＤＯＡ：Ｔｉｍｅ Ｄｉｆｆｅｒｅｎｃｅ Ｏｆ Ａｒｒｉｖａｌ）を算出する処理を実施する。なお、ＴＤＯＡ算出処理部１は到来時刻差算出手段を構成している。
例えば、基準の受信局が受信局＃０である場合、受信局＃０から出力されるＴＯＡ（０）と、受信局＃ｉから出力されるＴＯＡ（ｉ）から、ＴＤＯＡ（ｉ）を算出する。
ＴＤＯＡ（ｉ）＝ＴＯＡ（ｉ）−ＴＯＡ（０）
ただし、ｉ＝１，２，・・・，Ｎである。The TDOA
For example, when the reference receiving station is receiving
TDOA (i) = TOA (i) -TOA (0)
However, i = 1, 2,..., N.
測位位置算出処理部２は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ算出処理部１により算出されたＴＤＯＡ（ｉ）から目標の測位位置を算出する処理を実施する。なお、測位位置算出処理部２は位置測位手段を構成している。
測位位置追尾処理部３は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、測位位置算出処理部２により算出された目標の測位位置を例えば線形カルマンフィルタ（追尾処理用のフィルタ）に代入して、目標の追尾処理を実施することで、目標の航跡予測値と航跡平滑値を算出する。なお、測位位置追尾処理部３は目標追尾手段を構成している。
表示処理部４は例えばＧＰＵ（Ｇｒａｐｈｉｃｓ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）などから構成されており、測位位置追尾処理部３により算出された目標の航跡予測値と航跡平滑値をディスプレイに表示する処理を実施する。なお、表示処理部４は表示手段を構成している。The positioning position
The positioning position tracking processing unit 3 is composed of, for example, a semiconductor integrated circuit on which a CPU is mounted, or a one-chip microcomputer, and the target positioning position calculated by the positioning position
The
旋回遮蔽判定処理部５は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、（Ｎ＋１）個の受信局＃ｉによるＴＯＡ（ｉ）の出力状況及び測位位置算出処理部２による位置の測位状況を考慮して、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生しているか否かを判定する処理を実施する。なお、旋回遮蔽判定処理部５は信号遮蔽判定手段を構成している。
フィルタリセット処理部６は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、旋回遮蔽判定処理部５により航空機の旋回に伴う信号遮蔽が発生していると判定された場合、線形カルマンフィルタによる航跡のリセットを指示するフィルタ制御信号を測位位置追尾処理部３に出力する処理を実施する。なお、フィルタリセット処理部６はフィルタリセット手段を構成している。The turning shield
The filter
図１の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、測位位置追尾処理部３、表示処理部４、旋回遮蔽判定処理部５及びフィルタリセット処理部６のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、測位位置追尾処理部３、表示処理部４、旋回遮蔽判定処理部５及びフィルタリセット処理部６の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。In the example of FIG. 1, the receiving
For example, when the part excluding the receiving
次に動作について説明する。
（Ｎ＋１）個の受信局＃ｉは、目標である航空機に設置されているトランスポンダのアンテナから時系列に送信される信号を受信して、その信号の到来時刻であるＴＯＡ（ｉ）を時系列に出力する。ただし、ｉ＝０，１，２，・・・，Ｎである。
この実施の形態１では、説明の便宜上、受信局＃０が基準の受信局であるとして説明する。Next, the operation will be described.
(N + 1) receiving stations #i receive signals transmitted in time series from antennas of transponders installed in the target aircraft, and time-series TOA (i) that is the arrival time of the signals. Output to. However, i = 0, 1, 2,..., N.
In the first embodiment, for convenience of explanation, it is assumed that the receiving
ＴＤＯＡ算出処理部１は、受信局＃ｉからＴＯＡを受けると、基準の受信局である受信局＃０から出力されたＴＯＡ（０）と、他の受信局から出力されたＴＯＡ（ｉ）との時刻差であるＴＤＯＡ（ｉ）を算出する。
ＴＤＯＡ（ｉ）＝ＴＯＡ（ｉ）−ＴＯＡ（０）
ただし、ｉ＝１，２，・・・，Ｎである。When the TDOA
TDOA (i) = TOA (i) -TOA (0)
However, i = 1, 2,..., N.
測位位置算出処理部２は、ＴＤＯＡ算出処理部１がＴＤＯＡ（ｉ）を算出すると、例えば、最小２乗法などの方法で、そのＴＤＯＡ（ｉ）から目標の測位位置を算出する。ＴＤＯＡ（ｉ）から目標の測位位置を算出する処理自体は、公知の技術であるため、詳細な説明は省略する。
ここでは、目標の測位位置として、目標の位置に関する３次元のベクトル（ｘ，ｙ，ｚ）を算出することを想定するが、目標の位置に関する２次元のベクトル（ｘ，ｙ）や、時刻バイアスｔｂと位置（ｘ，ｙ，ｚ）に関する４次元のベクトル（ｘ，ｙ，ｚ，ｔｂ）を算出することもできる。When the TDOA
Here, it is assumed that a three-dimensional vector (x, y, z) related to the target position is calculated as the target positioning position, but a two-dimensional vector (x, y) related to the target position, time bias A four-dimensional vector (x, y, z, tb) relating to tb and position (x, y, z) can also be calculated.
測位位置追尾処理部３は、測位位置算出処理部２が目標の測位位置を算出すると、目標の測位位置を例えば線形カルマンフィルタに代入して、目標の追尾処理を実施することで、目標の航跡予測値と航跡平滑値を算出する。線形カルマンフィルタを用いて、目標の航跡予測値と航跡平滑値を算出する処理自体は、公知の技術であるため、詳細な説明は省略する。
ここで、目標の航跡は、目標の位置、速度、加速度等の次元を有する状態ベクトルと、誤差共分散行列（航跡予測値と測位位置の誤差を示す行列）とから構成される。
表示処理部４は、測位位置追尾処理部３が目標の航跡予測値と航跡平滑値を算出すると、目標の航跡予測値と航跡平滑値をディスプレイ等に表示する。When the positioning position
Here, the target wake is composed of a state vector having dimensions such as the target position, velocity, and acceleration, and an error covariance matrix (matrix indicating an error between the wake prediction value and the positioning position).
When the positioning position tracking processing unit 3 calculates the target track predicted value and the track smooth value, the
ここで、測位位置算出処理部２により算出される測位位置の次元数がｎであるとすると、（ｎ＋１）個の受信局がトランスポンダから送信された信号を受信してＴＯＡを出力している必要がある。
例えば、２次元の位置を測位する場合は、ｎ＝２であり、３個の受信局がＴＯＡを出力している必要がある。
同様に、３次元の位置を測位する場合は、ｎ＝３であり、４個の受信局がＴＯＡを出力している必要がある。Here, if the dimension number of the positioning position calculated by the positioning position
For example, when positioning a two-dimensional position, n = 2 and three receiving stations need to output TOA.
Similarly, when positioning a three-dimensional position, n = 3 and four receiving stations need to output TOA.
旋回遮蔽判定処理部５は、（Ｎ＋１）個の受信局＃ｉから出力されるＴＯＡ（ｉ）を時系列に入力するとともに、測位位置算出処理部２により算出される測位位置を時系列に入力する。
旋回遮蔽判定処理部５は、受信局毎にＴＯＡ（ｉ）の時系列を管理し、下記の条件（１）又は条件（２）を満足する場合、あるいは、条件（１）及び条件（２）を満足する場合、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生していると判定する。The turning shield
The turning shield
［条件（１）］
Ｍ1回のサンプリング期間において、ＴＯＡ（ｉ）を出力している受信局＃ｉの個数ａが、測位位置の算出に必要な個数ｂに満たないサンプリング（ａ＜ｂ）の回数ＴがＮ1（Ｔ＞Ｎ1）回を超えている。例えば、２次元測位であれば、ｂ＝３、３次元測位であれば、ｂ＝４である。
［条件（２）］
測位位置算出処理部２により算出される測位位置が欠落している（条件（１）を満足していない場合でも、受信局＃ｉから出力されるＴＯＡ（ｉ）にバラツキがあるために、測位位置の算出が不可能な場合があるため、測位位置算出処理部２により算出される測位位置が欠落している場合も、条件に含めている）。[Condition (1)]
In the sampling period of M 1 times, the number T of samplings (a <b) where the number a of the receiving stations #i outputting TOA (i) is less than the number b necessary for calculating the positioning position is N 1. (T> N 1 ) times. For example, b = 3 for two-dimensional positioning and b = 4 for three-dimensional positioning.
[Condition (2)]
The positioning position calculated by the positioning position
フィルタリセット処理部６は、旋回遮蔽判定処理部５により航空機の旋回に伴う信号遮蔽が発生していると判定された場合、線形カルマンフィルタによる航跡のリセットを指示するフィルタ制御信号を測位位置追尾処理部３に出力する。
測位位置追尾処理部３は、フィルタリセット処理部６から航跡のリセットを指示するフィルタ制御信号を受けると、線形カルマンフィルタによる航跡をリセット（過去に算出している航跡平滑値を消去）し、前回算出している航跡平滑値を用いずに、目標の追尾処理を実施して、目標の航跡予測値と航跡平滑値を算出する。The filter
When the positioning position tracking processing unit 3 receives a filter control signal instructing resetting of the wake from the filter
ここで、図２は航跡の追尾処理結果を示す説明図である。
（ａ）は航跡をリセットしない場合の追尾処理結果を示し、（ｂ）は航跡をリセットした場合の追尾処理結果を示している。
図２において、○は観測値（目標の測位位置）を示しており、太線矢印は航跡、点線は真の目標軌跡である。
図２の例では、目標である航空機の旋回に伴って、ＴＯＡが欠落して、ＴＤＯＡが欠落し、その結果、測位位置が欠落している。
即ち、ＴＯＡが欠落することで、ＴＤＯＡを算出することができずにＴＤＯＡが欠落し、さらに、ＴＤＯＡが欠落することで、目標の測位位置を算出することができずに測位位置が欠落するという因果関係になっている。Here, FIG. 2 is an explanatory view showing a result of tracking processing of a wake.
(A) shows the tracking process result when the wake is not reset, and (b) shows the tracking process result when the wake is reset.
In FIG. 2, ◯ indicates an observed value (target positioning position), a thick arrow indicates a wake, and a dotted line indicates a true target locus.
In the example of FIG. 2, as the target aircraft turns, the TOA is missing and the TDOA is missing. As a result, the positioning position is missing.
That is, when the TOA is missing, the TDOA cannot be calculated and the TDOA is missing. Further, when the TDOA is missing, the target positioning position cannot be calculated and the positioning position is missing. It is a causal relationship.
目標の測位位置が欠落していても、旋回前の過去の航跡を用いて、目標の追尾処理を実施すると、図２（ａ）に示すように、目標の航跡予測値として、概ね過去の航跡が示す方向の延長線上に位置するような値を算出してしまう航跡のオーバーシュートが発生するため、航跡の精度が劣化する。航跡のオーバーシュートの影響は、旋回の終了後に、目標の測位位置が得られるようになっても受けるため、航跡精度の劣化が改善するまでに長時間を要する。
これに対して、目標の測位位置が欠落すると、旋回前の過去の航跡をリセットして、過去の航跡を用いずに、目標の追尾処理を実施する場合、航跡のオーバーシュートの影響を受けないため、旋回の終了後に、目標の測位位置が得られると、図２（ｂ）に示すように、航跡精度が直ぐに改善する。Even if the target positioning position is missing, if the target tracking process is performed using the past track before the turn, as shown in FIG. The overshoot of the wake that calculates a value that lies on the extension line in the direction indicated by 発 生 occurs, so the accuracy of the wake deteriorates. The influence of the overshoot of the wake is received even if the target positioning position can be obtained after the turn is completed, and thus it takes a long time to improve the deterioration of the wake accuracy.
On the other hand, if the positioning position of the target is missing, the past track before the turn is reset, and when the target tracking process is performed without using the past track, it is not affected by the overshoot of the track. Therefore, when the target positioning position is obtained after the turn is completed, the wake accuracy is immediately improved as shown in FIG.
以上で明らかなように、この実施の形態１によれば、（Ｎ＋１）個の受信局＃ｉによるＴＯＡ（ｉ）の出力状況及び測位位置算出処理部２による位置の測位状況を考慮して、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生しているか否かを判定する旋回遮蔽判定処理部５を設け、フィルタリセット処理部６が、旋回遮蔽判定処理部５により航空機の旋回に伴う信号遮蔽が発生していると判定された場合、線形カルマンフィルタによる航跡のリセットを指示するフィルタ制御信号を測位位置追尾処理部３に出力するように構成したので、目標の位置を測位することができない状況下になっても、その後、目標の位置を測位できる状況になれば、直ちに、目標の航跡を正確に算出することができる効果を奏する。
As apparent from the above, according to the first embodiment, considering the output status of TOA (i) by (N + 1) receiving stations #i and the positioning status of the position by the positioning position
実施の形態２．
図３はこの発明の実施の形態２による測位追尾装置を示す構成図であり、図において、図１と同一符号は同一または相当部分を示すので説明を省略する。
ＴＤＯＡ追尾処理部７は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ算出処理部１により算出されたＴＤＯＡ（ｉ）を、例えば観測モデルに関する拡張カルマンフィルタ（追尾処理用のフィルタ）に代入して、目標の追尾処理を実施することで、目標の航跡予測値と航跡平滑値を算出する。
即ち、ＴＤＯＡ追尾処理部７はＴＤＯＡ算出処理部１により算出されたＴＤＯＡ（ｉ）を観測値として、観測モデルに関する拡張カルマンフィルタに基づいて、航跡予測値を算出する予測処理と、航跡平滑値を算出する平滑処理と、その航跡予測値と観測値の誤差共分散行列から計算される広がりと航跡予測値を中心とするゲート内に、その観測値が入るか否かを判定するゲート処理とを実施する。なお、ＴＤＯＡ追尾処理部７は目標追尾手段を構成している。
3 is a block diagram showing a positioning tracking apparatus according to
The TDOA
That is, the TDOA
図３の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部５及びフィルタリセット処理部６のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部５及びフィルタリセット処理部６の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。In the example of FIG. 3, the receiving
For example, when the portion excluding the receiving
上記実施の形態１では、測位位置追尾処理部３が、測位位置算出処理部２により算出された目標の測位位置を観測値として、線形カルマンフィルタに基づいて、目標の追尾処理を実施するものを示しているが、この実施の形態２では、ＴＤＯＡ追尾処理部７が、ＴＤＯＡ算出処理部１により算出されたＴＤＯＡ（ｉ）を観測値として、観測モデルに関する拡張カルマンフィルタに基づいて、目標の追尾処理を実施している点で相違している。
In the first embodiment, the positioning position tracking processing unit 3 performs target tracking processing based on a linear Kalman filter using the target positioning position calculated by the positioning position
図４（ａ）は測位位置追尾処理部３による追尾処理の処理イメージを示し、（ｂ）はＴＤＯＡ追尾処理部７による追尾処理の処理イメージを示す説明図である。
図４の例では、時刻ｔ０に目標の航跡があり、時刻ｔ１に観測値Ａｏ１、時刻ｔ２に観測値Ｂｏ２、時刻ｔ３に観測値Ｃｏ３が算出される観測状況を表している。
ここで、観測値は、ＴＤＯＡ観測値又は距離差観測値である。
なお、距離差とＴＤＯＡの間には、「距離差＝光速×ＴＤＯＡ」の関係がある。ただし、光速は一定値である。FIG. 4A shows a processing image of the tracking process by the positioning position tracking processing unit 3, and FIG. 4B is an explanatory diagram showing a processing image of the tracking process by the TDOA
In the example of FIG. 4, there is an observation situation in which there is a target wake at time t0, the observed value Ao1 at time t1, the observed value Bo2 at time t2, and the observed value Co3 at time t3.
Here, the observed value is a TDOA observed value or a distance difference observed value.
Note that there is a relationship “distance difference = light speed × TDOA” between the distance difference and TDOA. However, the speed of light is a constant value.
例えば、測位位置算出処理部２が、２次元の測位位置を算出する場合、同時刻に３つの観測値を使用して、測位位置を算出しようとするが、図４（ａ）の場合、時刻ｔ１，ｔ２，ｔ３において、観測値が１入力であるため、測位位置を算出することができない。
このため、図４（ａ）の場合、時刻ｔ１，ｔ２，ｔ３では、測位位置追尾処理部３が追尾処理を実施することができない。For example, when the positioning position
For this reason, in the case of Fig.4 (a), the positioning position tracking process part 3 cannot implement a tracking process in time t1, t2, t3.
図４（ｂ）において、Ｂｐ１，Ｃｐ１は前時刻ｔ０の航跡に基づく予測観測値、Ａｐ２，Ｃｐ２は前時刻ｔ１の航跡に基づく予測観測値、Ａｐ３，Ｂｐ３は前時刻ｔ２の航跡に基づく予測観測値を表している。
例えば、ＴＤＯＡ追尾処理部７が、時刻ｔ１における２次元の追尾位置を算出する場合、前時刻ｔ０の航跡に基づく予測観測値Ｂｐ１，Ｃｐ１と観測値Ａｏ１を用いて算出することが可能である。
時刻ｔ２においても、同様に、前時刻ｔ１の航跡に基づく予測観測値Ａｐ２，Ｃｐ２と観測値Ｂｏ２を用いて、２次元の追尾位置を算出することが可能である。
また、時刻ｔ３においても、同様に、前時刻ｔ２の航跡に基づく予測観測値Ａｐ３，Ｂｐ３と観測値Ｃｏ３を用いて、２次元の追尾位置を算出することが可能である。In FIG. 4B, Bp1 and Cp1 are predicted observation values based on the track at the previous time t0, Ap2 and Cp2 are predicted observation values based on the track at the previous time t1, and Ap3 and Bp3 are predicted observations based on the track at the previous time t2. Represents a value.
For example, when the TDOA
Similarly, at time t2, it is possible to calculate a two-dimensional tracking position using the predicted observation values Ap2, Cp2 and the observation value Bo2 based on the track at the previous time t1.
Similarly, at time t3, a two-dimensional tracking position can be calculated using the predicted observation values Ap3, Bp3 and the observation value Co3 based on the track at the previous time t2.
以上より明らかなように、ＴＤＯＡ追尾処理部７による追尾処理では、測位に必要な数だけＴＤＯＡが揃わない状況においても、目標の追尾処理を実行して、航跡を安定的に生成することができる。
図４では、２次元の追尾位置の算出例を示しているが、３次元の追尾位置の算出の場合も、次元が異なるだけで、２次元の追尾位置の算出の場合と同じ手順である。As is clear from the above, the tracking process performed by the TDOA
FIG. 4 shows an example of calculating the two-dimensional tracking position, but the calculation of the three-dimensional tracking position is the same as the calculation of the two-dimensional tracking position except that the dimensions are different.
なお、フィルタリセット処理部６は、旋回遮蔽判定処理部５が、上記実施の形態１と同様の方法で、航空機の旋回に伴う信号遮蔽が発生していると判定すると、拡張カルマンフィルタによる航跡のリセットを指示するフィルタ制御信号をＴＤＯＡ追尾処理部７に出力する。
ＴＤＯＡ追尾処理部７は、フィルタリセット処理部６から航跡のリセットを指示するフィルタ制御信号を受けると、拡張カルマンフィルタによる航跡をリセット（過去に算出している航跡平滑値を消去）し、前回算出している航跡平滑値を用いずに、目標の追尾処理を実施して、目標の航跡予測値と航跡平滑値を算出する。The filter
When the TDOA
実施の形態３．
図５はこの発明の実施の形態３による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
旋回遮蔽判定処理部８は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ算出処理部１によるＴＤＯＡ（ｉ）の算出状況及び測位位置算出処理部２による位置の測位状況を考慮して、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生しているか否かを判定する処理を実施する。なお、旋回遮蔽判定処理部８は信号遮蔽判定手段を構成している。Embodiment 3 FIG.
FIG. 5 is a block diagram showing a positioning tracking device according to Embodiment 3 of the present invention. In the figure, the same reference numerals as those in FIG.
The turning shielding
図５の測位追尾装置は、旋回遮蔽判定処理部８を図３の測位追尾装置に適用している例を示しているが、旋回遮蔽判定処理部８を図１の測位追尾装置に適用してもよい。
図５の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部８及びフィルタリセット処理部６のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部８及びフィルタリセット処理部６の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 5 shows an example in which the turning shield
In the example of FIG. 5, receiving
For example, when the portion excluding the receiving
上記実施の形態１，２では、旋回遮蔽判定処理部５が、条件（１）又は条件（２）を満足する場合、あるいは、条件（１）及び条件（２）を満足する場合、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生していると判定するものを示したが、旋回遮蔽判定処理部８が、下記の条件（３）又は条件（４）を満足する場合、あるいは、条件（３）及び条件（４）を満足する場合、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生していると判定するようにしてもよい。
In the first and second embodiments, the turning shielding
［条件（３）］
Ｍ2回のサンプリング期間において、ＴＤＯＡ（ｉ）の算出個数ｃが、測位位置の算出に必要な個数ｄに満たないサンプリング（ｃ＜ｄ）の回数ＴがＮ2（Ｔ＞Ｎ2）回を超えている。例えば、２次元測位であれば、ｄ＝３、３次元測位であれば、ｄ＝４である。
［条件（４）］
測位位置算出処理部２により算出される測位位置が欠落している（条件（３）を満足していない場合でも、ＴＤＯＡ算出処理部１により算出されるＴＤＯＡ（ｉ）にバラツキがあるために、測位位置の算出が不可能な場合があるため、測位位置算出処理部２により算出される測位位置が欠落している場合も、条件に含めている）。[Condition (3)]
In the M 2 sampling periods, the number T of samplings (c <d) where the calculated number c of TDOA (i) is less than the number d necessary for calculating the positioning position is N 2 (T> N 2 ). Over. For example, d = 3 for two-dimensional positioning and d = 4 for three-dimensional positioning.
[Condition (4)]
The positioning position calculated by the positioning position
フィルタリセット処理部６は、旋回遮蔽判定処理部８により航空機の旋回に伴う信号遮蔽が発生していると判定された場合、航跡のリセットを指示するフィルタ制御信号をＴＤＯＡ追尾処理部７に出力する。
ＴＤＯＡ追尾処理部７は、フィルタリセット処理部６から航跡のリセットを指示するフィルタ制御信号を受けると、航跡をリセット（過去に算出している航跡平滑値を消去）し、前回算出している航跡平滑値を用いずに、目標の追尾処理を実施して、目標の航跡予測値と航跡平滑値を算出する。The filter
When the TDOA
この実施の形態３の場合も、上記実施の形態１，２と同様に、目標の位置を測位することができない状況下になっても、その後、目標の位置を測位できる状況になれば、直ちに、目標の航跡を正確に算出することができる効果を奏する。 In the case of the third embodiment, as in the first and second embodiments, even if the target position cannot be measured, if the target position can be determined after that, There is an effect that the track of the target can be accurately calculated.
実施の形態４．
図６はこの発明の実施の形態４による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
旋回遮蔽判定処理部９は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、（Ｎ＋１）個の受信局＃ｉによるＴＯＡ（ｉ）の出力状況を考慮して、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生しているか否かを判定する処理を実施する。なお、旋回遮蔽判定処理部９は信号遮蔽判定手段を構成している。
6 is a block diagram showing a positioning tracking device according to
The turning shield determination processing unit 9 is composed of, for example, a semiconductor integrated circuit on which a CPU is mounted, a one-chip microcomputer, or the like, considering the output status of TOA (i) by (N + 1) receiving stations #i. Thus, a process is performed to determine whether or not there is signal shielding accompanying the turning of the aircraft between the target aircraft and the plurality of receiving stations. The turning shielding determination processing unit 9 constitutes a signal shielding determination unit.
図６の測位追尾装置は、旋回遮蔽判定処理部９を図３の測位追尾装置に適用している例を示しているが、旋回遮蔽判定処理部９を図１の測位追尾装置に適用してもよい。
図６の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部９及びフィルタリセット処理部６のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部９及びフィルタリセット処理部６の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 6 shows an example in which the turning shielding determination processing unit 9 is applied to the positioning tracking device of FIG. 3, but the turning shielding determination processing unit 9 is applied to the positioning tracking device of FIG. Also good.
In the example of FIG. 6, receiving
For example, when the portion excluding the receiving
上記実施の形態１，２では、旋回遮蔽判定処理部５が、条件（１）又は条件（２）を満足する場合、あるいは、条件（１）及び条件（２）を満足する場合、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生していると判定するものを示したが、旋回遮蔽判定処理部９が、条件（２）を満足しているか否かを判定せずに、条件（１）を満足する場合に、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生していると判定するようにしてもよい。
この場合、条件（２）を満足していても、信号遮蔽が発生していると判定されないため、判定精度が若干低下するが、判定処理の処理負荷が軽減される効果が得られる。In the first and second embodiments, the turning shielding
In this case, even if the condition (2) is satisfied, since it is not determined that signal shielding has occurred, the determination accuracy is slightly reduced, but the effect of reducing the processing load of the determination process is obtained.
実施の形態５．
図７はこの発明の実施の形態５による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
旋回遮蔽判定処理部１０は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ算出処理部１によるＴＤＯＡ（ｉ）の算出状況を考慮して、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生しているか否かを判定する処理を実施する。なお、旋回遮蔽判定処理部１０は信号遮蔽判定手段を構成している。
7 is a block diagram showing a positioning tracking apparatus according to
The turning shield
図７の測位追尾装置は、旋回遮蔽判定処理部１０を図３の測位追尾装置に適用している例を示しているが、旋回遮蔽判定処理部１０を図１の測位追尾装置に適用してもよい。
図７の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部１０及びフィルタリセット処理部６のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部１０及びフィルタリセット処理部６の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 7 shows an example in which the turning shielding
In the example of FIG. 7, the receiving
For example, when the portion excluding the receiving
上記実施の形態３では、旋回遮蔽判定処理部８が、条件（３）又は条件（４）を満足する場合、あるいは、条件（３）及び条件（４）を満足する場合、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生していると判定するものを示したが、旋回遮蔽判定処理部９が、条件（４）を満足しているか否かを判定せずに、条件（３）を満足する場合に、目標である航空機と複数の受信局間で、航空機の旋回に伴う信号遮蔽が発生していると判定するようにしてもよい。
この場合、条件（４）を満足していても、信号遮蔽が発生していると判定されないため、判定精度が若干低下するが、判定処理の処理負荷が軽減される効果が得られる。In the third embodiment, when the turning shielding
In this case, even if the condition (4) is satisfied, since it is not determined that signal shielding has occurred, the determination accuracy is slightly reduced, but the effect of reducing the processing load of the determination process is obtained.
実施の形態６．
図８はこの発明の実施の形態６による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
静止物遮蔽判定処理部１１は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ追尾処理部７により算出された航跡予測値が、目標と受信局＃ｉの間に所定の静止物が入り込む位置であるか否かを判定する処理を実施する。
移動物遮蔽判定処理部１２は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ追尾処理部７により算出された航跡予測値が、目標と受信局＃ｉの間に所定の移動物が入り込む位置であるか否かを判定する処理を実施する。
なお、静止物遮蔽判定処理部１１及び移動物遮蔽判定処理部１２から位置判定手段が構成されている。
8 is a block diagram showing a positioning tracking apparatus according to
The stationary object shielding
The moving object shielding
The stationary object shielding
総合遮蔽判定処理部１３は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定されている場合、静止物遮蔽判定処理部１１により航跡予測値が、静止物が入り込む位置であると判定されておらず、かつ、移動物遮蔽判定処理部１２により航跡予測値が、移動物が入り込む位置であると判定されていなければ、拡張カルマンフィルタによる航跡のリセットを指示するフィルタ制御信号をＴＤＯＡ追尾処理部７に出力する処理を実施する。なお、総合遮蔽判定処理部１３はフィルタリセット手段を構成している。
The comprehensive shielding
図８の測位追尾装置は、静止物遮蔽判定処理部１１、移動物遮蔽判定処理部１２及び総合遮蔽判定処理部１３を図３の測位追尾装置に適用している例を示しているが、静止物遮蔽判定処理部１１、移動物遮蔽判定処理部１２及び総合遮蔽判定処理部１３を図１の測位追尾装置に適用してもよい。
図８の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部５、静止物遮蔽判定処理部１１、移動物遮蔽判定処理部１２及び総合遮蔽判定処理部１３のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部５、静止物遮蔽判定処理部１１、移動物遮蔽判定処理部１２及び総合遮蔽判定処理部１３の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 8 shows an example in which the stationary object shielding
In the example of FIG. 8, the receiving
For example, when the portion excluding the receiving
次に動作について説明する。
静止物遮蔽判定処理部１１、移動物遮蔽判定処理部１２及び総合遮蔽判定処理部１３を実装している点以外は、上記実施の形態１〜５と同様であるため、主に、静止物遮蔽判定処理部１１、移動物遮蔽判定処理部１２及び総合遮蔽判定処理部１３の処理内容を説明する。Next, the operation will be described.
Since it is the same as the first to fifth embodiments except that the stationary object shielding
静止物遮蔽判定処理部１１は、ＴＤＯＡ追尾処理部７が航跡予測値を算出すると、その航跡予測値が、目標と受信局＃ｉの間に所定の静止物が入り込む位置であるか否かを判定する。
ここで、図９は静止物遮蔽判定処理部１１による静止物遮蔽判定処理を示す説明図である。以下、図９を参照しながら、静止物遮蔽判定処理を具体的に説明する。When the TDOA
Here, FIG. 9 is an explanatory diagram showing a stationary object shielding determination process by the stationary object shielding
例えば、目標である飛行機が、図９に示すように、空港の滑走路などを走行する場合、航空機と受信局の間に、ビルなどの静止物が入り込むことがある。
このような場合、航空機に設置されているトランスポンダのアンテナから送信される信号が静止物に遮蔽されて、受信局が信号を受信することができなくなる。
しかし、受信機が設置されている位置や、静止物が設置されている位置は既知であるため、目標である航空機が、どの位置を走行しているかが分かれば、現在、航空機に設置されているトランスポンダのアンテナから送信される信号が静止物に遮蔽されているか否かを判定することができる。For example, when the target airplane travels on a runway of an airport as shown in FIG. 9, a stationary object such as a building may enter between the aircraft and the receiving station.
In such a case, the signal transmitted from the antenna of the transponder installed in the aircraft is shielded by the stationary object, and the receiving station cannot receive the signal.
However, the position where the receiver is installed and the position where the stationary object is installed are already known. It is possible to determine whether a signal transmitted from the antenna of the transponder is shielded by a stationary object.
そこで、静止物遮蔽判定処理部１１は、図９に示すように、事前に、既知の受信局の設置位置と、既知の静止物の設置位置から決まる静止物遮蔽範囲を特定し、ＴＤＯＡ追尾処理部７により算出された航跡予測値が、その静止物遮蔽範囲に入っているか否かを判定する。
なお、静止物遮蔽範囲の決め方としては、例えば、事前に、受信局が電波を受信することが不可能な範囲を調査し、その範囲を静止物遮蔽範囲としてもよいし、図９に示すように、静止物のサイズパラメータを特定し、そのサイズパラメータに基づいて静止物遮蔽範囲を決定するようにしてもよい。
静止物位置のサイズパラメータは、例えば、静止物が１以上の構造物からなる場合、縦、横及び高さからなる各構造物の空間形状を特定し、各構造物の空間形状を組み合わせて、総合的に決定すればよい。
図９では、空港内のビルなどを静止物としているが、地形や山などを静止物としてもよい。Therefore, as shown in FIG. 9, the stationary object shielding
As a method for determining the stationary object shielding range, for example, a range in which the receiving station cannot receive radio waves is investigated in advance, and the range may be set as the stationary object shielding range, as shown in FIG. Alternatively, the size parameter of the stationary object may be specified, and the stationary object shielding range may be determined based on the size parameter.
The size parameter of the stationary object position, for example, when the stationary object is composed of one or more structures, specifies the spatial shape of each structure consisting of length, width and height, and combines the spatial shape of each structure, It may be determined comprehensively.
In FIG. 9, buildings in airports are stationary objects, but terrain and mountains may be stationary objects.
移動物遮蔽判定処理部１２は、ＴＤＯＡ追尾処理部７が航跡予測値を算出すると、その航跡予測値が、目標と受信局＃ｉの間に所定の移動物が入り込む位置であるか否かを判定する。
ここで、図１０は移動物遮蔽判定処理部１２による移動物遮蔽判定処理を示す説明図である。以下、図１０を参照しながら、移動物遮蔽判定処理を具体的に説明する。When the TDOA
Here, FIG. 10 is an explanatory diagram showing the moving object shielding determination process by the moving object shielding
例えば、目標である飛行機が、図１０に示すように、空港の滑走路などを走行する場合、目標である航空機と受信局の間に、他の航空機などの移動物が入り込むことがある。
このような場合、目標である航空機に設置されているトランスポンダのアンテナから送信される信号が移動物に遮蔽されて、受信局が信号を受信することができなくなる。
しかし、受信機が設置されている位置は既知であるため、移動物の位置が分かり、かつ、目標である航空機が、どの位置を走行しているかが分かれば、現在、航空機に設置されているトランスポンダのアンテナから送信される信号が移動物に遮蔽されているか否かを判定することができる。For example, when the target airplane travels on a runway of an airport as shown in FIG. 10, moving objects such as other airplanes may enter between the target aircraft and the receiving station.
In such a case, the signal transmitted from the antenna of the transponder installed in the target aircraft is shielded by the moving object, and the receiving station cannot receive the signal.
However, since the position where the receiver is installed is known, if the position of the moving object is known and the position of the target aircraft is known, it is currently installed on the aircraft. It can be determined whether a signal transmitted from the antenna of the transponder is shielded by a moving object.
そこで、移動物遮蔽判定処理部１２は、移動物の位置を把握して（例えば、移動物に搭載されているＡＤＳ−ＢやＧＰＳセンサなどから信号を取得して、移動物の位置を把握する）、その移動物の位置と、既知の受信局の設置位置から決まる移動物遮蔽範囲を特定し、ＴＤＯＡ追尾処理部７により算出された航跡予測値が、その移動物遮蔽範囲に入っているか否かを判定する。
なお、移動物に搭載されているＡＤＳ−ＢやＧＰＳセンサなどの信号から移動物の位置を把握することができない場合には、当該目標と同様の追尾処理によって位置を把握してもよいし、レーダ等で移動物の位置を把握するようにしてもよい。
図１０では、空港内の他の航空機を移動物としているが、例えば、雲や、電波干渉すると想定される雨、霧などを移動物としてもよい。雲、雨や霧の位置は、雲、雨や霧の位置を観測する専用センサによって把握することが可能である。Therefore, the moving object shielding
In addition, when the position of a moving object cannot be grasped | ascertained from signals, such as ADS-B and a GPS sensor mounted in a moving object, a position may be grasped | ascertained by the tracking process similar to the said target, The position of the moving object may be grasped by a radar or the like.
In FIG. 10, other aircraft in the airport are used as moving objects. For example, clouds, rain, fog, etc. that are assumed to interfere with radio waves may be used as moving objects. The positions of clouds, rain and fog can be grasped by a dedicated sensor for observing the positions of clouds, rain and fog.
総合遮蔽判定処理部１３は、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定されている場合、静止物遮蔽判定処理部１１により航跡予測値が、静止物が入り込む位置であると判定されておらず、かつ、移動物遮蔽判定処理部１２により航跡予測値が、移動物が入り込む位置であると判定されていなければ、拡張カルマンフィルタによる航跡のリセットを指示するフィルタ制御信号をＴＤＯＡ追尾処理部７に出力する。
ここで、図１１は総合遮蔽判定処理部１３による総合遮蔽判定処理を示すフローチャートである。
また、図１２は実際の受信局のＴＯＡ探知と、静止物による遮蔽、移動物による遮蔽及び旋回による遮蔽との対応関係を示す説明図である。When it is determined that the signal shielding has occurred by the turning shielding
Here, FIG. 11 is a flowchart showing the comprehensive shielding determination process by the comprehensive shielding
FIG. 12 is an explanatory diagram showing a correspondence relationship between the actual TOA detection of the receiving station, shielding by a stationary object, shielding by a moving object, and shielding by turning.
以下、図１１及び図１２を参照しながら、総合遮蔽判定処理を具体的に説明する。
図１２では、ＴＯＡ探知ありの場合は○、ＴＯＡ探知なしの場合は×で示しており、静止物による遮蔽、移動物による遮蔽、旋回による遮蔽のいずれか１つでもあれば、ＴＯＡ探知はなしになり、いずれの遮蔽もない場合に限り、ＴＯＡ探知はありとなる。
旋回による遮蔽が発生しているとき、旋回前の過去の航跡を用いて、目標の追尾処理を実施すると、上述したように、航跡のオーバーシュートが発生するため、航跡の精度が劣化する。
しかし、静止物による遮蔽や、移動物による遮蔽が発生しているときは、目標が旋回しているものではないため、過去の航跡を用いて、目標の追尾処理を実施しても、航跡のオーバーシュートが発生する可能性は低いと考えられる。
そこで、この実施の形態６では、受信機が信号を受信できない理由が、旋回による遮蔽の場合に限り、過去の航跡をリセットし、受信機が信号を受信できない理由が、静止物による遮蔽や移動物による遮蔽の場合には、過去の航跡をリセットせずに、過去の航跡を用いて、目標の追尾処理を引き続き実施するようにする。Hereinafter, the comprehensive shielding determination process will be specifically described with reference to FIGS. 11 and 12.
In FIG. 12, when TOA detection is present, it is indicated by ○, and when TOA detection is not indicated by ×, if any one of shielding by a stationary object, shielding by a moving object, and shielding by turning, there is no TOA detection. Thus, only when there is no shielding, TOA detection is possible.
When the target tracking process is performed using the past wake before the turn when the shielding is caused by the turn, the wake overshoot occurs as described above, so the accuracy of the wake deteriorates.
However, when the shielding by a stationary object or the shielding by a moving object occurs, the target is not turning, so even if the target tracking process is performed using the past wake, The possibility of overshooting is considered low.
Therefore, in the sixth embodiment, the reason why the receiver cannot receive the signal is only when the turning is shielded, and the past wake is reset, and the reason why the receiver cannot receive the signal is the shielding or movement by the stationary object. In the case of blocking by an object, the target tracking process is continuously performed using the past wake without resetting the past wake.
即ち、総合遮蔽判定処理部１３は、静止物遮蔽判定処理部１１の判定結果が「静止物による遮蔽がある」旨を示していれば、過去の航跡をリセットせずに、航跡を継続する旨をＴＤＯＡ追尾処理部７に通知する（ステップＳＴ１，ＳＴ２）。
総合遮蔽判定処理部１３は、静止物遮蔽判定処理部１１の判定結果が「静止物による遮蔽がなし」である旨を示している場合、移動物遮蔽判定処理部１２の判定結果が「移動物による遮蔽がある」旨を示していれば、過去の航跡をリセットせずに、航跡を継続する旨をＴＤＯＡ追尾処理部７に通知する（ステップＳＴ３，ＳＴ４）。That is, if the determination result of the stationary object shielding
When the determination result of the stationary object shielding
総合遮蔽判定処理部１３は、移動物遮蔽判定処理部１２の判定結果が「移動物による遮蔽なし」である旨を示している場合、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽なし」である旨を示していれば、過去の航跡をリセットせずに、航跡を継続する旨をＴＤＯＡ追尾処理部７に通知する（ステップＳＴ５，ＳＴ６）。
一方、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽あり」との旨を示していれば、航跡のリセットを指示するフィルタ制御信号をＴＤＯＡ追尾処理部７に出力する。When the determination result of the moving object shielding
On the other hand, if the determination result of the turning shielding
以上で明らかなように、この実施の形態６によれば、ＴＤＯＡ追尾処理部７により算出された航跡予測値が、目標と受信局＃ｉの間に所定の静止物が入り込む位置であるか否かを判定する静止物遮蔽判定処理部１１と、ＴＤＯＡ追尾処理部７により算出された航跡予測値が、目標と受信局＃ｉの間に所定の移動物が入り込む位置であるか否かを判定する移動物遮蔽判定処理部１２とを設け、総合遮蔽判定処理部１３が、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定されている場合、静止物遮蔽判定処理部１１により航跡予測値が、静止物が入り込む位置であると判定されておらず、かつ、移動物遮蔽判定処理部１２により航跡予測値が、移動物が入り込む位置であると判定されていなければ、航跡のリセットを指示するフィルタ制御信号をＴＤＯＡ追尾処理部７に出力するように構成したので、過去の航跡を用いて、目標の追尾処理を実施しても、航跡のオーバーシュートが発生する可能性が低いと考えられる静止物による遮蔽や移動物による遮蔽の場合には、航跡をリセットせずに、目標の追尾処理を引き続き実施することができるようになり、目標の追尾精度を高めることができる効果を奏する。
As is apparent from the above, according to the sixth embodiment, whether or not the predicted wake calculated by the TDOA
実施の形態７．
図１３はこの発明の実施の形態７による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
運動モデル制御処理部１４は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、旋回遮蔽判定処理部５の判定結果に応じて、ＴＤＯＡ追尾処理部７における目標の追尾処理を制御する処理を実施する。
即ち、運動モデル制御処理部１４は旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、信号遮蔽が発生していないと判定された場合よりも、目標の航跡予測値を算出する際に用いる駆動雑音共分散行列を大きくする旨をＴＤＯＡ追尾処理部７に指示する処理を実施する。なお、運動モデル制御処理部１４は追尾処理制御手段を構成している。
FIG. 13 is a block diagram showing a positioning tracking apparatus according to
The motion model
In other words, the motion model
図１３の測位追尾装置は、運動モデル制御処理部１４を図３の測位追尾装置に適用している例を示しているが、運動モデル制御処理部１４を図１の測位追尾装置に適用してもよい。
図１３の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部５及び運動モデル制御処理部１４のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部５及び運動モデル制御処理部１４の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 13 shows an example in which the motion model
In the example of FIG. 13, the receiving
For example, when the portion excluding the receiving
次に動作について説明する。
フィルタリセット処理部６の代わりに、運動モデル制御処理部１４を設けている点以外は、上記実施の形態１〜６と同様であるため、主に運動モデル制御処理部１４の処理内容を説明する。Next, the operation will be described.
Since the movement model
まず、ＴＤＯＡ追尾処理部７が、目標の航跡予測値を算出する際に用いる誤差共分散行列と、駆動雑音共分散行列との関係式は、下記の式（１）の通りである。
運動モデル制御処理部１４は、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、信号遮蔽が発生していないと判定された場合よりも、駆動雑音共分散行列Ｑ(k-1)を大きくする旨をＴＤＯＡ追尾処理部７に指示する。
ＴＤＯＡ追尾処理部７は、運動モデル制御処理部１４から駆動雑音共分散行列Ｑ(k-1)を大きくする旨の指示を受けると、駆動雑音共分散行列Ｑ(k-1)を大きくして、目標の航跡予測値を算出するが、駆動雑音共分散行列Ｑ(k-1)を大きくすることで、目標の追尾処理における航跡の算出の元となる観測値と予測値のうち、観測値を重み付けして使用する比率のゲインが大きくなる。つまり、駆動雑音共分散行列Ｑ(k-1)を大きくすると、観測値の重みが大きくなる。
この結果、旋回前の過去の航跡を用いて、目標の追尾処理を実施しても、目標の旋回に伴う航跡のオーバーシュートが軽減される。The motion model
When receiving an instruction from the motion model
As a result, even if the target tracking process is performed using the past wake before the turn, the wake overshoot accompanying the turn of the target is reduced.
以上で明らかなように、この実施の形態７によれば、運動モデル制御処理部１４が、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、信号遮蔽が発生していないと判定された場合よりも、目標の航跡予測値を算出する際に用いる駆動雑音共分散行列Ｑ(k-1)を大きくする旨をＴＤＯＡ追尾処理部７に指示するように構成したので、目標の位置を測位することができない状況下になっても、その後、目標の位置を測位できる状況になれば、直ちに、目標の航跡を正確に算出することができる効果を奏する。
As apparent from the above, according to the seventh embodiment, when the motion model
実施の形態８．
図１４はこの発明の実施の形態８による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
運動モデル制御処理部１５は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、旋回遮蔽判定処理部５の判定結果に応じて、ＴＤＯＡ追尾処理部７における目標の追尾処理を制御する処理を実施する。
即ち、運動モデル制御処理部１５は旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、目標の加速度を考慮して、目標の航跡予測値を算出する旨をＴＤＯＡ追尾処理部７に指示する処理を実施する。なお、運動モデル制御処理部１５は追尾処理制御手段を構成している。
FIG. 14 is a block diagram showing a positioning tracking apparatus according to
The motion model
In other words, the motion model
図１４の測位追尾装置は、運動モデル制御処理部１５を図３の測位追尾装置に適用している例を示しているが、運動モデル制御処理部１５を図１の測位追尾装置に適用してもよい。
図１４の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部５及び運動モデル制御処理部１５のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ追尾処理部７、表示処理部４、旋回遮蔽判定処理部５及び運動モデル制御処理部１５の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 14 shows an example in which the motion model
In the example of FIG. 14, the receiving
For example, when the portion excluding the receiving
次に動作について説明する。
フィルタリセット処理部６の代わりに、運動モデル制御処理部１５を設けている点以外は、上記実施の形態１〜６と同様であるため、主に運動モデル制御処理部１５の処理内容を説明する。Next, the operation will be described.
Since the motion model
ＴＤＯＡ追尾処理部７は、下記の式（２）によって、目標の航跡予測値を算出する。
運動モデル制御処理部１５は、旋回遮蔽判定処理部５により信号遮蔽が発生していないと判定された場合、上記の式（２）によって、目標の航跡予測値を算出する旨をＴＤＯＡ追尾処理部７に指示するが、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、下記の式（３）によって、目標の航跡予測値を算出する旨をＴＤＯＡ追尾処理部７に指示する。
これにより、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、ＴＤＯＡ追尾処理部７が、目標の加速度を考慮して、目標の航跡予測値を算出することになるため、旋回目標への追従性を高めることが可能になる。
Thereby, when it is determined by the turn shielding
実施の形態９．
図１５はこの発明の実施の形態９による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
ＴＤＯＡ多重運動モデル追尾処理部１６は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ算出処理部１により算出されたＴＤＯＡ（ｉ）を、各種の運動モデル（例えば、等速直進モデル、旋回モデル）に関する拡張カルマンフィルタ（追尾処理用のフィルタ）を組み合わせて、目標の追尾処理（多重運動モデル追尾処理）を実施することで、目標の航跡予測値と航跡平滑値を算出する処理を実施する。なお、ＴＤＯＡ多重運動モデル追尾処理部１６は目標追尾手段を構成している。Embodiment 9 FIG.
15 is a block diagram showing a positioning tracking apparatus according to Embodiment 9 of the present invention. In the figure, the same reference numerals as those in FIG.
The TDOA multiple motion model
推移確率制御処理部１７は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、旋回遮蔽判定処理部５の判定結果に応じて、ＴＤＯＡ多重運動モデル追尾処理部１６における目標の追尾処理を制御する処理を実施する。
即ち、推移確率制御処理部１７は旋回遮蔽判定処理部５の判定結果に応じて、多重運動モデル追尾処理のモデル推移確率を設定する処理を実施する。なお、推移確率制御処理部１７は追尾処理制御手段を構成している。The transition probability
That is, the transition probability
図１５の測位追尾装置は、ＴＤＯＡ多重運動モデル追尾処理部１６及び推移確率制御処理部１７を図３の測位追尾装置に適用している例を示しているが、ＴＤＯＡ多重運動モデル追尾処理部１６及び推移確率制御処理部１７を図１の測位追尾装置に適用してもよい。
図１５の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル追尾処理部１６、表示処理部４、旋回遮蔽判定処理部５及び推移確率制御処理部１７のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル追尾処理部１６、表示処理部４、旋回遮蔽判定処理部５及び推移確率制御処理部１７の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 15 shows an example in which the TDOA multiple motion model
In the example of FIG. 15, receiving
For example, when the portion excluding the receiving
次に動作について説明する。
フィルタリセット処理部６及びＴＤＯＡ追尾処理部７の代わりに、ＴＤＯＡ多重運動モデル追尾処理部１６及び推移確率制御処理部１７を設けている点以外は、上記実施の形態１〜６と同様であるため、主にＴＤＯＡ多重運動モデル追尾処理部１６及び推移確率制御処理部１７の処理内容を説明する。Next, the operation will be described.
Since this embodiment is the same as
ＴＤＯＡ多重運動モデル追尾処理部１６における多重運動モデル追尾処理としては、例えば、等速直線運動モデル、等加速度運動モデル、等角速度運動モデル、蛇行運動モデル、外力（例えば、重力、コリオリ力、揚力、空気抵抗力など）が要因の運動モデルなどの各種の運動モデルを組み合わせることが可能であり、また、その組み合せにおける運動モデルの数を決めることができる。
以下の説明では、便宜上、等速直線運動モデルを「直進モデル」と称し、運動の曖昧さを表す駆動雑音が大きい等加速度運動モデル、等角速度運動モデルや蛇行運動モデルなどを「旋回モデル」と称する。As the multiple motion model tracking processing in the TDOA multiple motion model
In the following description, for the sake of convenience, the constant velocity linear motion model is referred to as a “straight-ahead model”, and the constant acceleration motion model, the constant angular velocity motion model, the meandering motion model, and the like that have a large driving noise representing the ambiguity of motion are referred to as the “swivel model”. Called.
推移確率制御処理部１７は、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、ＴＤＯＡ多重運動モデル追尾処理部１６に対して、等速直進モデルから旋回モデルへのモデル推移確率を大きくするように設定する。
The transition probability
以下、モデル信頼度計算に使用するモデル推移確率について説明する。
時刻ｋの運動モデルｂの事後信頼度をμk,b(+)と定義する。
時刻ｋの運動モデルｂの事後信頼度μk,b(+)は、下記の式（４）によって算出する。
また、Ｎは運動モデル数、ｂは等速直進モデル又は旋回モデルのいずれかの運動モデルを示す変数である。Hereinafter, the model transition probability used for the model reliability calculation will be described.
The posterior reliability of the motion model b at time k is defined as μ k, b (+) .
The posterior reliability μ k, b (+) of the motion model b at time k is calculated by the following equation (4).
ここでは説明の簡単化のため、運動モデルを等速直進モデルと旋回モデルの２つのモデルに絞っているが、加速度運動モデルや等加速度運動モデルなどを入れてもよい。運動モデルの組み合せや、運動モデルの数を１以上として、事前に決めることができる。 Here, for simplification of explanation, the motion model is narrowed down to two models, a constant velocity straight-ahead model and a turning model, but an acceleration motion model, a constant acceleration motion model, and the like may be included. Combinations of exercise models and the number of exercise models can be determined in advance as one or more.
次に、等速直進モデルの混合処理の説明を行う。
混合処理においては、以下のように、事前信頼度と事後信頼度が使用される。
In the mixing process, prior reliability and posterior reliability are used as follows.
ここで、運動モデルａから運動モデルｂへの逆推移確率μk,b|aは、下記の式（７）によって算出される。
ここで、時刻ｋ＋１の運動モデルｂの事前信頼度μk+1,a(-)は、下記の式（８）によって算出される。
等速直進モデルの混合では、上記の式（５）〜（８）によって、等速直進モデルに基づく混合平滑ベクトル、等速直進モデルに基づく混合平滑誤差共分散行列、等速直進モデルの平滑ベクトル、等速直進モデルの平滑誤差共分散行列、等速直進モデルから旋回モデルへの逆推移確率、等速直進モデルの事前信頼度が算出される。
旋回モデルの混合では、上記の等速直進モデルを旋回モデルに読み替え、上記の旋回モデルを等速直進運動モデルに読み替えることで、上記の式（５）〜（８）によって、同様の処理が行われる。In the mixing of the constant-velocity linear model, the mixed smooth vector based on the constant-velocity linear model, the mixed smoothing error covariance matrix based on the constant-velocity linear model, and the smooth vector of the constant-velocity linear model according to the above equations (5) to (8) Then, the smoothing error covariance matrix of the constant-velocity linear model, the inverse transition probability from the constant-velocity linear model to the turning model, and the prior reliability of the constant-velocity linear model are calculated.
In the mixing of the turning models, the same processing is performed by the above formulas (5) to (8) by replacing the above-mentioned constant-velocity linear model with the turning model and the above-mentioned turning model with the constant-velocity linear motion model. Is called.
ここで、複数のモデルの事前信頼度をベクトル形式にしたものを「事前信頼度ベクトル」と称し、モデル遷移の全ての可能性を考えて推移確率を行列形式にしたものを「モデル推移確率行列」と称する。
モデル数が２（等速直進モデル、旋回モデル）の場合の事前信頼度ベクトルμk,a(-)は下記の式（９）となり、モデル推移確率行列Ｐbaは下記の式（１０）となる。モデル推移確率行列Ｐbaの各行の要素の総和は１である。
The prior reliability vector μ k, a (-) when the number of models is 2 (constant speed straight model, turning model) is given by the following formula (9), and the model transition probability matrix P ba is given by the following formula (10). Become. The sum of the elements in each row of the model transition probability matrix P ba is 1.
図１６は等速直進モデルの事前信頼度の求め方を示す説明図である。
図１６に示すように，等速直進モデルの時刻ｋにおける事前信頼度は、時刻ｋ−１における事後信頼度に推移確率π11を乗算するとともに、旋回モデルの事後信頼度に推移確率π21を乗算し、これらの乗算結果の総和を求めることで得られる。モデル数が３以上の場合も同じ考え方である。
なお、図１７は各モデルの信頼度計算を含んでいる多重運動モデル追尾処理を示すフローチャートである。FIG. 16 is an explanatory diagram showing how to obtain the prior reliability of the constant-velocity linear model.
As shown in FIG. 16, the prior reliability at the time k of the constant velocity straight model is obtained by multiplying the posterior reliability at the time k−1 by the transition probability π 11 and the transition probability π 21 in the posterior reliability of the turning model. Multiplication is performed and the sum of these multiplication results is obtained. The same idea applies when the number of models is 3 or more.
FIG. 17 is a flowchart showing the multiple motion model tracking process including the reliability calculation of each model.
以上のように、この実施の形態９によれば、旋回遮蔽判定処理部５により信号遮蔽が発生していると判定された場合、ＴＤＯＡ多重運動モデル追尾処理部１６に対して、等速直進モデルから旋回モデルへのモデル推移確率を大きくするように設定する構成にしたので、旋回目標への追従性を高めることが可能になる。
As described above, according to the ninth embodiment, when it is determined that the signal shielding has occurred by the turning shielding
実施の形態１０．
図１８はこの発明の実施の形態１０による測位追尾装置を示す構成図であり、図において、図１５と同一符号は同一または相当部分を示すので説明を省略する。
推移確率制御処理部１８は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、図１５の推移確率制御処理部１７と同様に、旋回遮蔽判定処理部５の判定結果に応じて、多重運動モデル追尾処理のモデル推移確率を設定する処理を実施するが、多重運動モデル追尾処理のモデル推移確率を変更する際、複数のサンプリングをかけてモデル推移確率の変更を段階的に行うようにする。なお、推移確率制御処理部１８は追尾処理制御手段を構成している。
18 is a block diagram showing a positioning tracking apparatus according to
The transition probability
図１８の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル追尾処理部１６、表示処理部４、旋回遮蔽判定処理部５及び推移確率制御処理部１８のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル追尾処理部１６、表示処理部４、旋回遮蔽判定処理部５及び推移確率制御処理部１８の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。In the example of FIG. 18, receiving
For example, when the portion excluding the receiving
上記実施の形態９では、推移確率制御処理部１７が、旋回遮蔽判定処理部５の判定結果に応じて、多重運動モデル追尾処理のモデル推移確率を設定するものを示したが、推移確率制御処理部１８が、事前に決めた増加方法によって、多重運動モデル追尾処理のモデル推移確率を複数サンプリングで徐々に大きくするようにしてもよい。
In the ninth embodiment, the transition probability
図１９は推移確率制御処理部１８によるモデル推移確率の設定処理を示す説明図である。
推移確率制御処理部１８は、例えば、等速直進モデルから旋回モデルへのモデル推移確率を１サンプリングで変えるのではなく、図１９に示すように、複数のサンプリングをかけてモデル推移確率の変更を段階的に行うようにする。
モデル推移確率の変化のさせ方は、直線的でもよいし、曲線的でもよい。FIG. 19 is an explanatory diagram showing a model transition probability setting process performed by the transition probability
For example, the transition probability
The method of changing the model transition probability may be linear or curvilinear.
以上で明らかなように、この実施の形態１０によれば、多重運動モデル追尾処理のモデル推移確率を変更する際、複数のサンプリングをかけてモデル推移確率の変更を段階的に行うように構成したので、直進から旋回への追従性がスムーズになる効果がある。 As is apparent from the above, according to the tenth embodiment, when changing the model transition probability of the multiple motion model tracking process, the model transition probability is changed stepwise by applying a plurality of samplings. Therefore, there is an effect that the followability from straight to turning is smooth.
実施の形態１１．
図２０はこの発明の実施の形態１１による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
ＴＤＯＡ運動モデル統合追尾処理部１９は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ算出処理部１により算出されたＴＤＯＡ（ｉ）を拡張カルマンフィルタに代入して、目標の追尾処理を実施することで、目標の航跡予測値と航跡平滑値を算出するものであるが、その際、拡張カルマンフィルタにおける直進モデルの追尾フィルタから得られる処理結果と、拡張カルマンフィルタにおける旋回モデルの追尾フィルタから得られる処理結果とを統合する運動モデル統合追尾処理を実施する。なお、ＴＤＯＡ運動モデル統合追尾処理部１９は目標追尾手段を構成している。
20 is a block diagram showing a positioning tracking apparatus according to
The TDOA motion model integrated
統合重み付け制御処理部２０は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、旋回遮蔽判定処理部５の判定結果に応じて、ＴＤＯＡ運動モデル統合追尾処理部１９における目標の追尾処理を制御する処理を実施する。
即ち、統合重み付け制御処理部２０は旋回遮蔽判定処理部５の判定結果に応じて、直進モデルの追尾フィルタから得られる処理結果と、旋回モデルの追尾フィルタから得られる処理結果とを統合する際の重み付けを設定する処理を実施する。なお、統合重み付け制御処理部２０は追尾処理制御手段を構成している。The integrated weighting
That is, the integrated weighting
図２０の測位追尾装置は、ＴＤＯＡ運動モデル統合追尾処理部１９及び統合重み付け制御処理部２０を図３の測位追尾装置に適用している例を示しているが、ＴＤＯＡ運動モデル統合追尾処理部１９及び統合重み付け制御処理部２０を図１の測位追尾装置に適用してもよい。
図２０の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ運動モデル統合追尾処理部１９、表示処理部４、旋回遮蔽判定処理部５及び統合重み付け制御処理部２０のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ運動モデル統合追尾処理部１９、表示処理部４、旋回遮蔽判定処理部５及び統合重み付け制御処理部２０の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。
図２１はＴＤＯＡ運動モデル統合追尾処理を示す説明図である。The positioning tracking device of FIG. 20 shows an example in which the TDOA motion model integrated
In the example of FIG. 20, receiving
For example, when the portions other than the receiving
FIG. 21 is an explanatory diagram showing the TDOA motion model integrated tracking process.
次に動作について説明する。
フィルタリセット処理部６及びＴＤＯＡ追尾処理部７の代わりに、ＴＤＯＡ運動モデル統合追尾処理部１９及び統合重み付け制御処理部２０を設けている点以外は、上記実施の形態１〜６と同様であるため、主にＴＤＯＡ運動モデル統合追尾処理部１９及び統合重み付け制御処理部２０の処理内容を説明する。Next, the operation will be described.
Since it is the same as that of the said Embodiments 1-6 except the point which has provided the TDOA motion model integrated
ＴＤＯＡ運動モデル統合追尾処理部１９は、ＴＤＯＡ算出処理部１がＴＤＯＡ（ｉ）を算出すると、そのＴＤＯＡ（ｉ）を用いて、等速直進モデルに基づく追尾処理を実施して、等速直進モデルの平滑値の状態ベクトルｘ 1（ｋ｜ｋ）等を算出する。
また、ＴＤＯＡ運動モデル統合追尾処理部１９は、そのＴＤＯＡ（ｉ）を用いて、旋回モデルに基づく追尾処理を実施して、旋回モデルの平滑値の状態ベクトルｘ 2（ｋ｜ｋ）等を算出する。When the TDOA
Further, the TDOA motion model integrated
ＴＤＯＡ運動モデル統合追尾処理部１９は、等速直進モデルの平滑値の状態ベクトルｘ 1（ｋ｜ｋ）及び旋回モデルの平滑値の状態ベクトルｘ 2（ｋ｜ｋ）を算出すると、等速直進モデルの重みβ1と、旋回モデルの重みβ2とを用いて、下記の式（１１）に示すように、等速直進モデルの平滑値の状態ベクトルｘ 1（ｋ｜ｋ）と旋回モデルの平滑値の状態ベクトルｘ 2（ｋ｜ｋ）とを重み付け加算して、統合平滑値の状態ベクトルｘ gt（ｋ｜ｋ）を算出する。
統合重み付け制御処理部２０は、旋回遮蔽判定処理部５の判定結果に応じて、直進モデルの重みβ1と旋回モデルの重みβ2を設定する。
即ち、統合重み付け制御処理部２０は、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽がなし」である旨を示していれば、直進モデルの重みβ1を旋回モデルの重みβ2より大きくする旨をＴＤＯＡ運動モデル統合追尾処理部１９に指示するが、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽がある」旨を示していれば、直進モデルの重みβ1より旋回モデルの重みβ2を大きくする旨をＴＤＯＡ運動モデル統合追尾処理部１９に指示する。
これにより、旋回による遮蔽がある場合、直進モデルの重みβ1より旋回モデルの重みβ2を大きくして、統合平滑値の状態ベクトルｘ gt（ｋ｜ｋ）が算出される。
このように、旋回遮蔽の判定結果に応じて、ＴＤＯＡ運動モデル統合追尾処理の重み付けを変えることで、目標への追従性が高くなる効果が得られる。The integrated weighting
That is, if the determination result of the turning shielding
Thus, when there is shielding due to turning, the weight β 2 of the turning model is made larger than the weight β 1 of the straight-ahead model, and the integrated smooth value state vector x gt (k | k) is calculated.
In this way, by changing the weighting of the TDOA motion model integrated tracking process according to the result of turning shielding determination, an effect of improving the followability to the target can be obtained.
実施の形態１２．
図２２はこの発明の実施の形態１２による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、ＴＤＯＡ算出処理部１により算出されたＴＤＯＡ（ｉ）を拡張カルマンフィルタに代入して、目標の追尾処理を実施することで、目標の航跡予測値と航跡平滑値を算出するものであるが、その際、水平方向の複数の運動モデルを組み合わせて目標を追尾する水平方向の多重運動モデル追尾処理と、垂直方向の複数の運動モデルを組み合わせて目標を追尾する垂直方向の多重運動モデル追尾処理とを実施して、水平方向の多重運動モデル追尾処理の処理結果と垂直方向の多重運動モデル追尾処理の処理結果とを統合するものである。なお、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１は目標追尾手段を構成している。
22 is a block diagram showing a positioning tracking apparatus according to
The TDOA multiple motion model horizontal / vertical
モデル制御処理部２２は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、旋回遮蔽判定処理部５の判定結果に応じて、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１における目標の追尾処理を制御する処理を実施する。
即ち、モデル制御処理部２２は旋回遮蔽判定処理部５の判定結果と地形を考慮して、水平方向の多重運動モデル追尾処理のモデル推移確率及び垂直方向の多重運動モデル追尾処理のモデル推移確率を設定する処理を実施する。なお、モデル制御処理部２２は追尾処理制御手段を構成している。The model
That is, the model
図２２の測位追尾装置は、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１及びモデル制御処理部２２を図３の測位追尾装置に適用している例を示しているが、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１及びモデル制御処理部２２を図１の測位追尾装置に適用してもよい。
図２２の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１、表示処理部４、旋回遮蔽判定処理部５及びモデル制御処理部２２のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１、表示処理部４、旋回遮蔽判定処理部５及びモデル制御処理部２２の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 22 shows an example in which the TDOA multi-motion model horizontal / vertical
In the example of FIG. 22, the receiving
For example, when the portion excluding the receiving
次に動作について説明する。
フィルタリセット処理部６及びＴＤＯＡ追尾処理部７の代わりに、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１及びモデル制御処理部２２を設けている点以外は、上記実施の形態１〜６と同様であるため、主にＴＤＯＡ多重運動モデル水平垂直追尾処理部２１及びモデル制御処理部２２の処理内容を説明する。Next, the operation will be described.
The present embodiment is the same as
ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１における多重運動モデル追尾処理の方法は、図１８のＴＤＯＡ多重運動モデル追尾処理部１６における多重運動モデル追尾処理の方法と同様であるが、水平方向の多重運動モデル追尾処理と、垂直方向の多重運動モデル追尾処理とを独立に実施する。
ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１は、水平方向の多重運動モデル追尾処理と、垂直方向の多重運動モデル追尾処理とを独立に実施すると、水平方向の多重運動モデル追尾処理を実施すること得られた航跡予測値と、垂直方向の多重運動モデル追尾処理を実施すること得られた航跡予測値とを合わせて、表示処理部４に出力する。
また、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１は、水平方向の多重運動モデル追尾処理を実施すること得られた航跡平滑値と、垂直方向の多重運動モデル追尾処理を実施すること得られた航跡平滑値とを合わせて、表示処理部４に出力する。The method of multi-motion model tracking processing in the TDOA multi-motion model horizontal / vertical
When the TDOA multi-motion model horizontal / vertical
The TDOA multi-motion model horizontal / vertical
モデル制御処理部２２は、旋回遮蔽判定処理部５の判定結果と地形を考慮して、水平方向の多重運動モデル追尾処理のモデル推移確率及び垂直方向の多重運動モデル追尾処理のモデル推移確率を設定する。
即ち、モデル制御処理部２２は、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽がある」旨を示していれば、航跡平滑値から計算される平滑高度と組み合わせて、水平方向の多重運動モデル追尾処理における等速直進モデルから旋回モデルへの推移確率を高めるか、垂直方向の多重運動モデル追尾処理における等速直進モデルから旋回モデルへの推移確率を高めるか、水平方向の多重運動モデル追尾処理における等速直進モデルから旋回モデルへの推移確率と垂直方向の多重運動モデル追尾処理における等速直進モデルから旋回モデルへの推移確率の両方を高めるかを決定する。The model
In other words, if the determination result of the turning shielding
例えば、目標高度によって、事前に高度方向の旋回が少ないことが分かっている場合は、平滑高度が高度しきい値（高度方向の旋回が少ない場合のしきい値）未満であり、かつ、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽がある」旨を示していれば、等速直進モデルから旋回モデルへの推移確率を高める処置を、水平方向の多重運動モデル追尾処理だけに実施する。
つまり、地形位置（空港、山、ビル等の位置）と航跡平滑値（平滑位置、平滑高度等）の関係から、事前に目標が高度方向に旋回するのか、水平方向に旋回するのかをある程度推測することができるため、地形位置と、水平方向の多重運動モデル追尾処理の推移確率と、垂直方向の多重運動モデル追尾処理の推移確率との対応関係を示すテーブルを事前に作成しておき、そのテーブルから地形位置に対応する水平方向の多重運動モデル追尾処理の推移確率と、垂直方向の多重運動モデル追尾処理の推移確率とを取得する。
そして、水平方向の多重運動モデル追尾処理の推移確率と、垂直方向の多重運動モデル追尾処理の推移確率とを設定する制御信号をＴＤＯＡ多重運動モデル水平垂直追尾処理部２１に出力する。For example, when it is known in advance that the turning in the altitude direction is small according to the target altitude, the smooth altitude is less than the altitude threshold (threshold when the altitude direction is low) and the turning shielding is performed. If the determination result of the
In other words, based on the relationship between the terrain position (positions of airports, mountains, buildings, etc.) and wake smoothness values (smooth position, smooth altitude, etc.), it is estimated to some extent whether the target turns in the altitude direction or in the horizontal direction in advance. Therefore, a table showing the correspondence relationship between the topographic position, the transition probability of the multi-motion model tracking process in the horizontal direction, and the transition probability of the multi-motion model tracking process in the vertical direction is created in advance. The transition probability of the horizontal multi-motion model tracking process corresponding to the terrain position and the transition probability of the vertical multi-motion model tracking process corresponding to the terrain position are acquired from the table.
Then, the control signal for setting the transition probability of the horizontal multi-motion model tracking process and the transition probability of the multi-motion model tracking process in the vertical direction is output to the TDOA multi-motion model horizontal / vertical
これにより、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１は、モデル制御処理部２２から出力された制御信号にしたがって、水平方向の多重運動モデル追尾処理の推移確率と、垂直方向の多重運動モデル追尾処理の推移確率とを設定して、水平方向の多重運動モデル追尾処理と垂直方向の多重運動モデル追尾処理を独立に実施する。
このように、旋回遮蔽判定処理部５の判定結果と地形を考慮して、水平方向の多重運動モデル追尾処理のモデル推移確率及び垂直方向の多重運動モデル追尾処理のモデル推移確率を設定することで、目標への追従性を高めることができる。As a result, the TDOA multi-motion model horizontal / vertical
In this way, the model transition probability of the horizontal multi-motion model tracking process and the model transition probability of the multi-motion model tracking process in the vertical direction are set in consideration of the determination result of the turning shielding
実施の形態１３．
図２３はこの発明の実施の形態１３による測位追尾装置を示す構成図であり、図において、図３と同一符号は同一または相当部分を示すので説明を省略する。
ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、図２２のＴＤＯＡ多重運動モデル水平垂直追尾処理部２１と同様に、水平方向の多重運動モデル追尾処理と、垂直方向の多重運動モデル追尾処理とを独立に実施して、水平方向の多重運動モデル追尾処理の処理結果と垂直方向の多重運動モデル追尾処理の処理結果とを統合するものであるが、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３の場合、水平方向の多重運動モデル追尾処理の運動モデルが直進モデルと旋回モデルであって、垂直方向の多重運動モデル追尾処理の運動モデルが高度一定の複数の直進モデルである。なお、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３は目標追尾手段を構成している。
FIG. 23 is a block diagram showing a positioning tracking apparatus according to
The TDOA multiple motion model horizontal / vertical
モデル制御処理部２４は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、図２２のモデル制御処理部２２と同様に、水平方向の多重運動モデル追尾処理のモデル推移確率及び垂直方向の多重運動モデル追尾処理のモデル推移確率を設定するものであるが、モデル制御処理部２４の場合、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽がある」旨を示していれば、水平方向の多重運動モデル追尾処理における直進モデルから旋回モデルへのモデル推移確率が大きくなるように設定して、垂直方向の多重運動モデル追尾処理のモデル推移確率を維持するようにする。なお、モデル制御処理部２４は追尾処理制御手段を構成している。
The model
図２３の測位追尾装置は、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３及びモデル制御処理部２４を図３の測位追尾装置に適用している例を示しているが、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３及びモデル制御処理部２４を図１の測位追尾装置に適用してもよい。
図２３の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３、表示処理部４、旋回遮蔽判定処理部５及びモデル制御処理部２４のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３、表示処理部４、旋回遮蔽判定処理部５及びモデル制御処理部２４の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。The positioning tracking device of FIG. 23 shows an example in which the TDOA multiple motion model horizontal / vertical
In the example of FIG. 23, receiving
For example, when the portion excluding the receiving
この実施の形態１３では、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３が、水平方向の多重運動モデル追尾処理の運動モデルについては、直進モデルと旋回モデルを扱うものであって、垂直方向の多重運動モデル追尾処理の運動モデルについては、高度一定の複数の直進モデルを扱うものであることを想定する。
In the thirteenth embodiment, the TDOA multi-motion model horizontal / vertical
モデル制御処理部２４は、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽がある」旨を示していれば、水平方向の多重運動モデル追尾処理における直進モデルから旋回モデルへのモデル推移確率が大きくなるように設定して、垂直方向の多重運動モデル追尾処理のモデル推移確率を維持するようにする。
これにより、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２３では、旋回遮蔽判定処理部５の判定結果が「旋回による遮蔽がある」旨を示していれば、水平方向の多重運動モデル追尾処理については、直進モデルから旋回モデルへのモデル推移確率が大きくなる多重運動モデルで、目標の追尾が行われる。
この結果、目標への追従性を確保することができる。また、高度一定の直進モデルを複数使用する垂直方向の多重運動モデルを使用することで、マルチパス等により高度誤差が大きい状況でも、目標への高度追尾精度が向上する。If the determination result of the turning shielding
Thereby, in the TDOA multiple motion model horizontal / vertical
As a result, the ability to follow the target can be ensured. In addition, by using a vertical multiple motion model that uses a plurality of straight-ahead models having a constant altitude, the altitude tracking accuracy to the target is improved even in a situation where the altitude error is large due to multipath or the like.
実施の形態１４．
図２４はこの発明の実施の形態１４による測位追尾装置を示す構成図であり、図において、図２２と同一符号は同一または相当部分を示すので説明を省略する。
モデル制御処理部２５は例えばＣＰＵを実装している半導体集積回路、あるいは、ワンチップマイコンなどから構成されており、図２２のモデル制御処理部２２と同様に、水平方向の多重運動モデル追尾処理のモデル推移確率及び垂直方向の多重運動モデル追尾処理のモデル推移確率を設定するものであるが、モデル制御処理部２５の場合、垂直方向の多重運動モデル追尾処理の運動モデルが、上昇旋回モデル及び下降旋回モデルを備えていれば、目標の高度に応じて、上昇旋回モデル及び下降旋回モデルを使用するか否かを決定する。なお、モデル制御処理部２５は追尾処理制御手段を構成している。
24 is a block diagram showing a positioning tracking apparatus according to
The model
図２４の測位追尾装置は、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１及びモデル制御処理部２５を図３の測位追尾装置に適用している例を示しているが、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１及びモデル制御処理部２５を図１の測位追尾装置に適用してもよい。
図２３の例では、測位追尾装置の構成要素である受信局＃０〜＃Ｎ、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１、表示処理部４、旋回遮蔽判定処理部５及びモデル制御処理部２５のそれぞれが専用のハードウェアで構成されているものを想定しているが、測位追尾装置の全部または一部がコンピュータで構成されていてもよい。
例えば、受信局＃０〜＃Ｎを除く部分がコンピュータで構成されている場合、ＴＤＯＡ算出処理部１、測位位置算出処理部２、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１、表示処理部４、旋回遮蔽判定処理部５及びモデル制御処理部２５の処理内容を記述しているプログラムをコンピュータのメモリに格納し、当該コンピュータのＣＰＵが当該メモリに格納されているプログラムを実行するようにすればよい。24 shows an example in which the TDOA multi-motion model horizontal / vertical
In the example of FIG. 23, receiving
For example, when the portion excluding the receiving
次に動作について説明する。
モデル制御処理部２２の代わりに、モデル制御処理部２５を設けている点以外は、上記実施の形態１２と同様であるため、主にモデル制御処理部２５の処理内容を説明する。
この実施の形態１４では、ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１が、垂直方向の多重運動モデル追尾処理の運動モデルとして、上昇旋回モデル及び下降旋回モデルを備えている場合を想定する。Next, the operation will be described.
Except for the point that the model
In the fourteenth embodiment, it is assumed that the TDOA multi-motion model horizontal / vertical
ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１が、上昇旋回モデル、下降旋回モデル及び直進モデルを使用する場合、例えば、航跡平滑値から得られる平滑高度が、ある一定高度以上では、下降旋回モデルを使用するなど、平滑高度と上昇旋回モデル及び下降旋回モデルの使用の有無との対応関係を示すテーブルを事前に作成しておくものとする。
モデル制御処理部２５は、例えば、航跡平滑値から平滑高度を得ると、事前に作成されているテーブルを参照して、その平滑高度で使用する運動モデルが、上昇旋回モデルであるのか、下降旋回モデルであるのかを確認し、使用する運動モデルを示す制御信号をＴＤＯＡ多重運動モデル水平垂直追尾処理部２１に出力する。When the TDOA multi-motion model horizontal / vertical
For example, when the model
ＴＤＯＡ多重運動モデル水平垂直追尾処理部２１は、モデル制御処理部２５から出力された制御信号が上昇旋回モデルを使用する旨を示してれば、垂直方向の多重運動モデル追尾処理の運動モデルとして、上昇旋回モデルを使用する。
また、モデル制御処理部２５から出力された制御信号が下降旋回モデルを使用する旨を示してれば、垂直方向の多重運動モデル追尾処理の運動モデルとして、下降旋回モデルを使用する。
このように、目標の高度に応じて、垂直方向の多重運動モデル追尾処理の運動モデルとして、上昇旋回モデル及び下降旋回モデルを使用するか否かを決めることで、例えば、目標高度によっては、あり得ない上昇旋回や下降旋回の動作を除外することができる。If the control signal output from the model
If the control signal output from the model
Thus, depending on the target altitude, for example, depending on the target altitude, it is possible to determine whether to use the ascending and descending swivel models as the motion model for the vertical multi-motion model tracking process. It is possible to exclude operations of ascending and descending turns that cannot be obtained.
なお、本願発明はその発明の範囲内において、各実施の形態の自由な組み合わせ、あるいは各実施の形態の任意の構成要素の変形、もしくは各実施の形態において任意の構成要素の省略が可能である。 In the present invention, within the scope of the invention, any combination of the embodiments, or any modification of any component in each embodiment, or omission of any component in each embodiment is possible. .
この発明に係る測位追尾装置は、目標と複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段と、信号遮蔽判定手段により信号遮蔽が発生していると判定された場合、追尾処理用のフィルタによる航跡をリセットするフィルタリセット手段とを備え、目標の位置を測位することができない状況下になっても、その後、目標の位置を測位できる状況になれば、直ちに、目標の航跡を正確に算出することができるので、航空機の位置の測位や航空機の航跡を予測する測位追尾装置として用いるのに適している。 In the positioning tracking device according to the present invention, it is determined that the signal shielding is generated by the signal shielding determination means for determining whether the signal shielding is occurring between the target and the plurality of receiving stations, and the signal shielding determination means. Filter reset means for resetting the wake of the tracking processing filter, even if the target position cannot be determined, the target position can be determined immediately. Since the target track can be accurately calculated, it is suitable for use as a positioning tracking device for positioning the position of the aircraft and predicting the track of the aircraft.
＃０〜＃Ｎ 受信局、１ ＴＤＯＡ算出処理部（到来時刻差算出手段）、２ 測位位置算出処理部（位置測位手段）、３ 測位位置追尾処理部（目標追尾手段）、４ 表示処理部（表示手段）、５ 旋回遮蔽判定処理部（信号遮蔽判定手段）、６ フィルタリセット処理部（フィルタリセット手段）、７ ＴＤＯＡ追尾処理部（目標追尾手段）、８，９，１０ 旋回遮蔽判定処理部（信号遮蔽判定手段）、１１ 静止物遮蔽判定処理部（位置判定手段）、１２ 移動物遮蔽判定処理部（位置判定手段）、１３ 総合遮蔽判定処理部（フィルタリセット手段）、１４，１５ 運動モデル制御処理部（追尾処理制御手段）、１６ ＴＤＯＡ多重運動モデル追尾処理部（目標追尾手段）、１７，１８ 推移確率制御処理部（追尾処理制御手段）、１９ ＴＤＯＡ運動モデル統合追尾処理部（目標追尾手段）、２０ 統合重み付け制御処理部（追尾処理制御手段）、２１，２３ ＴＤＯＡ多重運動モデル水平垂直追尾処理部（目標追尾手段）、２２，２４，２５ モデル制御処理部（追尾処理制御手段）、１０１ ＴＤＯＡ算出処理部、１０２ 測位位置算出処理部、１０３ 測位位置追尾処理部、１０４ 表示処理部。 # 0 to #N Receiving station, 1 TDOA calculation processing section (arrival time difference calculation means), 2 positioning position calculation processing section (position positioning means), 3 positioning position tracking processing section (target tracking means), 4 display processing section ( Display means), 5 turning shielding judgment processing section (signal shielding judgment means), 6 filter reset processing section (filter reset means), 7 TDOA tracking processing section (target tracking means), 8, 9, 10 turning shielding judgment processing section ( Signal shielding determination means), 11 stationary object shielding determination processing section (position determination means), 12 moving object shielding determination processing section (position determination means), 13 comprehensive shielding determination processing section (filter reset means), 14, 15 motion model control Processing unit (tracking processing control means), 16 TDOA multiple motion model tracking processing unit (target tracking means), 17, 18 Transition probability control processing unit (tracking processing control means), 19 TDO Motion model integrated tracking processing unit (target tracking means), 20 Integrated weight control processing unit (tracking processing control means), 21, 23 TDOA multiple motion model horizontal / vertical tracking processing unit (target tracking means), 22, 24, 25 Model control Processing unit (tracking processing control means), 101 TDOA calculation processing unit, 102 positioning position calculation processing unit, 103 positioning position tracking processing unit, 104 display processing unit.
Claims (15)
上記複数の受信局から出力された到来時刻の時刻差である到来時刻差を算出する到来時刻差算出手段と、
上記到来時刻差算出手段により算出された到来時刻差から上記目標の位置を測位する位置測位手段と、
上記位置測位手段により測位された目標の位置又は上記到来時刻差算出手段により算出された到来時刻差を追尾処理用のフィルタに代入して、上記目標の追尾処理を実施することで、上記目標の航跡予測値と航跡平滑値を算出する目標追尾手段と、
上記目標追尾手段により算出された目標の航跡予測値と航跡平滑値を表示する表示手段と、
上記目標と上記複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段と、
上記信号遮蔽判定手段により信号遮蔽が発生していると判定された場合、上記追尾処理用のフィルタによる航跡をリセットするフィルタリセット手段と
を備えた測位追尾装置。 A plurality of receiving stations that receive signals transmitted from the target and output the arrival times of the signals;
An arrival time difference calculating means for calculating an arrival time difference which is a time difference between arrival times output from the plurality of receiving stations;
Position positioning means for positioning the target position from the arrival time difference calculated by the arrival time difference calculation means;
By substituting the target position measured by the position positioning means or the arrival time difference calculated by the arrival time difference calculating means into a filter for tracking processing, and performing the target tracking processing, A target tracking means for calculating a wake prediction value and a wake smooth value;
Display means for displaying the target track prediction value and the track smooth value calculated by the target tracking means;
Signal shielding determination means for determining whether signal shielding occurs between the target and the plurality of receiving stations;
A positioning tracking device comprising: a filter resetting unit that resets a track by the tracking processing filter when it is determined by the signal blocking determination unit that signal blocking has occurred.
上記フィルタリセット手段は、上記信号遮蔽判定手段により信号遮蔽が発生していると判定され、かつ、上記位置判定手段により航跡予測値が静止物又は移動物が入り込む位置であると判定されていなければ、追尾処理用のフィルタによる航跡をリセットする
ことを特徴とする請求項１記載の測位追尾装置。 A position determination means for determining whether or not the track prediction value calculated by the target tracking means is a position where a predetermined stationary object or moving object enters between the target and the receiving station;
The filter reset means, a signal is determined shield is generated by the signal blocking determining means, and, unless it is determined that the track prediction value is the position of the stationary or moving object enters by the position determining means The positioning tracking device according to claim 1, wherein the track by the tracking processing filter is reset.
上記複数の受信局から出力された到来時刻の時刻差である到来時刻差を算出する到来時刻差算出手段と、
上記到来時刻差算出手段により算出された到来時刻差から上記目標の位置を測位する位置測位手段と、
上記位置測位手段により測位された目標の位置又は上記到来時刻差算出手段により算出された到来時刻差を追尾処理用のフィルタに代入して、上記目標の追尾処理を実施することで、上記目標の航跡予測値と航跡平滑値を算出する目標追尾手段と、
上記目標追尾手段により算出された目標の航跡予測値と航跡平滑値を表示する表示手段と、
上記目標と上記複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段と、
上記信号遮蔽判定手段の判定結果に応じて、上記目標追尾手段における上記追尾処理用のフィルタのゲインを大きくして目標の追尾処理を制御する追尾処理制御手段と
を備えた測位追尾装置。 A plurality of receiving stations that receive signals transmitted from the target and output the arrival times of the signals;
An arrival time difference calculating means for calculating an arrival time difference which is a time difference between arrival times output from the plurality of receiving stations;
Position positioning means for positioning the target position from the arrival time difference calculated by the arrival time difference calculation means;
By substituting the target position measured by the position positioning means or the arrival time difference calculated by the arrival time difference calculating means into a filter for tracking processing, and performing the target tracking processing, A target tracking means for calculating a wake prediction value and a wake smooth value;
Display means for displaying the target track prediction value and the track smooth value calculated by the target tracking means;
Signal shielding determination means for determining whether signal shielding occurs between the target and the plurality of receiving stations;
A positioning tracking device comprising tracking processing control means for controlling the target tracking processing by increasing the gain of the tracking processing filter in the target tracking means in accordance with the determination result of the signal shielding determination means.
上記複数の受信局から出力された到来時刻の時刻差である到来時刻差を算出する到来時刻差算出手段と、
上記到来時刻差算出手段により算出された到来時刻差から上記目標の位置を測位する位置測位手段と、
上記位置測位手段により測位された目標の位置又は上記到来時刻差算出手段により算出された到来時刻差を追尾処理用のフィルタに代入して、上記目標の追尾処理を実施することで、上記目標の航跡予測値と航跡平滑値を算出する目標追尾手段と、
上記目標追尾手段により算出された目標の航跡予測値と航跡平滑値を表示する表示手段と、
上記目標と上記複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段と、
上記信号遮蔽判定手段により信号遮蔽が発生していると判定された場合、目標の加速度を考慮して、上記目標の航跡予測値を算出する旨を上記目標追尾手段に指示する追尾処理制御手段と
を備えた測位追尾装置。 A plurality of receiving stations that receive signals transmitted from the target and output the arrival times of the signals;
An arrival time difference calculating means for calculating an arrival time difference that is a time difference between arrival times output from the plurality of receiving stations;
Position positioning means for positioning the target position from the arrival time difference calculated by the arrival time difference calculation means;
By substituting the target position measured by the position positioning means or the arrival time difference calculated by the arrival time difference calculating means into a filter for tracking processing, and performing the target tracking processing, A target tracking means for calculating a wake prediction value and a wake smooth value;
Display means for displaying the target track prediction value and the track smooth value calculated by the target tracking means;
Signal shielding determination means for determining whether signal shielding occurs between the target and the plurality of receiving stations;
If the signal blocking is determined to be generated by the signal blocking judging means, taking into account the acceleration of the target, and tracking processing control means to the effect of calculating the trajectory prediction value of the target instructs the target tracking means
Positioning tracking device equipped with .
上記複数の受信局から出力された到来時刻の時刻差である到来時刻差を算出する到来時刻差算出手段と、
上記到来時刻差算出手段により算出された到来時刻差から上記目標の位置を測位する位置測位手段と、
上記位置測位手段により測位された目標の位置又は上記到来時刻差算出手段により算出された到来時刻差を追尾処理用のフィルタに代入して、上記目標の追尾処理を実施することで、上記目標の航跡予測値と航跡平滑値を算出する目標追尾手段と、
上記目標追尾手段により算出された目標の航跡予測値と航跡平滑値を表示する表示手段と、
上記目標と上記複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段と、
上記信号遮蔽判定手段の判定結果に応じて、上記目標追尾手段における目標の追尾処理を制御する追尾処理制御手段とを備え、
上記目標追尾手段は、各種の運動モデルを組み合わせて、目標を追尾する多重運動モデル追尾処理を実施するものであり、
上記追尾処理制御手段は、上記信号遮蔽判定手段の判定結果に応じて、上記多重運動モデル追尾処理のモデル推移確率を設定することを特徴とする測位追尾装置。 A plurality of receiving stations that receive signals transmitted from the target and output the arrival times of the signals;
An arrival time difference calculating means for calculating an arrival time difference that is a time difference between arrival times output from the plurality of receiving stations;
Position positioning means for positioning the target position from the arrival time difference calculated by the arrival time difference calculation means;
By substituting the target position measured by the position positioning means or the arrival time difference calculated by the arrival time difference calculating means into a filter for tracking processing, and performing the target tracking processing, A target tracking means for calculating a wake prediction value and a wake smooth value;
Display means for displaying the target track prediction value and the track smooth value calculated by the target tracking means;
Signal shielding determination means for determining whether signal shielding occurs between the target and the plurality of receiving stations;
Tracking process control means for controlling target tracking processing in the target tracking means according to the determination result of the signal shielding determination means,
The target tracking means performs a multiple motion model tracking process for tracking a target by combining various motion models.
The tracking processing control means in accordance with the determination result of the signal blocking determining means, measuring position tracking device you and sets the model transition probability of the multiple motion model tracking process.
上記複数の受信局から出力された到来時刻の時刻差である到来時刻差を算出する到来時刻差算出手段と、
上記到来時刻差算出手段により算出された到来時刻差から上記目標の位置を測位する位置測位手段と、
上記位置測位手段により測位された目標の位置又は上記到来時刻差算出手段により算出された到来時刻差を追尾処理用のフィルタに代入して、上記目標の追尾処理を実施することで、上記目標の航跡予測値と航跡平滑値を算出する目標追尾手段と、
上記目標追尾手段により算出された目標の航跡予測値と航跡平滑値を表示する表示手段と、
上記目標と上記複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段と、
上記信号遮蔽判定手段の判定結果に応じて、上記目標追尾手段における目標の追尾処理を制御する追尾処理制御手段とを備え、
上記目標追尾手段は、直進モデルの追尾フィルタから得られる処理結果と、旋回モデルの追尾フィルタから得られる処理結果とを統合する運動モデル統合追尾処理を実施するものであり、
上記追尾処理制御手段は、上記信号遮蔽判定手段の判定結果に応じて、直進モデルの追尾フィルタから得られる処理結果と、旋回モデルの追尾フィルタから得られる処理結果とを統合する際の重み付けを設定することを特徴とする測位追尾装置。 A plurality of receiving stations that receive signals transmitted from the target and output the arrival times of the signals;
An arrival time difference calculating means for calculating an arrival time difference that is a time difference between arrival times output from the plurality of receiving stations;
Position positioning means for positioning the target position from the arrival time difference calculated by the arrival time difference calculation means;
By substituting the target position measured by the position positioning means or the arrival time difference calculated by the arrival time difference calculating means into a filter for tracking processing, and performing the target tracking processing, A target tracking means for calculating a wake prediction value and a wake smooth value;
Display means for displaying the target track prediction value and the track smooth value calculated by the target tracking means;
Signal shielding determination means for determining whether signal shielding occurs between the target and the plurality of receiving stations;
Tracking process control means for controlling target tracking processing in the target tracking means according to the determination result of the signal shielding determination means,
The target tracking means performs a motion model integrated tracking process that integrates the processing result obtained from the tracking filter of the straight traveling model and the processing result obtained from the tracking filter of the turning model.
The tracking processing control means, set in accordance with the determination result of the signal blocking determination means, the processing results obtained from the tracking filter straight model, the weighting at the time of integrating the processing results obtained from the tracking filter of the turning model measuring position tracking device you characterized by.
上記複数の受信局から出力された到来時刻の時刻差である到来時刻差を算出する到来時刻差算出手段と、
上記到来時刻差算出手段により算出された到来時刻差から上記目標の位置を測位する位置測位手段と、
上記位置測位手段により測位された目標の位置又は上記到来時刻差算出手段により算出された到来時刻差を追尾処理用のフィルタに代入して、上記目標の追尾処理を実施することで、上記目標の航跡予測値と航跡平滑値を算出する目標追尾手段と、
上記目標追尾手段により算出された目標の航跡予測値と航跡平滑値を表示する表示手段と、
上記目標と上記複数の受信局間で信号遮蔽が発生しているか否かを判定する信号遮蔽判定手段と、
上記信号遮蔽判定手段の判定結果に応じて、上記目標追尾手段における目標の追尾処理を制御する追尾処理制御手段とを備え、
上記目標追尾手段は、水平方向の複数の運動モデルを組み合わせて目標を追尾する水平方向の多重運動モデル追尾処理と、垂直方向の複数の運動モデルを組み合わせて目標を追尾する垂直方向の多重運動モデル追尾処理とを実施して、水平方向の多重運動モデル追尾処理の処理結果と垂直方向の多重運動モデル追尾処理の処理結果とを統合するものであり、
上記追尾処理制御手段は、上記信号遮蔽判定手段の判定結果と地形を考慮して、上記水平方向の多重運動モデル追尾処理のモデル推移確率及び上記垂直方向の多重運動モデル追尾処理のモデル推移確率を設定することを特徴とする測位追尾装置。 A plurality of receiving stations that receive signals transmitted from the target and output the arrival times of the signals;
An arrival time difference calculating means for calculating an arrival time difference that is a time difference between arrival times output from the plurality of receiving stations;
Position positioning means for positioning the target position from the arrival time difference calculated by the arrival time difference calculation means;
By substituting the target position measured by the position positioning means or the arrival time difference calculated by the arrival time difference calculating means into a filter for tracking processing, and performing the target tracking processing, A target tracking means for calculating a wake prediction value and a wake smooth value;
Display means for displaying the target track prediction value and the track smooth value calculated by the target tracking means;
Signal shielding determination means for determining whether signal shielding occurs between the target and the plurality of receiving stations;
Tracking process control means for controlling target tracking processing in the target tracking means according to the determination result of the signal shielding determination means,
The target tracking means includes a horizontal multiple motion model tracking process for tracking a target by combining a plurality of horizontal motion models, and a vertical multiple motion model for tracking a target by combining a plurality of vertical motion models. The tracking process is performed, and the processing result of the horizontal multi-motion model tracking process and the processing result of the vertical multi-motion model tracking process are integrated.
The tracking processing control unit, taking into account the determination result and terrain of the signal blocking determining means, the model transition probability of a multiple motion model tracking process of the model transition probability and the vertical direction of the multiple motion model tracking processing of the horizontal direction setting measuring position tracking device you characterized by.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2014507753A JP5744320B2 (en) | 2012-03-28 | 2013-03-19 | Positioning tracking device |
Applications Claiming Priority (4)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012074003 | 2012-03-28 | ||
| JP2012074003 | 2012-03-28 | ||
| JP2014507753A JP5744320B2 (en) | 2012-03-28 | 2013-03-19 | Positioning tracking device |
| PCT/JP2013/057823 WO2013146468A1 (en) | 2012-03-28 | 2013-03-19 | Positioning tracking device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP5744320B2 true JP5744320B2 (en) | 2015-07-08 |
| JPWO2013146468A1 JPWO2013146468A1 (en) | 2015-12-10 |
Family
ID=49259724
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2014507753A Active JP5744320B2 (en) | 2012-03-28 | 2013-03-19 | Positioning tracking device |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP5744320B2 (en) |
| WO (1) | WO2013146468A1 (en) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2017014011A1 (en) * | 2015-07-17 | 2017-01-26 | 株式会社村田製作所 | Position detection system and computer program |
| CN107228667B (en) * | 2017-04-23 | 2019-11-26 | 西安电子科技大学 | A kind of improved Kalman filter device indoor positioning tracking merging cartographic information |
| JP7111506B2 (en) * | 2018-05-17 | 2022-08-02 | 株式会社デンソーテン | Target detection device |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4376330B2 (en) * | 1998-08-10 | 2009-12-02 | 富士通テン株式会社 | Satellite tracking antenna device for moving objects |
| JP4397732B2 (en) * | 2004-05-12 | 2010-01-13 | 三菱電機株式会社 | Positioning device |
-
2013
- 2013-03-19 JP JP2014507753A patent/JP5744320B2/en active Active
- 2013-03-19 WO PCT/JP2013/057823 patent/WO2013146468A1/en active Application Filing
Also Published As
| Publication number | Publication date |
|---|---|
| WO2013146468A1 (en) | 2013-10-03 |
| JPWO2013146468A1 (en) | 2015-12-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US11726498B2 (en) | Aerial vehicle touchdown detection | |
| JP7143444B2 (en) | aircraft smart landing | |
| CN107368095B (en) | Air anti-collision system and method for small-sized fixed-wing unmanned aerial vehicle | |
| US10534068B2 (en) | Localization system, vehicle control system, and methods thereof | |
| CN110471441A (en) | A kind of quadrotor drone barrier-avoiding method based on laser acquisition | |
| US8319679B2 (en) | Systems and methods for predicting locations of weather relative to an aircraft | |
| Lawrance et al. | Path planning for autonomous soaring flight in dynamic wind fields | |
| CN109521756A (en) | Barrier motion information generation method and device for automatic driving vehicle | |
| CN102621542B (en) | Track method before locomotive weak target detection based on multimode grain filtering and data association | |
| CN105628026A (en) | Positioning and posture determining method and system of mobile object | |
| US7792330B1 (en) | System and method for determining range in response to image data | |
| JP5744320B2 (en) | Positioning tracking device | |
| CN106908762A (en) | A kind of many hypothesis UKF method for tracking target for UHF rfid systems | |
| US10976426B2 (en) | Apparatus and method for ascertaining object kinematics of a movable object | |
| Hafner et al. | Evaluation of smartphone-based indoor positioning using different Bayes filters | |
| CN103176477B (en) | A kind of carried SAR flight route method of combination based on wind speed and direction dynamic conditioning | |
| CN113589222A (en) | Aircraft guidance with beacon transmission | |
| RU2584067C1 (en) | Method of determining motion parameters of aircraft during landing | |
| JP2004309166A (en) | Target tracking apparatus | |
| JP6162630B2 (en) | Target positioning system and target positioning method | |
| EP3060952B1 (en) | Locational and directional sensor control for search | |
| US20240200969A1 (en) | Machine learning based occupancy grid generation | |
| RU22925U1 (en) | DEVICE FOR DETERMINING FLIGHT PARAMETERS FOR CARRYING OUT AN AUTOMATIC LANDING OF THE AIRCRAFT | |
| RU2206873C1 (en) | Device determining parameters of flight to implement automatic landing of aircraft | |
| JP7529391B2 (en) | Pseudorange Estimation From Passive Sensors |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 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: 20150407 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20150428 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 5744320 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| 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 |