WO2017119081A1 - 目標追尾装置 - Google Patents
目標追尾装置 Download PDFInfo
- Publication number
- WO2017119081A1 WO2017119081A1 PCT/JP2016/050254 JP2016050254W WO2017119081A1 WO 2017119081 A1 WO2017119081 A1 WO 2017119081A1 JP 2016050254 W JP2016050254 W JP 2016050254W WO 2017119081 A1 WO2017119081 A1 WO 2017119081A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- wake
- target
- track
- echo
- tracking
- Prior art date
Links
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
- 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
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
- G01S13/726—Multiple target tracking
-
- 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/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/06—Systems determining position data of a target
- G01S13/08—Systems for measuring distance only
- G01S13/10—Systems for measuring distance only using transmission of interrupted, pulse modulated waves
- G01S13/20—Systems for measuring distance only using transmission of interrupted, pulse modulated waves whereby multiple time-around echoes are used or eliminated
-
- 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/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/06—Systems determining position data of a target
- G01S13/08—Systems for measuring distance only
- G01S13/10—Systems for measuring distance only using transmission of interrupted, pulse modulated waves
- G01S13/22—Systems for measuring distance only using transmission of interrupted, pulse modulated waves using irregular pulse repetition frequency
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/28—Details of pulse systems
- G01S7/285—Receivers
- G01S7/292—Extracting wanted echo-signals
- G01S7/2923—Extracting wanted echo-signals based on data belonging to a number of consecutive radar periods
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G5/00—Traffic control systems for aircraft, e.g. air-traffic control [ATC]
Definitions
- the present invention relates to a target tracking device that estimates a target track from target observation information of an aircraft or the like detected by a radar device or the like.
- a pulse radar device or the like transmits a pulse and receives a reflected pulse reflected by the target to be observed.
- the target tracking device measures the distance to the target based on the transmission / reception time from when the pulse is transmitted by the pulse radar device or the like to when it is received.
- the pulse transmission / reception time is longer than the pulse repetition interval (PRI, Pulse Repetition Interval) at the time of pulse transmission, the pulse transmission / reception time and the distance to the target are not unique, and the correct target position cannot be obtained. It is known that there is. This phenomenon is called “multi-order echo”, “distance ambiguity”, “range ambiguity”, or “distance folding”.
- Non-Patent Document 1 is a method of observing a target with a plurality of types of PRIs and estimating a correct target distance from a difference in the distance direction of multi-order echoes in each PRI. This method is generally called “multi-PRI ranging” or “multi-PRF (Pulse Repeat Frequency) ranging”.
- Non-Patent Document 2 and Patent Document 1 is a method of extracting only the primary echo by suppressing the secondary echo in demodulating the received pulse by periodically changing the modulation code of the transmission pulse. It is.
- n-th echo a case where a pulse transmitted in the (k ⁇ 1) -th time frame is received in the k-th time frame is referred to as “n-th echo”.
- k and n are natural numbers.
- “n” of the nth-order echo is expressed as “order of multi-order echo”.
- Non-Patent Document 2 and Patent Document 1 that remove secondary echoes by changing the modulation code of the transmission pulse have a problem that multi-order echoes of the third order or higher cannot be removed. It was. This problem does not become a problem when the reflection cross-sectional area of the target to be observed is small, and the pulse transmission / reception time is such that the intensity of the reflected pulse from a distance is sufficiently small to exceed twice the PRI. . On the other hand, under the condition where a small target at a short distance and a large target at a distance are observed at the same time, correct positions and velocities of a small target and a large target with different orders of multi-order echo cannot be obtained.
- the present invention has been made to solve the above-described problem.
- the target number is unknown, erroneous detection occurs, target detection is lost, and multi-order echoes of different orders are generated simultaneously.
- the purpose is to estimate the track of each target.
- a target track candidate is created on the assumption that the target to be observed exists at a distance observed as an nth-order echo, and is displayed on the display unit based on the reliability of the track candidate.
- the track of each target is determined when the number of targets is unknown, erroneous detection occurs, target detection is lost, and multi-order echoes of different orders occur simultaneously. Can be estimated.
- FIG. 2A is a conceptual diagram illustrating an observation condition to which the target tracking device according to Embodiment 1 is applied
- FIG. 2B is a conceptual diagram illustrating an example of a target observation result
- 3 is a diagram illustrating a hardware configuration example of a target tracking device according to Embodiment 1.
- FIG. 4A, 4B, and 4C are conceptual diagrams illustrating examples of a primary echo wake, a secondary echo wake, and a tertiary echo wake created by the target tracking device according to the first embodiment.
- FIG. 10 is a conceptual diagram showing an example of m-th to n-th echo wakes in the second embodiment.
- 10 is a flowchart showing operations of an m-th to n-th order echo tracking filter unit and a wake reliability calculation unit of the target tracking device according to the second embodiment.
- 10 is a flowchart illustrating an operation of a track determination unit of the target tracking device according to the third embodiment.
- FIG. 1 is a block diagram showing a configuration example of a target tracking device 1 according to Embodiment 1 of the present invention. Below, the case where the target tracking apparatus 1 which concerns on each embodiment of this invention is applied to the radar 2 which is an existing radar apparatus is demonstrated.
- FIG. 2A is a conceptual diagram showing an observation condition to which the target tracking device 1 according to Embodiment 1 is applied
- FIG. 2B is a conceptual diagram showing an example of a target observation result.
- the x-axis is the positive east-west direction eastward
- the y-axis is the positive north-south direction northward.
- the target tracking device 1 receives such a detection plot from the radar 2, determines the motion specification of each target, and outputs it to the display 7.
- the motion specifications are the target position, velocity, acceleration, and the like, and are hereinafter referred to as “tracking tracks”.
- the radar 2 includes existing devices such as a pulse transmission device, a transmission / reception switching device, an antenna, a receiver, and a signal detector (not shown), and observes a target position. Then, the radar 2 outputs the position information of the target detected in the latest time frame, that is, a detection plot, to the primary echo tracking filter unit 3 and the nth echo tracking filter unit 3-n. Note that the detection plot may include erroneous detection based on reflected pulses from other than the target. In addition, it is assumed that the detection plot of each time frame includes PRI information at the time of observation.
- the observation area of the radar 2 is arbitrary, and it may be a two-dimensional radar that observes the distance to the target and the azimuth angle, or may be a three-dimensional radar that can also observe the elevation angle direction.
- the track reliability increases as the tracking track approaches the motion model assumed by the primary echo tracking filter unit 3 and the n-th echo tracking filter unit 3-n. For example, when a constant velocity linear motion model is assumed, the track reliability generated by the tracking wake created by the detection plots arranged in a straight line increases.
- FIG. 4A, 4B, and 4C are conceptual diagrams showing examples of the primary echo wake, the secondary echo wake, and the tertiary echo wake generated by the target tracking device 1 according to Embodiment 1.
- FIG. In this example, a detection plot observed while the radar 2 periodically switches between three types of PRIs (PRI1, PRI2, and PRI3) for a multi-order echo of order 2 is input to the target tracking device 1. And Further, it is assumed that the primary echo tracking filter unit 3 and the n-th echo tracking filter unit 3-n create a tracking wake based on a constant velocity linear motion model.
- FIG. 4A shows an example of the primary echo track 61 output by the primary echo tracking filter unit 3.
- the primary echo tracking filter unit 3 creates a tracking wake candidate under the assumption that “each detection plot is a result of observing a target less than the maximum observation distance R max ”.
- the primary echo tracking filter unit 3 creates a tracking track on the assumption that a detection omission 64 or a false detection 65 occurs with a certain probability. Specifically, when the detection plot is missing, the primary echo tracking filter unit 3 extends, for example, the tracking track up to that point at an estimated speed, thereby interpolating the detection missing 64 to the primary echo track 61. Create Further, for example, the primary echo tracking filter unit 3 creates the primary echo wake 61 that does not include the false detection 65 by ignoring the detection plot away from the tracking wake.
- FIG. 4B shows an example of the secondary echo wake 62 output from the secondary echo tracking filter unit 3-2.
- the secondary echo tracking filter 3-2 assuming that "each detection plot is the result of observing the target less than the maximum observation distance R max or 2R max", each detected plot the distance direction of the radar origin 50 PRI After moving a distance that depends on, create a tracking wake candidate.
- the secondary echo tracking filter unit 3-2 similarly to the primary echo tracking filter unit 3, creates a tracking track on the assumption that the detection loss 64 or the false detection 65 occurs with a certain probability.
- FIG. 4C shows an example of the tertiary echo wake 63 output from the tertiary echo tracking filter unit 3-3.
- the third-order echo tracking filter unit 3-3 assumes that “each detection plot is a result of observing a target having a maximum observation distance of 2R max or more and less than 3R max ”, and each detection plot is PRI in the distance direction of the radar origin 50. After moving a distance that depends on, create a tracking wake candidate. At this time, similarly to the primary echo tracking filter unit 3, the tertiary echo tracking filter unit 3-3 creates a tracking track on the assumption that the detection loss 64 or the false detection 65 occurs with a certain probability.
- the tracking wake close to the constant velocity linear motion model as the motion model is the secondary echo wake 62. Therefore, in this example, the track reliability of the secondary echo wake 62 calculated by the track reliability calculation unit 4 paired with the secondary echo tracking filter unit 3-2 is the same as that of the other track reliability calculation units 4.
- the wake determination unit 6 determines the secondary echo wake 62 as the display wake and outputs it to the display 7.
- the tracking track representing the target estimation value is assumed to be composed of a “state vector” representing the motion specifications and an “error covariance matrix” representing the ambiguity of the estimation.
- k at time k are defined by Expression (2) and Expression (3).
- the time k is defined as “the kth observation time frame from the start of observation (k is a natural number)”.
- the target tracking device 1 repeatedly executes the processing shown in the flowcharts of FIGS. 5 and 6 for each observation time frame.
- T on the right shoulder of the parenthesis in Equation (2) represents transposition of the matrix.
- x and v x represent the position and velocity of the x-axis.
- y and v y represent the position and velocity of the y-axis.
- z and v z represents the position and velocity of the z-axis.
- the x-axis is set in the east-facing positive east-west direction.
- the y-axis is set in a north-south positive north-south direction.
- the z-axis is set to a positive altitude direction.
- the detection plot obtained from the radar 2 at time k is expressed as “detection plot z k ” and is defined by the equation (4).
- each of the n-order echo tracking filter units 3-n including the primary echo tracking filter unit 3 when n is an integer of 1 or more performs n-order echo conversion.
- the nth-order echo tracking filter unit 3-n assumes that the detection plot input from the radar 2 is the observation result of the nth-order echo target, and moves the position of the detection plot from the radar origin 50 by a certain distance in the distance direction.
- Equation (6) z k, R , z k, By , z k, El are detection plots in the polar coordinate system, and are defined by Equation (7).
- each of the nth-order echo tracking filter units 3-n including the first-order echo tracking filter unit 3 performs initial track addition.
- the nth-order echo tracking filter unit 3-n creates a new tracking track candidate at time k ⁇ 1 based on the past detection plot. Since the initial value of the tracking wake that is repeatedly predicted and updated is set in accordance with the repetition of the processing shown in the flowchart of FIG. 5, the wake created here is denoted as “initial wake”.
- k ⁇ 1, New which is the initial value of the wake reliability calculated in step ST1-6, which will be described later, is set from equation (10).
- ⁇ FT is a scalar parameter indicating the number of erroneous detections per unit volume
- ⁇ NT is a scalar parameter indicating the number of targets appearing per unit volume.
- the nth-order echo tracking filter unit 3-n performs the tracking wake state vector x k-1
- K ⁇ 1 is obtained.
- I 3 is a 3 ⁇ 3 unit matrix.
- each of the n-th echo tracking filter unit 3-n including the primary echo tracking filter unit 3 obtains a wake correlation.
- the nth-order echo tracking filter unit 3-n extracts a detection plot at time k in the vicinity of the predicted track at time k, and narrows down the detection plot used when updating the predicted track in the next step ST1-5.
- the nth-order echo tracking filter unit 3-n detects a condition “neighboring” for a state vector x k
- neighborhborhood for example, when the position residual is defined by a distance (Mahalanobis distance) normalized by an error, the nth-order echo tracking filter unit 3-n detects a detection plot that satisfies the following conditional expression (16) Extract z k as “detection plot in correlation gate”.
- ⁇ Gate is a scalar parameter that determines the size of the correlation gate.
- H is a matrix for extracting the same components as the detection plot from the state vector, and is defined by Expression (17).
- each of the nth-order echo tracking filter units 3-n including the first-order echo tracking filter unit 3 performs track update.
- the nth-order echo tracking filter unit 3-n creates a tracking track at time k from the predicted track and the detection plot in the correlation gate.
- the nth-order echo tracking filter unit 3-n also creates a wake representing the case where the predicted wake is not observed as a detection plot at time k as the tracking wake at time k.
- the nth-order echo tracking filter unit 3-n performs the above process on all detection plots in the correlation gate. Therefore, when m detection plots are obtained in the correlation gate, m tracking track candidates x k
- the nth-order echo tracking filter unit 3-n also performs tracking tracks according to the following formulas (21) and (22) as tracking track candidates indicating that the predicted track is not observed as a detection plot at time k. create.
- step ST1-5 Of the m + 1 tracking tracks created in step ST1-5, there is at most one true tracking track. However, the likelihood of each tracking track is evaluated in subsequent steps ST1-6, the erroneous tracking tracks are reduced in step ST1-7, and then the final tracking track for display is determined by the track determination unit 6. Therefore, at this time, it is not narrowed down which wake is correct.
- each of the track reliability calculation units 4 paired with the nth-order echo tracking filter unit 3-n including the primary echo tracking filter unit 3 performs track reliability calculation.
- the wake reliability calculation unit 4 calculates a value representing the likelihood of the tracking wake created in step ST1-5 from the predicted wake and the detection plot in the correlation gate as the “wake credibility”.
- the reliability of the tracking track when the predicted track is not observed as a detection plot at time k that is, the reliability of the track updated by the equations (21) and (22) in step ST1-5 is as follows. It shall be calculated
- b Th is a scalar parameter that represents a lower limit threshold value for track reliability.
- the wake reliability calculation unit 4 outputs a plurality of tracking tracks that have not been deleted here to the wake determination unit 6 as “nth echo wakes at time k”.
- step ST1-8 the wake determination unit 6 sets the provisional maximum reliability to a minimum value, that is, the minimum negative value on the program.
- step ST1-9 the track determination unit 6 selects one unselected tracking track in the process at time k from the received n-th echo track.
- step ST1-10 the track determination unit 6 compares the track reliability of the selected tracking track with the provisional maximum reliability. When the track reliability of the selected tracking track is greater than the provisional maximum reliability (step ST1-10 “YES”), the track determination unit 6 proceeds to step ST1-11. On the other hand, when the track reliability of the selected tracking track is equal to or lower than the provisional maximum reliability (step ST1-10 “NO”), the track determination unit 6 skips step ST1-11 and performs step ST1- 12
- the indicator 7 displays the display track received from the track determination unit 6 on a display or the like.
- the information displayed at this time includes the position and speed included in the state vector of the display wake, the ellipse indicating the magnitude of the error obtained from the error covariance matrix of the display wake, the multi-order echo order, or the wake reliability of the display wake, etc. It is.
- the display device 7 can change the information to be displayed according to preset conditions or input from the user.
- a tracking wake is obtained for a multi-order echo target of an arbitrary order by an n-order echo calculation block 5 constituted by an arbitrary number of pairs of an n-order echo tracking filter unit 3-n and a track reliability calculation unit 4. Therefore, as long as the target is observed by the radar 2, it is epoch-making in that there is no theoretical upper limit to the target distance from which the tracking track can be obtained.
- the maximum observation distance can be obtained even in the case where detection failure occurs due to a small target and erroneous detection due to reflected pulses from other than the target occurs.
- the wake of the target beyond R max can be estimated. This is based on Equation (21) and Equation (22) on the premise that the first-order echo tracking filter unit 3 and the n-th order echo tracking filter unit 3-n occur with a probability of missing detection and false detection. This is because a tracking track is created from the time series of the detection plot, or the detection plot is narrowed down in step ST1-4.
- the target wake can be estimated even when the order of multi-order echo is 3 or more.
- the target wake can be estimated even when the order of multi-order echo is 3 or more.
- multi-PRI ranging in which a higher-order multi-order echo target requires detection plots using various kinds of PRIs for position estimation, PRI1, PRI2,..., PRIN (N Can be estimated for a multi-order echo target of any order from a time series of detection plots using at least two types of PRI.
- the target tracking device 1 is used when the target number is unknown, erroneous detection occurs, missing target detection occurs, and multi-order echoes of different orders occur simultaneously.
- the wake of each target can be estimated.
- FIG. FIG. 7 is a block diagram showing a configuration example of the target tracking device 1 according to Embodiment 2 of the present invention.
- the configuration is based on the premise that the order of the multi-order echo does not change during the observation.
- R max m is an integer of 1 or more
- nth-order echo target n is an integer of 1 or more, m ⁇ n
- the next echo target may occur.
- a track of a multi-order echo target in which the order of the multi-order echo changes between n and m (hereinafter, m-th to n-th echo track) is also estimated.
- the maximum value of n is the maximum order of multi-order echoes that can be observed.
- FIG. 8 shows a case where there is one boundary straddling, the present invention is not limited to this, and there may be a case where a plurality of boundaries are straddled.
- the m-th to n-th order echo tracking filter unit 8 receives a detection plot from the radar 2 in the latest time frame.
- the m-th to n-th order echo tracking filter unit 8 receives the m-th order echo track in the past time frame from the m-th order echo tracking filter unit 3-m and also the n-th order echo track in the past time frame. Received from the tracking filter unit 3-n.
- the m-th to n-th order echo tracking filter unit 8 creates a tracking track of a multi-order echo target in which the order of the multi-order echo changes between n and m during observation, and makes a paired track reliability calculation unit 4 is output.
- the m-th order echo detection plot and the n-th order echo detection plot are treated as “detection plot z k at time k” without being distinguished from each other.
- step ST2-4 the m-th to n-th order echo tracking filter unit 8 obtains a wake correlation.
- the m-th to n-th order echo tracking filter unit 8 extracts a detection plot at time k in the vicinity of the predicted track at time k, and narrows down the detection plot used when updating the predicted track in the next step ST2-5.
- the method for extracting the detection plot in the vicinity of the predicted wake is performed using, for example, Expression (16) as in the first embodiment.
- the m-th to n-th echo tracking filter unit 8 performs track update.
- the m-th to n-th order echo tracking filter unit 8 creates a tracking track at time k from the predicted track and the detection plot in the correlation gate.
- the m-th to n-th order echo tracking filter unit 8 also creates a wake representing the case where the predicted wake is not observed as a detection plot at time k as the tracking wake at time k.
- the method for creating the tracking wake from the prediction wake and the detection plot in the correlation gate is performed using Equation (18), Equation (19), Equation (21), and Equation (22), as in the first embodiment. .
- the mth to nth order echo tracking filter unit 8 and the wake reliability calculation unit 4 paired with the mth to nth order echo tracking filter unit 8 operate.
- the m-th to n-th order echo tracks output from the track reliability calculation unit 4 and their track reliability are candidates for display tracks selected by the track determination unit 6 by the same operation as in the first embodiment.
- the target tracking device 1 includes a plurality of sets of m-th order echo tracking filter unit 3-m, n-th order echo tracking filter unit 3-n, and m-th to n-th order echo tracking filter unit 8. It may be.
- the target tracking device 1 under the observation condition in which the tertiary echo target is detected, the target tracking device 1 is set to the primary echo tracking filter unit, the secondary echo tracking filter unit, the tertiary echo tracking filter unit, and the primary to secondary echo tracking filter unit. , And a secondary to tertiary echo tracking filter section.
- Tracking track is obtained.
- the m-th to n-th order echo tracking filter unit 8 updates the tracking track represented as the m-th order echo target at the previous time with the detection plot at the latest time assuming that it is the n-th order echo target.
- the track representing the n-th echo target by updating the detection plot assuming m-th echo goal is to create a tracking track of the target across the boundary of the maximum observation distance R max.
- FIG. 10 is a block diagram showing a configuration example of the target tracking device 1 according to Embodiment 3 of the present invention.
- the target tracking device 1 according to Embodiment 3 includes an nth-order echo tracking filter unit 3-n, a wake reliability calculation unit 4, an nth-order echo calculation block 5, and a wake determination unit 6 And.
- the wake determination unit 6 includes a wake hypothesis creation unit 9 and a wake hypothesis determination unit 10. Note that the mounting method and operation of the nth-order echo tracking filter unit 3-n, the wake reliability calculation unit 4 and the nth-order echo calculation block 5 are the same as those in the first embodiment, and thus the description thereof is omitted.
- a combination of tracking tracks that can be realized at the same time means that the detection plot history used for the track update in step ST1-5 in FIG. 5 for a certain tracking track and the step ST1-5 in FIG. 5 for another tracking track. It is defined that the same detection plot is not included in the detection plot history used for the wake update.
- a tracking track T1 is a track created from past detection plots z 1 (T1) , z 2 (T1) ,..., Z k (T1)
- another tracking track T2 is a past detection plot z. 1 (T2) , z 2 (T2) ,..., Z k (T2) .
- the overlapped detection plot is tracked with the tracking track T1. Since either one of the wakes T2 is observed, the tracking wake T1 and the tracking wake T2 are wakes that cannot be realized at the same time. However, under this condition, as the observation time is longer, more detection plot histories need to be traced and the processing load becomes higher. Therefore, in the description of the operation described later, only the detection plots at the past L times are duplicated as practical processing. Shall be determined.
- the display unit 7 receives one or a plurality of display tracks from the track hypothesis determination unit 10, and represents a motion value such as a target position or velocity included in each display track, a value representing an error in an estimated value of the motion parameters, Displays the next echo order or wake reliability.
- n is an integer greater than or equal to 1
- the wake hypothesis creation unit 9 and the wake hypothesis determination unit 10 receive the nth-order echo wake at time k, its wake reliability, and the like from the wake reliability calculation unit 4 paired with the nth-order echo tracking filter unit 3-n. And the processing shown in the flowchart of FIG. 11 is performed.
- step ST3-1 the wake hypothesis determination unit 10 sets the provisional maximum hypothesis reliability to a minimum value, that is, the minimum negative value on the program.
- step ST3-2 the wake hypothesis creation unit 9 creates a wake hypothesis by combining the tracking wakes of the uncreated combination in the process at time k from the received nth-order echo wakes. At this time, it is assumed that one or more tracking tracks are included in the wake hypothesis, and it is not distinguished which multi-order echo is assumed for each tracking wake.
- step ST3-3 the wake hypothesis creating unit 9 uses each track in the created wake hypothesis to update the wake in step ST1-5 in FIG. 5 between time k and time kL. Compare the history of detected plots.
- L is an integer greater than or equal to 0, and is a parameter that determines the balance between performance and processing load. The larger L is, the higher the estimation accuracy of the wake hypothesis is, while the processing load is high. If the same detection plot is included in the history of the detection plots for the past L times of each tracking wake included in the wake hypothesis created in step ST3-2 (step ST3-3 “NO”), The wake hypothesis creation unit 9 determines that this wake hypothesis is not “a combination of tracking wakes that can be realized simultaneously” and rejects the wake hypothesis, and proceeds to step ST3-7.
- step ST3-3 when the same detection plot is not included in the history of the past L detection plots of each tracking wake (step ST3-3 “YES”), the wake hypothesis creation unit 9 determines that the wake hypothesis is “simultaneously. It is determined that the combination of tracking tracks can be realized, and the process proceeds to step ST3-4.
- the wake hypothesis determination unit 10 receives from the wake hypothesis creation unit 9 a wake hypothesis determined to be a “combination of tracking wakes that can be realized at the same time”. For the tracking track, the sum of the track reliability is calculated as the hypothesis reliability.
- the hypothesis reliability is a value that indicates how many likely tracking tracks are included in the wake hypothesis, and the larger the value, the more likely the combination of tracking tracks.
- step ST3-5 the wake hypothesis determination unit 10 compares the hypothesis reliability obtained in step ST3-4 with the provisional maximum hypothesis reliability. When the hypothesis reliability obtained in step ST3-4 is greater than the provisional maximum hypothesis reliability (step ST3-5 “YES”), the wake hypothesis determination unit 10 proceeds to step ST3-6. On the other hand, when the hypothesis reliability obtained in step ST3-4 is equal to or lower than the provisional maximum hypothesis reliability (step ST3-5 “NO”), the wake hypothesis determination unit 10 skips step ST3-6. The process proceeds to step ST3-7.
- step ST3-6 the wake hypothesis determination unit 10 overwrites the provisional maximum hypothesis reliability with the hypothesis reliability of step ST3-4.
- step ST3-7 the wake hypothesis creation unit 9 determines whether or not all the wake hypotheses have been created from the received nth-order echo wake. When the wake hypothesis creating unit 9 creates all the wake hypotheses (“YES” in step ST3-7), the wake hypothesis creating unit 9 proceeds to step ST3-8. On the other hand, if there is an uncreated combination of wake hypotheses ("NO" in step ST3-7), the wake hypothesis creating unit 9 returns to step ST3-2.
- the tracking track of each target can be obtained.
- the track hypothesis generation unit 9 and the track hypothesis determination unit 10 output a combination of tracking tracks that do not share the same detection plot and that include the most likely tracking tracks. .
- This effect is displayed especially on the assumption that each tracking track does not share the same detection plot when a plurality of multi-order echo targets having different orders appear close together on the detection plot output from the radar 2. Since the wake is determined, it is epoch-making in that it becomes difficult for a tracking wake of a multi-order echo track of one order to transfer to a multi-order echo of another order.
- a time series of detection plots by at least two types of PRIs is different from multi-PRI ranging that requires detection plots obtained by various types of PRIs as the number of targets observed simultaneously increases. Therefore, each track can be estimated for an arbitrary number of multi-order echo targets. This is for generating a combination of tracking tracks without setting an upper limit of the target number in the track hypothesis creation unit 9.
- the target tracking device 1 when the target track is estimated based on the observation result of the radar device has been described.
- a ranging sensor other than a radar such as a ranging sensor using sound waves. Needless to say, it can also be used.
- the target tracking device estimates the correct track of a target with respect to multi-order echoes, it is suitable for use with a radar device or the like that observes a target with a plurality of types of PRIs.
- 1 target tracking device 2 radar, 3rd order echo tracking filter section, 3-m mth order echo tracking filter section, 3-n nth order echo tracking filter section, 4 track reliability calculation section, 5th order echo calculation block, 6 wake determination unit, 7 indicator, 8 m-th to n-th order echo tracking filter unit (multi-order echo tracking filter unit), 9 wake hypothesis creation unit, 10 wake hypothesis determination unit, 50 radar origin, 51 primary echo target, 52 secondary echo target, 53 tertiary echo target, 54 primary echo, 55 secondary echo, 56 tertiary echo, 61 primary echo track, 62 secondary echo track, 63 tertiary echo track, 64 missing detection, 65 False detection, 66 m-th to n-th echo wake, 101 processor, 102 memory, 103 input device, 104 output device.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
目標追尾装置(1)は、nを1以上の整数とし、観測対象の目標がn次エコーとして観測される距離に存在することを仮定して、レーダ(2)によって観測された目標の情報に、目標の検出抜け及び目標の誤検出が含まれることを前提とし、目標の情報から目標の航跡の候補を作成する複数のn次エコー追尾フィルタ部(3-n)と、目標の情報に目標の検出抜け及び目標の誤検出が含まれることを前提とし、複数のn次エコー追尾フィルタ部(3-n)により作成された航跡の候補の尤もらしさを表す航跡信頼度を計算する航跡信頼度計算部(4)と、航跡信頼度計算部(4)により計算された航跡信頼度に基づいて、複数のn次エコー追尾フィルタ部(3-n)により作成された航跡の候補の中から、表示器(7)に表示させる航跡を決定する航跡決定部(6)とを備える。
Description
レーダ装置等によって検出された航空機等の目標の観測情報から、目標の航跡を推定する目標追尾装置に関するものである。
パルスレーダ装置等は、パルスを送信し、当該パルスが観測対象の目標で反射した反射パルスを受信する。目標追尾装置は、パルスレーダ装置等によりパルスが送信されてから受信されるまでの送受信時間に基づいて、目標までの距離を測定する。パルスの送受信時間が、パルス送信時のパルス繰り返し間隔(PRI、Pulse Repetition Interval)より長くなった場合、パルス送受信時間と目標までの距離とが一意ではなくなり、正しい目標の位置が得られない現象があることが知られている。この現象は、「多次エコー」、「距離アンビギュイティ」、「レンジアンビギュイティ」、または「距離折り返し」と呼ばれている。
従来より、上記多次エコーに対して目標の正しい距離を推定する技術が複数知られている。
非特許文献1に開示されている方法は、複数種類のPRIで目標を観測し、各PRIにおける多次エコーの距離方向の差分から、正しい目標の距離を推定する方法である。この方法は一般に「マルチPRIレンジング」または「マルチPRF(Pulse Repetition Frequency)レンジング」と呼ばれている。
非特許文献2及び特許文献1に開示されている方法は、送信パルスの変調コードを周期的に変更することで、受信パルスの復調において2次エコーを抑圧し、1次エコーのみを抽出する方法である。
以下では、多次エコーのうち、k-n-1番目の時刻フレームで送信されたパルスがk番目の時刻フレームで受信された場合を「n次エコー」と表記する。k及びnは自然数とする。また、n次エコーの「n」を「多次エコーの次数」と表記する。
以下では、多次エコーのうち、k-n-1番目の時刻フレームで送信されたパルスがk番目の時刻フレームで受信された場合を「n次エコー」と表記する。k及びnは自然数とする。また、n次エコーの「n」を「多次エコーの次数」と表記する。
M.Skolnik,「Radar Handbook Third Edition」,(米),McGraw-Hill,2008年2月,p.4.31-4.33
深尾昌一郎、浜津享助著,「気象と大気のレーダーリモートセンシング」,改訂第2版,京都大学学術出版会,2009年3月30日,p.285-287
マルチPRIレンジングは、目標の個数が既知であり、かつ目標以外からの不要な反射パルスの検出が無く、かつ目標からの反射パルスが雑音に埋もれ検出されない場合が無いことを前提とする。すなわち、例えば2次エコーとして受信された反射パルスについて、マルチPRIレンジングでは、PRIを変更したいずれの観測においても当該反射パルスが検出されることを前提とする。なお、以下では、目標以外からの不要な反射パルスの検出を「誤検出」と表記し、目標からの反射パルスが雑音に埋もれ検出されない場合を「検出抜け」と表記する。
また、複数目標からの反射パルスが検出される場合、PRIの種類は「目標の最大個数+1」種類以上なければならない。この前提は、特定の目標を高頻度に観測し、高精度の速度観測を目的とするHigh-PRFレーダまたはMiddle-PRFレーダにおいては妥当な前提である。
よってマルチPRIレンジングでは、広範囲を観測するレーダにおける前提において、すなわち想定を超える個数の目標が同時に観測される場合、または誤検出が起こる場合、または目標の反射断面積が小さく検出抜けが起こる場合に、正しい目標の距離が得られないという課題があった。
また、複数目標からの反射パルスが検出される場合、PRIの種類は「目標の最大個数+1」種類以上なければならない。この前提は、特定の目標を高頻度に観測し、高精度の速度観測を目的とするHigh-PRFレーダまたはMiddle-PRFレーダにおいては妥当な前提である。
よってマルチPRIレンジングでは、広範囲を観測するレーダにおける前提において、すなわち想定を超える個数の目標が同時に観測される場合、または誤検出が起こる場合、または目標の反射断面積が小さく検出抜けが起こる場合に、正しい目標の距離が得られないという課題があった。
また、非特許文献2及び特許文献1に開示されている、送信パルスの変調コードを変えることで2次エコーを除去する方式は、次数が3次以上の多次エコーを除去できないという課題があった。
この課題は、観測対象とする目標の反射断面積がいずれも小さく、PRIの2倍を超えるほど遠方からの反射パルスの強度が十分小さいと見なせる程度のパルス送受信時間である場合においては問題とならない。一方、近距離の小型目標と、遠方の大型目標が同時に観測される条件においては、多次エコーの次数が異なる小型目標と大型目標の正しい位置及び速度は得られない。
この課題は、観測対象とする目標の反射断面積がいずれも小さく、PRIの2倍を超えるほど遠方からの反射パルスの強度が十分小さいと見なせる程度のパルス送受信時間である場合においては問題とならない。一方、近距離の小型目標と、遠方の大型目標が同時に観測される条件においては、多次エコーの次数が異なる小型目標と大型目標の正しい位置及び速度は得られない。
この発明は、上記の問題を解決するためになされたもので、目標個数が未知であり、かつ誤検出が発生し、かつ目標検出の抜けが発生し、かつ異なる次数の多次エコーが同時に発生する場合に、各目標の航跡を推定することを目的とする。
この発明に係る目標追尾装置は、nを1以上の整数とし、観測対象の目標がn次エコーとして観測される距離に存在することを仮定して、センサによって観測された目標の情報に、目標の検出抜け及び目標の誤検出が含まれることを前提とし、目標の情報から目標の航跡の候補を作成する複数のn次エコー追尾フィルタ部と、目標の情報に目標の検出抜け及び目標の誤検出が含まれることを前提とし、複数のn次エコー追尾フィルタ部により作成された航跡の候補の尤もらしさを表す航跡信頼度を計算する航跡信頼度計算部と、航跡信頼度計算部により計算された航跡信頼度に基づいて、複数のn次エコー追尾フィルタ部により作成された航跡の候補の中から、表示器に表示させる航跡を決定する航跡決定部とを備えるものである。
この発明によれば、観測対象の目標がn次エコーとして観測される距離に存在することを仮定して目標の航跡の候補を作成し、航跡の候補の信頼度に基づいて表示器に表示させる航跡を決定するようにしたので、目標個数が未知であり、かつ誤検出が発生し、かつ目標検出の抜けが発生し、かつ異なる次数の多次エコーが同時に発生する場合に、各目標の航跡を推定することができる。
以下、この発明をより詳細に説明するために、この発明を実施するための形態について、添付の図面に従って説明する。
実施の形態1.
図1は、この発明の実施の形態1に係る目標追尾装置1の構成例を示すブロック図である。以下では、この発明の各実施の形態に係る目標追尾装置1を、既存のレーダ装置であるレーダ2に適用した場合について説明する。
実施の形態1.
図1は、この発明の実施の形態1に係る目標追尾装置1の構成例を示すブロック図である。以下では、この発明の各実施の形態に係る目標追尾装置1を、既存のレーダ装置であるレーダ2に適用した場合について説明する。
図2Aは、実施の形態1に係る目標追尾装置1を適用する観測条件を表す概念図であり、図2Bは、目標の観測結果の例を示す概念図である。図において、x軸は、東向きが正の東西方向であり、y軸は、北向きが正の南北方向である。
図2Aのように、レーダ2の観測範囲内に未知の個数の目標が存在し、各目標の位置はレーダ2からは質点として観測されるものとする。また、各目標は、レーダ2の最大観測距離Rmax以内またはRmax以遠に存在し得るものとする。
図2Aのように、レーダ2の観測範囲内に未知の個数の目標が存在し、各目標の位置はレーダ2からは質点として観測されるものとする。また、各目標は、レーダ2の最大観測距離Rmax以内またはRmax以遠に存在し得るものとする。
以下では、レーダ原点50から最大観測距離Rmax未満に存在する目標を1次エコー目標51と表記する。また、最大観測距離Rmax以上2Rmax未満に存在する目標を2次エコー目標52と表記する。また、最大観測距離2Rmax以上3Rmax未満に存在する目標を3次エコー目標53と表記する。
レーダ2が観測ごとに複数種類のPRIに切り替えた場合、各目標の検出プロットは図2Bのように現れる。図2Bは、レーダ2が観測ごとに3種類のPRIを周期的に切り替えた場合の例である。検出プロットは、検出された目標の位置情報であり、図2Bにおいては1次エコー54、2次エコー55及び3次エコー56の各検出プロットが「×」印で示される。最大観測距離RmaxがPRIによって変化するため、多次エコーの次数が大きいほど、多次エコーの検出プロットは距離方向に蛇行するように現れる。
目標追尾装置1は、このような検出プロットをレーダ2から受け取り、各目標の運動諸元を決定して表示器7へ出力する。運動諸元は、目標の位置、速度または加速度等であり、以下では「追尾航跡」と表記する。
図1に示すように、目標追尾装置1は、1次エコー追尾フィルタ部3、航跡信頼度計算部4、n次エコー計算ブロック5、及び航跡決定部6を備えている。n次エコー計算ブロック5は、n個(nは2以上の整数)のn次エコー追尾フィルタ部3-nと、2個の航跡信頼度計算部4とを備えている。例えば、2次エコー目標52と3次エコー目標53を観測する場合、n次エコー計算ブロック5は、1組の2次エコー追尾フィルタ部3-2及び航跡信頼度計算部4と、1組の3次エコー追尾フィルタ部3-3及び航跡信頼度計算部4から構成される。
ただし、1個のn次エコー追尾フィルタ部3-nに対して1個の航跡信頼度計算部4を設ける構成に限定されるものではない。例えば、複数のn次エコー追尾フィルタ部3-nに対して1個の航跡信頼度計算部4を設け、当該1個の航跡信頼度計算部4が、n次エコー追尾フィルタ部3-nの個数分の処理を行う構成にしてもよい。
ただし、1個のn次エコー追尾フィルタ部3-nに対して1個の航跡信頼度計算部4を設ける構成に限定されるものではない。例えば、複数のn次エコー追尾フィルタ部3-nに対して1個の航跡信頼度計算部4を設け、当該1個の航跡信頼度計算部4が、n次エコー追尾フィルタ部3-nの個数分の処理を行う構成にしてもよい。
なお、図1では、nを2以上の整数とし、1次エコー追尾フィルタ部3とn次エコー追尾フィルタ部3-nとを区別しているが、実質的な動作は1次エコー追尾フィルタ部3とn次エコー追尾フィルタ部3-nとで大きな違いはない。そのため、nを1以上の整数とし、n=1のときのn次エコー追尾フィルタ部3-nを、1次エコー追尾フィルタ部3の代わりとしてもよい。
図3は、目標追尾装置1のハードウェア構成例を示す図である。目標追尾装置1における1次エコー追尾フィルタ部3、航跡信頼度計算部4、n次エコー計算ブロック5及び航跡決定部6は、メモリ102に格納されているプログラムを実行するプロセッサ101である。1次エコー追尾フィルタ部3、航跡信頼度計算部4、n次エコー計算ブロック5及び航跡決定部6の各機能は、ソフトウェア、ファームウェア、またはソフトウェアとファームウェアとの組み合わせにより実現される。ソフトウェアまたはファームウェアはプログラムとして記述され、メモリ102に格納される。プロセッサ101は、メモリ102に格納されたプログラムを読み出して実行することにより、各部の機能を実現する。すなわち、目標追尾装置1は、プロセッサ101により実行されるときに後述する図5及び図6に示される各ステップが結果的に実行されることになるプログラムを格納するためのメモリ102を備える。また、このプログラムは、目標追尾装置1の各部の手順または方法をコンピュータに実行させるものであるともいえる。
プロセッサ101は、CPU(Central Processing Unit)、またはGPU(Graphics Processing Unit)等である。メモリ102は、HDD(Hard Disk Drive)、SSD(Solid State Drive)、DRAM(Dynamic Random Access Memory)、またはフラッシュメモリ等である。
また、目標追尾装置1は、レーダ2が出力する検出プロットを1次エコー追尾フィルタ部3及びn次エコー計算ブロック5へ入力する入力装置103を備える。この入力装置103は、USB(Universal Serial Bus)、またはイーサネット(登録商標)等のインタフェースを利用して、レーダ2に接続する。
また、目標追尾装置1は、航跡決定部6が決定した各目標の運動諸元を、表示器7へ出力する出力装置104を備える。この出力装置104は、DVI(Digital Visual Interface、登録商標)、またはHDMI(High-Definition Multimedia Interface、登録商標)等のインタフェースを利用して、表示器7に接続する。
また、目標追尾装置1は、航跡決定部6が決定した各目標の運動諸元を、表示器7へ出力する出力装置104を備える。この出力装置104は、DVI(Digital Visual Interface、登録商標)、またはHDMI(High-Definition Multimedia Interface、登録商標)等のインタフェースを利用して、表示器7に接続する。
レーダ2は、図示しないパルス送信装置、送受切替機、アンテナ、受信機、及び信号検出機等の既存の装置を備え、目標位置を観測する。そして、レーダ2は、1次エコー追尾フィルタ部3及びn次エコー追尾フィルタ部3-nに対して、最新の時刻フレームにおいて検出された目標の位置情報、つまり検出プロットを出力する。なお、検出プロットには、目標以外からの反射パルスに基づいた誤検出が含まれている場合がある。また、各時刻フレームの検出プロットには、観測時のPRI情報も含まれているものとする。
なお、レーダ2の観測領域は任意であり、目標までの距離及び方位角を観測する2次元レーダでもよいし、さらに仰角方向も観測可能な3次元レーダでもよい。
なお、レーダ2の観測領域は任意であり、目標までの距離及び方位角を観測する2次元レーダでもよいし、さらに仰角方向も観測可能な3次元レーダでもよい。
1次エコー追尾フィルタ部3は、レーダ2から検出プロットを受け取り、各検出プロットがすべて1次エコー目標を観測した結果であると仮定して、1次エコー目標の追尾航跡の候補を複数作成する。ここで、1次エコー目標の追尾航跡とは、各時刻フレームにおける1次エコー目標の位置または速度等の推定値系列、ならびに推定値の誤差を表す値を含む。1次エコー追尾フィルタ部3は、作成した追尾航跡の候補を、航跡信頼度計算部4に出力する。なお、以下では、1次エコー追尾フィルタ部3で作成された追尾航跡を「1次エコー航跡」と表記する。
n次エコー追尾フィルタ部3-nは、レーダ2から検出プロットを受け取り、各検出プロットがすべてn次エコー目標を観測した結果であると仮定して、n次エコー目標の追尾航跡の候補を複数作成する。n次エコー追尾フィルタ部3-nは、作成した追尾航跡の候補を、n次エコー計算ブロック5内で対になっている航跡信頼度計算部4に出力する。なお、以下では、n次エコー追尾フィルタ部3-nで作成された追尾航跡を「n次エコー航跡」と表記する。
1次エコー追尾フィルタ部3と対になっている航跡信頼度計算部4は、1次エコー追尾フィルタ部3から1次エコー航跡を受け取り、この1次エコー航跡の尤もらしさを表す値である航跡信頼度を計算する。そして、1次エコー追尾フィルタ部3は、1次エコー航跡と航跡信頼度を、航跡決定部6に出力する。
同様に、n次エコー計算ブロック5内でn次エコー追尾フィルタ部3-nと対になっている航跡信頼度計算部4は、そのn次エコー追尾フィルタ部3-nからn次エコー航跡を受け取り、このn次エコー航跡の尤もらしさを表す航跡信頼度を計算する。そして、航跡信頼度計算部4は、n次エコー航跡と航跡信頼度を、航跡決定部6に出力する。
同様に、n次エコー計算ブロック5内でn次エコー追尾フィルタ部3-nと対になっている航跡信頼度計算部4は、そのn次エコー追尾フィルタ部3-nからn次エコー航跡を受け取り、このn次エコー航跡の尤もらしさを表す航跡信頼度を計算する。そして、航跡信頼度計算部4は、n次エコー航跡と航跡信頼度を、航跡決定部6に出力する。
航跡信頼度は、追尾航跡が1次エコー追尾フィルタ部3及びn次エコー追尾フィルタ部3-nで前提とする運動モデルに近いほど大きな値となる。例えば、等速直進運動モデルを前提とする場合、直線状に並んだ検出プロットによって作成された追尾航跡ほど航跡信頼度は大きくなる。
航跡決定部6は、1次エコー追尾フィルタ部3と対になった航跡信頼度計算部4から1次エコー航跡とその航跡信頼度を受け取り、n次エコー追尾フィルタ部3-nと対になった航跡信頼度計算部4からn次エコー航跡とその航跡信頼度を受け取り、航跡信頼度が最大の追尾航跡を選択する。そして、航跡決定部6は、航跡信頼度が最大の追尾航跡を「表示航跡」として表示器7に出力する。
表示器7は、航跡決定部6から表示航跡を受け取り、この表示航跡に含まれる目標の位置もしくは速度等の推定値系列、推定値の誤差を表す値、または航跡信頼度等を表示する。
図4A、図4B及び図4Cは、実施の形態1に係る目標追尾装置1により作成された1次エコー航跡、2次エコー航跡及び3次エコー航跡の例を示す概念図である。この例では、次数が2の多次エコーに対して、レーダ2が3種類のPRI(PRI1、PRI2、PRI3)を周期的に切り替えながら観測した検出プロットが、目標追尾装置1に入力されたものとする。また、1次エコー追尾フィルタ部3及びn次エコー追尾フィルタ部3-nは、等速直進運動モデルに基づいた追尾航跡を作成したものとする。
図4Aでは、1次エコー追尾フィルタ部3が出力する1次エコー航跡61の例を示す。
1次エコー追尾フィルタ部3は、「各検出プロットは最大観測距離Rmax未満の目標を観測した結果である」という仮定のもとで追尾航跡の候補を作成する。1次エコー追尾フィルタ部3は、検出抜け64または誤検出65がある確率で起こることを前提に追尾航跡を作成する。具体的には、1次エコー追尾フィルタ部3は、検出プロットが抜けている場合、例えば、その手前までの追尾航跡を推定速度で延長することで、検出抜け64を補間した1次エコー航跡61を作成する。また、例えば、1次エコー追尾フィルタ部3は、追尾航跡から離れた検出プロットを無視することで、誤検出65を含まない1次エコー航跡61を作成する。
1次エコー追尾フィルタ部3は、「各検出プロットは最大観測距離Rmax未満の目標を観測した結果である」という仮定のもとで追尾航跡の候補を作成する。1次エコー追尾フィルタ部3は、検出抜け64または誤検出65がある確率で起こることを前提に追尾航跡を作成する。具体的には、1次エコー追尾フィルタ部3は、検出プロットが抜けている場合、例えば、その手前までの追尾航跡を推定速度で延長することで、検出抜け64を補間した1次エコー航跡61を作成する。また、例えば、1次エコー追尾フィルタ部3は、追尾航跡から離れた検出プロットを無視することで、誤検出65を含まない1次エコー航跡61を作成する。
図4Bでは、2次エコー追尾フィルタ部3-2が出力する2次エコー航跡62の例を示す。2次エコー追尾フィルタ部3-2は、n=2のn次エコー追尾フィルタ部3-nである。
2次エコー追尾フィルタ部3-2は、「各検出プロットは最大観測距離Rmax以上2Rmax未満の目標を観測した結果である」と仮定し、各検出プロットをレーダ原点50の距離方向にPRIに依存する距離だけ移動した上で、追尾航跡の候補を作成する。このとき、2次エコー追尾フィルタ部3-2は、1次エコー追尾フィルタ部3と同様に、検出抜け64または誤検出65がある確率で起こることを前提に追尾航跡を作成する。
2次エコー追尾フィルタ部3-2は、「各検出プロットは最大観測距離Rmax以上2Rmax未満の目標を観測した結果である」と仮定し、各検出プロットをレーダ原点50の距離方向にPRIに依存する距離だけ移動した上で、追尾航跡の候補を作成する。このとき、2次エコー追尾フィルタ部3-2は、1次エコー追尾フィルタ部3と同様に、検出抜け64または誤検出65がある確率で起こることを前提に追尾航跡を作成する。
図4Cでは、3次エコー追尾フィルタ部3-3が出力する3次エコー航跡63の例を示す。3次エコー追尾フィルタ部3-3は、n=3のn次エコー追尾フィルタ部3-nである。
3次エコー追尾フィルタ部3-3は、「各検出プロットは最大観測距離2Rmax以上3Rmax未満の目標を観測した結果である」と仮定し、各検出プロットをレーダ原点50の距離方向にPRIに依存する距離だけ移動した上で、追尾航跡の候補を作成する。このとき、3次エコー追尾フィルタ部3-3は、1次エコー追尾フィルタ部3と同様に、検出抜け64または誤検出65がある確率で起こることを前提に追尾航跡を作成する。
3次エコー追尾フィルタ部3-3は、「各検出プロットは最大観測距離2Rmax以上3Rmax未満の目標を観測した結果である」と仮定し、各検出プロットをレーダ原点50の距離方向にPRIに依存する距離だけ移動した上で、追尾航跡の候補を作成する。このとき、3次エコー追尾フィルタ部3-3は、1次エコー追尾フィルタ部3と同様に、検出抜け64または誤検出65がある確率で起こることを前提に追尾航跡を作成する。
図4A~図4Cで示した1次エコー航跡61、2次エコー航跡62及び3次エコー航跡63のうち、運動モデルである等速直進運動モデルに近い追尾航跡は2次エコー航跡62である。したがって、この例では、2次エコー追尾フィルタ部3-2と対になっている航跡信頼度計算部4が計算する2次エコー航跡62の航跡信頼度が、他の航跡信頼度計算部4が計算する航跡信頼度よりも高くなり、航跡決定部6は、2次エコー航跡62を表示航跡として決定して表示器7に出力する。
次に、図5及び図6のフローチャートを用いて、本実施の形態に係る目標追尾装置1の動作の詳細を説明する。
まず始めに、時刻kにおける1次エコー追尾フィルタ部3、n次エコー追尾フィルタ部3-n及び航跡信頼度計算部4の動作を、図5のフローチャートに沿って説明する。
なお、以下では、nは自然数とし、1次エコー追尾フィルタ部3の動作を、n次エコー追尾フィルタ部3-nにおいてn=1の場合における動作として、まとめて説明する。
まず始めに、時刻kにおける1次エコー追尾フィルタ部3、n次エコー追尾フィルタ部3-n及び航跡信頼度計算部4の動作を、図5のフローチャートに沿って説明する。
なお、以下では、nは自然数とし、1次エコー追尾フィルタ部3の動作を、n次エコー追尾フィルタ部3-nにおいてn=1の場合における動作として、まとめて説明する。
動作について説明する前に、処理に用いる各記号について定義する。
目標の推定値を表す追尾航跡は、運動諸元を表す「状態ベクトル」と、推定のあいまいさを表す「誤差共分散行列」から成るものとする。
以降の説明では、時刻kにおける状態ベクトルxk|kと誤差共分散行列Pk|kは、式(2)と式(3)で定義される。なお、時刻kは「観測開始からk回目の観測時刻フレーム(kは自然数)」と定義される。目標追尾装置1は、観測時刻フレームごとに、図5及び図6のフローチャートに示される処理を繰り返し実行する。
目標の推定値を表す追尾航跡は、運動諸元を表す「状態ベクトル」と、推定のあいまいさを表す「誤差共分散行列」から成るものとする。
以降の説明では、時刻kにおける状態ベクトルxk|kと誤差共分散行列Pk|kは、式(2)と式(3)で定義される。なお、時刻kは「観測開始からk回目の観測時刻フレーム(kは自然数)」と定義される。目標追尾装置1は、観測時刻フレームごとに、図5及び図6のフローチャートに示される処理を繰り返し実行する。
ここで、式(2)の括弧右肩のTは行列の転置を表す。x及びvxはx軸の位置と速度を表す。y及びvyはy軸の位置と速度を表す。z及びvzはz軸の位置と速度を表す。x軸は、図2Aに示したように東向き正の東西方向に設定されている。y軸は、図2Aに示したように北向き正の南北方向に設定されている。z軸は、上向きが正の高度方向に設定されているものとする。
また、式(3)のPij(i、j=1~6)は、xk|kのi行目成分とj列目成分の誤差共分散を表す。
なお、複数の追尾航跡を表記する場合は、xk|k (1)、xk|k (2)、・・・、及びPk|k (1)、Pk|k (2)、・・・と表記する。
また、レーダ2から時刻kに得られた検出プロットは、「検出プロットzk」と表記し、式(4)で定義される。
ここで、zk,x、zk,y、zk,zはそれぞれ検出プロットのx軸、y軸、z軸の位置を表す。なお、時刻kに複数の検出プロットが得られた場合は、zk
(1)、zk
(2)、・・・と表記する。
また、状態ベクトルxk|kと誤差共分散行列Pk|kが「時刻kまでの検出プロットを基に推定した時刻kにおける追尾航跡」を表す一方で、「時刻k-1までの検出プロットを基に推定した時刻kにおける追尾航跡」を「予測航跡」として状態ベクトルxk|k-1と誤差共分散行列Pk|k-1で表す。各行列の要素は式(2)及び式(3)と同じとする。
また、追尾航跡の航跡信頼度をbk|k、予測航跡の航跡信頼度をbk|k-1と表記する。
また、状態ベクトルxk|kと誤差共分散行列Pk|kが「時刻kまでの検出プロットを基に推定した時刻kにおける追尾航跡」を表す一方で、「時刻k-1までの検出プロットを基に推定した時刻kにおける追尾航跡」を「予測航跡」として状態ベクトルxk|k-1と誤差共分散行列Pk|k-1で表す。各行列の要素は式(2)及び式(3)と同じとする。
また、追尾航跡の航跡信頼度をbk|k、予測航跡の航跡信頼度をbk|k-1と表記する。
ステップST1-1において、nを1以上の整数とした場合における1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nのそれぞれは、n次エコー変換を行う。n次エコー追尾フィルタ部3-nは、レーダ2から入力された検出プロットがn次エコー目標の観測結果であると仮定し、検出プロットの位置をレーダ原点50から距離方向に一定距離移動させる。
例えば、PRIがTPRIのときに観測された検出プロットzkを変換する場合、移動させる距離ΔRは、式(5)より求まる。
以降のステップST1-2~ST1-7における検出プロットは、いずれも上記変換後の検出プロットとする。
ステップST1-2において、1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nのそれぞれは、初期航跡追加を行う。n次エコー追尾フィルタ部3-nは、過去の検出プロットを基に、時刻k-1における新しい追尾航跡の候補を作成する。図5のフローチャートに示される処理の繰り返しにあわせて予測と更新が繰り返される追尾航跡の初期値を設定することから、ここで作成する航跡を「初期航跡」と表記する。
例えば、時刻k-1における初期航跡の状態ベクトルxk-1|k-1,Newと誤差共分散行列Pk-1|k-1,Newは、時刻k-1の検出プロットzk-1と時刻k-2の検出プロットzk-2を基に、式(8)と式(9)より設定される。
また、後述するステップST1-6で計算される航跡信頼度の初期値である、初期航跡の航跡信頼度bk-1|k-1,Newは、式(10)より設定される。
n次エコー追尾フィルタ部3-nは、過去の検出プロットが複数ある場合、検出プロットの全組み合わせについて上記の初期航跡を作成する。または、目標の速度条件が設定できる場合は、その速度で移動可能な一定距離以内のzk-1とzk-2のみから初期航跡を設定してもよい。
また、初期航跡の作成において基とする検出プロットは、時刻k-1と時刻k-2の検出プロットの組み合わせ以外でもよく、例えば過去3フレーム前の検出プロットの組み合わせから作成する方法、または過去1フレーム前の検出プロットのみから作成する方法でもよい。
また、初期航跡の作成において基とする検出プロットは、時刻k-1と時刻k-2の検出プロットの組み合わせ以外でもよく、例えば過去3フレーム前の検出プロットの組み合わせから作成する方法、または過去1フレーム前の検出プロットのみから作成する方法でもよい。
ステップST1-3において、1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nのそれぞれは、航跡予測を行う。n次エコー追尾フィルタ部3-nは、ステップST1-2で作成した初期航跡と、前の時刻k-1においてn次エコー追尾フィルタ部3-nが出力した追尾航跡について、時刻kでの予測航跡を求める。
なお、n次エコー追尾フィルタ部3-nは、図5のフローチャートに示された処理を繰り返す中で、1回目のステップST1-3の実行時は初期航跡から予測航跡を作成し、2回目以降のステップST1-3の実行時は直前のST1-2で作成した初期航跡と前の時刻k-1における追尾航跡から予測航跡を作成する。
前の時刻k-1における追尾航跡とは、前回の繰り返しにおけるステップST1-5の後にn次エコー追尾フィルタ部3-nから航跡信頼度計算部4へ出力される追尾航跡のことである。
なお、n次エコー追尾フィルタ部3-nは、図5のフローチャートに示された処理を繰り返す中で、1回目のステップST1-3の実行時は初期航跡から予測航跡を作成し、2回目以降のステップST1-3の実行時は直前のST1-2で作成した初期航跡と前の時刻k-1における追尾航跡から予測航跡を作成する。
前の時刻k-1における追尾航跡とは、前回の繰り返しにおけるステップST1-5の後にn次エコー追尾フィルタ部3-nから航跡信頼度計算部4へ出力される追尾航跡のことである。
n次エコー追尾フィルタ部3-nは、時刻k-1の追尾航跡の状態ベクトルxk-1|k-1と誤差共分散行列Pk-1|k-1について、あるいは初期航跡ならばxk-1|k-1,NewとPk-1|k-1,Newについて、式(11)及び式(12)により予測航跡の状態ベクトルxk|k-1と誤差共分散行列Pk|k-1を求める。
ここで、Φは目標の運動モデルを表す6×6行列のパラメータである。例えば、目標の運動として等速直進運動を仮定する場合、Φは式(13)として表される。また、Qは運動モデルからの誤差を表す6×6行列のパラメータである。例えば等速直進運動モデルの速度成分に標準偏差qのあいまいさがあることを仮定する場合、Qは式(14)として表される。
また、時刻k-1の追尾航跡の航跡信頼度bk-1|k-1に対し、あるいは初期航跡ならばbk-1|k-1,Newに対し、時刻kの予測航跡の航跡信頼度bk|k-1は式(15)とする。
ステップST1-4において、1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nのそれぞれは、航跡相関を求める。n次エコー追尾フィルタ部3-nは、時刻kの予測航跡の近傍にある時刻kの検出プロットを抽出し、次のステップST1-5において予測航跡を更新する際に用いる検出プロットを絞り込む。
n次エコー追尾フィルタ部3-nは、ある予測航跡の状態ベクトルxk|k-1、及び誤差共分散行列Pk|k-1に対して、「近傍にある」との条件を満たす検出プロットを抽出する。「近傍」の定義として、例えば位置の残差を誤差で規格化した距離(マハラノビス距離)で定義する場合、n次エコー追尾フィルタ部3-nは、以下の条件式(16)を満たす検出プロットzkを「相関ゲート内の検出プロット」として抽出する。
ステップST1-5において、1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nのそれぞれは、航跡更新を行う。n次エコー追尾フィルタ部3-nは、予測航跡とその相関ゲート内の検出プロットから、時刻kにおける追尾航跡を作成する。また、n次エコー追尾フィルタ部3-nは、予測航跡が時刻kでは検出プロットとして観測されなかった場合を表す航跡も、時刻kにおける追尾航跡として作成する。
n次エコー追尾フィルタ部3-nは、ある予測航跡の状態ベクトルxk|k-1及び誤差共分散行列Pk|k-1に対して、相関ゲート内の検出プロットzkを用いて更新する場合、以下の式(18)及び式(19)から追尾航跡の状態ベクトルxk|k及び誤差共分散行列Pk|kを求める。
n次エコー追尾フィルタ部3-nは、上記の処理を相関ゲート内にあるすべての検出プロットに対して行う。よって、相関ゲート内にm個の検出プロットが得られていた場合、m個の追尾航跡の候補xk|k
(1)、・・・、xk|k
(m)が作成される。
さらに、n次エコー追尾フィルタ部3-nは、予測航跡が時刻kでは検出プロットとして観測されなかった場合を表す追尾航跡の候補として、以下の式(21)及び式(22)による追尾航跡も作成する。
上記ステップST1-5において作成されたm+1個の追尾航跡うち、真の追尾航跡は高々1個である。しかし、以降のステップST1-6で各追尾航跡の尤もらしさを評価し、ステップST1-7で誤った追尾航跡を減らし、その後、航跡決定部6にて最終的な表示用の追尾航跡を決定するため、この時点ではいずれの航跡が正しいかの絞り込みは行わない。
ステップST1-6において、1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nと対になった航跡信頼度計算部4のそれぞれは、航跡信頼度計算を行う。航跡信頼度計算部4は、予測航跡とその相関ゲート内にある検出プロットから、ステップST1-5で作成された追尾航跡の尤もらしさを表す値を、「航跡信頼度」として計算する。
ある予測航跡の状態ベクトルxk|k-1及び誤差共分散行列Pk|k-1に対して、相関ゲート内の検出プロットzkを用いて更新した結果、時刻kの追尾航跡のxk|k及びPk|kが求まったとする。このとき、時刻kの追尾航跡の航跡信頼度bk|kを、予測航跡と検出プロットとの残差が小さいほど、予測航跡の航跡信頼度bk|k-1から大きく増加するような値として定義する。尤もらしさを表す値は様々な定義が存在するが、以下では例として「Applications of MHT to Dim Moving Targets」(G.C.Demos,R.A.Ribas,T.J.Broida,S.S.Blackman,Proceedings of SPIE,Signal and Data Processing of Small Targets 1990,1990年10月,vol.1305,p.297-309)に記載されている航跡信頼度について説明する。
信頼度を「予測航跡xk|k-1が検出プロットzkとして得られる確率(検出プロットzkに対する予測航跡xk|k-1の尤度)」と「検出プロットzkが誤検出である確率」の比の対数として定義した場合、航跡信頼度bk|kは、以下の式(23)によって求められる。
なお、予測航跡が時刻kでは検出プロットとして観測されなかった場合の追尾航跡の信頼度、つまりステップST1-5において式(21)及び式(22)によって更新された航跡の信頼度は、以下の式(25)によって求められるものとする。
ステップST1-7において、1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nと対になった航跡信頼度計算部4のそれぞれは、航跡削除を行う。航跡信頼度計算部4は、ステップST1-6において作成された時刻kの追尾航跡のうち、誤検出のみによって作成及び更新された航跡を削除するために、航跡信頼度が低い追尾航跡を削除する。
航跡信頼度計算部4は、以下の式(26)を満たす追尾航跡は削除し、航跡決定部6へ出力せず、かつ、次時刻k+1でのステップST1-3で用いない。
航跡信頼度計算部4は、ここで削除されなかった複数の追尾航跡を「時刻kにおけるn次エコー航跡」として航跡決定部6へ出力する。
上記のステップST1-1~ST1-7によって、1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nと、対になる航跡信頼度計算部4とが動作する。ここで、nは1以上の整数とし、nの最大値は観測し得る多次エコーの最大の次数として予め設定されているものとする。例えば、3次エコー目標が検出され得る観測条件ではn=1,2,3と設定され、1次エコー追尾フィルタ部3に加え、2次エコー追尾フィルタ部3-2及び3次エコー追尾フィルタ部3-3が並行して上記のステップST1-1~ST1-7をそれぞれ実行する。
なお、上記では目標の運動モデルとして等速直進運動モデルを用いた場合について説明したが、他の運動モデル、例えば目標の加速度まで推定する等加速度運動モデル、または目標の旋回軌道を推定する等速円運動モデル等を用いてもよい。また、上記では目標の観測モデルとして目標の観測結果が北基準直交座標系の位置として得られる場合について説明したが、他の観測モデル、例えば目標の位置を極座標系(距離、仰角、方位角)で表す場合の観測モデルを用いてもよい。
続いて、図6のフローチャートに沿って、時刻kにおける航跡決定部6の動作を説明する。航跡決定部6は、1次エコー追尾フィルタ部3を含むn次エコー追尾フィルタ部3-nと対になった航跡信頼度計算部4のそれぞれから、時刻kにおけるn次エコー航跡とその航跡信頼度とを受け取り、図6のフローチャートに示される処理を行う。
始めにステップST1-8において、航跡決定部6は、暫定的な最大信頼度を極小値、つまりプログラム上の最小の負値に設定する。
ステップST1-9において、航跡決定部6は、受け取ったn次エコー航跡の中から、時刻kでの処理内における未選択の追尾航跡を1つ選択する。
ステップST1-9において、航跡決定部6は、受け取ったn次エコー航跡の中から、時刻kでの処理内における未選択の追尾航跡を1つ選択する。
ステップST1-10において、航跡決定部6は、選択された追尾航跡の航跡信頼度と暫定的な最大信頼度とを比較する。航跡決定部6は、選択された追尾航跡の航跡信頼度が暫定的な最大信頼度より大きかった場合(ステップST1-10“YES”)、ステップST1-11へ移行する。一方、航跡決定部6は、選択された追尾航跡の航跡信頼度が暫定的な最大信頼度以下であった場合(ステップST1-10“NO”)、ステップST1-11をスキップしてステップST1-12へ移行する。
ステップST1-11において、航跡決定部6は、選択された追尾航跡の航跡信頼度で暫定的な最大信頼度を上書きする。
ステップST1-12において、航跡決定部6は、受け取ったn次エコー航跡の中からすべての追尾航跡が選択されたか否かを判定する。航跡決定部6は、すべての追尾航跡が選択された場合(ステップST1-12“YES”)、ステップST1-13へ移行する。一方、航跡決定部6は、未選択の追尾航跡が残っている場合(ステップST1-12“NO”)、ステップST1-9へ戻る。
ステップST1-12において、航跡決定部6は、受け取ったn次エコー航跡の中からすべての追尾航跡が選択されたか否かを判定する。航跡決定部6は、すべての追尾航跡が選択された場合(ステップST1-12“YES”)、ステップST1-13へ移行する。一方、航跡決定部6は、未選択の追尾航跡が残っている場合(ステップST1-12“NO”)、ステップST1-9へ戻る。
ステップST1-13において、航跡決定部6は、最大信頼度を持つ追尾航跡を「表示航跡」として表示器7に出力する。
以上のステップST1-8~ST1-13によって、表示器7に表示航跡が出力される。
以上のステップST1-8~ST1-13によって、表示器7に表示航跡が出力される。
表示器7は、航跡決定部6から受け取った表示航跡をディスプレイ等に表示する。このとき表示する情報は、表示航跡の状態ベクトルに含まれる位置及び速度、表示航跡の誤差共分散行列から求めた誤差の大きさを表す楕円、多次エコー次数、または表示航跡の航跡信頼度等である。なお、表示器7は、予め設定された条件、または使用者からの入力により、表示する情報を変更可能である。
以上のように構成された実施の形態1によれば、1次エコー追尾フィルタ部3及びn次エコー追尾フィルタ部3-nによって多次エコーの次数を仮定した追尾航跡の候補を生成し、航跡信頼度計算部4にて各追尾航跡の尤もらしさを評価し、航跡決定部6で最終的な多次エコーの次数を決定するようにしたので、遠方の目標、特にレーダ2の最大観測距離Rmax以遠に存在する目標の検出プロットから、目標の航跡を推定することができる。これにより、レーダ2における送信機、アンテナ及び受信機等の構成を変えることなく、追尾航跡が得られる目標の最大距離を延伸することができる点で画期的である。また、n次エコー追尾フィルタ部3-n及び航跡信頼度計算部4の任意数の対によって構成されたn次エコー計算ブロック5によって、任意の次数の多次エコー目標に対して追尾航跡を得ることができるため、レーダ2で目標が観測されている限り、追尾航跡が得られる目標の距離に原理的な上限がない点で画期的である。
また、実施の形態1によれば、従来技術であるマルチRPFレンジングと異なり、目標が小型であるために起こる検出抜け、及び目標以外からの反射パルスによる誤検出が発生する場合でも、最大観測距離Rmax以遠の目標の航跡を推定できる。これは、1次エコー追尾フィルタ部3及びn次エコー追尾フィルタ部3-nにおいて、検出抜け及び誤検出がある確率で発生することを前提として、式(21)及び式(22)を用いて検出プロットの時系列から追尾航跡を作成したり、ステップST1-4で検出プロットを絞り込んだりしているためである。また、航跡信頼度計算部4において、検出抜け及び誤検出がある確率で発生することを前提として、式(10)、式(23)及び式(25)における検出確率pdと誤検出確率βFTのようなパラメータを用いて各追尾航跡の信頼度を計算しているためである。
また、実施の形態1によれば、従来技術である送信パルスを位相変調する方法と異なり、多次エコーの次数が3以上の場合においても目標の航跡を推定することができる。
さらに、実施の形態1によれば、次数の大きな多次エコー目標ほど位置の推定に多種類のPRIによる検出プロットを必要とするマルチPRIレンジングと異なり、PRI1、PRI2、・・・、PRIN(Nは2以上の整数)のうち、最低2種類のPRIによる検出プロットの時系列から、任意の次数の多次エコー目標に対して航跡を推定することができる。
さらに、実施の形態1によれば、次数の大きな多次エコー目標ほど位置の推定に多種類のPRIによる検出プロットを必要とするマルチPRIレンジングと異なり、PRI1、PRI2、・・・、PRIN(Nは2以上の整数)のうち、最低2種類のPRIによる検出プロットの時系列から、任意の次数の多次エコー目標に対して航跡を推定することができる。
したがって、実施の形態1に係る目標追尾装置1は、目標個数が未知であり、かつ誤検出が発生し、かつ目標検出の抜けが発生し、かつ異なる次数の多次エコーが同時に発生する場合に、各目標の航跡を推定することができる。
実施の形態2.
図7は、この発明の実施の形態2に係る目標追尾装置1の構成例を示すブロック図である。上記実施の形態1では、多次エコーの次数が観測中において変わらないことを前提とする構成であったが、実際は、図8にm次~n次エコー航跡66として示すように、最大観測距離Rmaxのm倍(mは1以上の整数)の境界を跨ぐように移動する目標が存在し、n次エコー目標(nは1以上の整数、m<nとする)が観測の途中にm次エコー目標になる場合が起こり得る。
したがって実施の形態2では、多次エコーの次数がnとmの間で変わる多次エコー目標の航跡(以下、m次~n次エコー航跡)も推定する構成とする。nの最大値は観測し得る多次エコーの最大の次数である。また、図8では跨ぐ境界が1つである場合について示したが、これに限定されるものではなく、複数の境界を跨ぐ場合もある。
図7は、この発明の実施の形態2に係る目標追尾装置1の構成例を示すブロック図である。上記実施の形態1では、多次エコーの次数が観測中において変わらないことを前提とする構成であったが、実際は、図8にm次~n次エコー航跡66として示すように、最大観測距離Rmaxのm倍(mは1以上の整数)の境界を跨ぐように移動する目標が存在し、n次エコー目標(nは1以上の整数、m<nとする)が観測の途中にm次エコー目標になる場合が起こり得る。
したがって実施の形態2では、多次エコーの次数がnとmの間で変わる多次エコー目標の航跡(以下、m次~n次エコー航跡)も推定する構成とする。nの最大値は観測し得る多次エコーの最大の次数である。また、図8では跨ぐ境界が1つである場合について示したが、これに限定されるものではなく、複数の境界を跨ぐ場合もある。
図7に示すように、実施の形態2に係る目標追尾装置1は、m次エコー追尾フィルタ部3-mと、n次エコー追尾フィルタ部3-nと、m次~n次エコー追尾フィルタ部8と、複数の航跡信頼度計算部4と、航跡決定部6とを備えている。
なお、上述したようにm及びnは1以上の整数、かつm<nとする。m次エコー追尾フィルタ部3-mは、m=1の場合は実施の形態1の1次エコー追尾フィルタ部3と同じであり、m≧2の場合は実施の形態1のn次エコー追尾フィルタ部3-nと同じである。
つまり、図7に示されたm次エコー追尾フィルタ部3-m、n次エコー追尾フィルタ部3-n、航跡信頼度計算部4及び航跡決定部6の実装方法及び動作は、実施の形態1と同様であるため説明を省略する。
なお、上述したようにm及びnは1以上の整数、かつm<nとする。m次エコー追尾フィルタ部3-mは、m=1の場合は実施の形態1の1次エコー追尾フィルタ部3と同じであり、m≧2の場合は実施の形態1のn次エコー追尾フィルタ部3-nと同じである。
つまり、図7に示されたm次エコー追尾フィルタ部3-m、n次エコー追尾フィルタ部3-n、航跡信頼度計算部4及び航跡決定部6の実装方法及び動作は、実施の形態1と同様であるため説明を省略する。
m次~n次エコー追尾フィルタ部8は、多次エコー追尾フィルタ部である。
このm次~n次エコー追尾フィルタ部8は、図3のメモリ102に格納されたプログラムを実行するプロセッサ101である。プロセッサ101がメモリ102に格納されているプログラムを実行することにより、m次~n次エコー追尾フィルタ部8の機能が実現される。
このm次~n次エコー追尾フィルタ部8は、図3のメモリ102に格納されたプログラムを実行するプロセッサ101である。プロセッサ101がメモリ102に格納されているプログラムを実行することにより、m次~n次エコー追尾フィルタ部8の機能が実現される。
m次~n次エコー追尾フィルタ部8は、最新時刻フレームにおける検出プロットをレーダ2から受け取る。また、m次~n次エコー追尾フィルタ部8は、過去の時刻フレームにおけるm次エコー航跡をm次エコー追尾フィルタ部3-mから受け取ると共に、過去の時刻フレームにおけるn次エコー航跡をn次エコー追尾フィルタ部3-nから受け取る。そして、m次~n次エコー追尾フィルタ部8は、観測中に多次エコーの次数がnとmの間で変わる多次エコー目標の追尾航跡を作成し、対になった航跡信頼度計算部4に出力する。
m次~n次エコー追尾フィルタ部8と対になった航跡信頼度計算部4は、m次~n次エコー追尾フィルタ部8からm次~n次エコー航跡を受け取り、このm次~n次エコー航跡の尤もらしさを表す値である航跡信頼度を計算する。そして、航跡信頼度計算部4は、m次~n次エコー航跡と航跡信頼度を、航跡決定部6に出力する。
次に、時刻kにおけるm次~n次エコー追尾フィルタ部8及び航跡信頼度計算部4の動作を、図9のフローチャートに沿って説明する。
なお、以下で用いる記号は、実施の形態1で定義したものと同じとする。
なお、以下で用いる記号は、実施の形態1で定義したものと同じとする。
ステップST2-1において、m次~n次エコー追尾フィルタ部8は、m次~n次エコー変換を行う。m次~n次エコー追尾フィルタ部8は、レーダ2から入力された検出プロットがm次またはn次エコー目標の観測結果であると仮定し、検出プロットの位置をレーダ原点50から距離方向に一定距離移動させる。
例えば、PRIがTPRIのときに観測された検出プロットzkを変換する場合、m次エコー目標の観測結果であると仮定した場合の移動させる距離ΔRmは、式(27)より求まる。また、n次エコー目標の観測結果であると仮定した場合の移動させる距離ΔRnは、式(28)より求まる。
このとき、m次エコー目標の検出プロットとして変換したm次エコー検出プロットzk,m’は、式(29)のとおりになる。また、n次エコー目標の検出プロットとして変換したn次エコー検出プロットzk,n’は、式(30)のとおりになる。
式(29)及び式(30)のzk,R、zk,By、zk,Elは、極座標系における検出プロットであり、上述の式(7)で定義される。
以降のステップST2-2~ST2-7では、上記のm次エコー検出プロットとn次エコー検出プロットを区別することなく「時刻kの検出プロットzk」として扱う。
ステップST2-2において、m次~n次エコー追尾フィルタ部8は、初期航跡追加を行う。m次~n次エコー追尾フィルタ部8は、過去の検出プロットを基に、時刻k-1における新しい追尾航跡の候補、つまり初期航跡を作成する。過去の検出プロットはm次エコー検出プロットとn次エコー検出プロットがあるが、ステップST2-1にて記したように、ここではそれぞれの検出プロットは区別せずに初期航跡を作成する。
初期航跡は、実施の形態1と同様に、式(8)と式(9)より設定される。
初期航跡は、実施の形態1と同様に、式(8)と式(9)より設定される。
ステップST2-3において、m次~n次エコー追尾フィルタ部8は、航跡予測を行う。m次~n次エコー追尾フィルタ部8は、ステップST2-2で作成した初期航跡と、前の時刻k-1においてm次エコー追尾フィルタ部3-mが出力した追尾航跡と、前の時刻k-1においてn次エコー追尾フィルタ部3-nが出力した追尾航跡と、前の時刻k-1においてm次~n次エコー追尾フィルタ部8が出力した追尾航跡について、時刻kでの予測航跡を求める。
予測航跡は、実施の形態1と同様に、式(11)と式(12)から作成される。ここで作成される予測航跡は3種類あり、1つはm次エコー航跡から作成される予測航跡、1つはn次エコー航跡から作成される予測航跡、1つはm次~n次エコー航跡及び初期航跡から作成される予測航跡である。しかし、以降のステップST2-4~ST2-7では、いずれの種類の予測航跡も区別せずに「時刻kの予測航跡」として扱う。
ステップST2-4において、m次~n次エコー追尾フィルタ部8は、航跡相関を求める。m次~n次エコー追尾フィルタ部8は、時刻kの予測航跡の近傍にある時刻kの検出プロットを抽出し、次のステップST2-5において予測航跡を更新する際に用いる検出プロットを絞り込む。
予測航跡の近傍にある検出プロットを抽出する方法は、実施の形態1と同様に、例えば式(16)を用いて行われる。またステップST2-1及びステップST2-3で記したように、検出プロットの種類(m次エコー検出プロット、n次エコー検出プロット)及び予測航跡の種類(m次エコー航跡から作成された予測航跡、n次エコー航跡から作成された予測航跡、m次~n次エコー航跡から作成された予測航跡)はここでは区別しない。
予測航跡の近傍にある検出プロットを抽出する方法は、実施の形態1と同様に、例えば式(16)を用いて行われる。またステップST2-1及びステップST2-3で記したように、検出プロットの種類(m次エコー検出プロット、n次エコー検出プロット)及び予測航跡の種類(m次エコー航跡から作成された予測航跡、n次エコー航跡から作成された予測航跡、m次~n次エコー航跡から作成された予測航跡)はここでは区別しない。
ステップST2-5において、m次~n次エコー追尾フィルタ部8は、航跡更新を行う。m次~n次エコー追尾フィルタ部8は、予測航跡とその相関ゲート内の検出プロットから、時刻kにおける追尾航跡を作成する。また、m次~n次エコー追尾フィルタ部8は、予測航跡が時刻kでは検出プロットとして観測されなかった場合を表す航跡も、時刻kにおける追尾航跡として作成する。
予測航跡と相関ゲート内の検出プロットから追尾航跡を作成する方法は、実施の形態1と同様に、式(18)、式(19)、式(21)及び式(22)を用いて行われる。
予測航跡と相関ゲート内の検出プロットから追尾航跡を作成する方法は、実施の形態1と同様に、式(18)、式(19)、式(21)及び式(22)を用いて行われる。
ステップST2-6において、m次~n次エコー追尾フィルタ部8と対になった航跡信頼度計算部4は、航跡信頼度計算を行う。航跡信頼度計算部4は、予測航跡とその相関ゲート内にある検出プロットから、ステップST2-5で作成された追尾航跡の航跡信頼度を計算する。
航跡信頼度は、実施の形態1と同様に、式(23)、式(24)及び式(25)より計算される。
航跡信頼度は、実施の形態1と同様に、式(23)、式(24)及び式(25)より計算される。
ステップST2-7において、m次~n次エコー追尾フィルタ部8と対になった航跡信頼度計算部4は、航跡削除を行う。航跡信頼度計算部4は、ステップST2-6において作成された時刻kの追尾航跡のうち、誤検出のみによって作成及び更新された航跡を削除するために、航跡信頼度が低い追尾航跡を削除する。m次~n次エコー追尾フィルタ部8は、ここで削除されなかった複数の追尾航跡を「時刻kにおけるm次~n次エコー追尾航跡」として航跡決定部6へ出力する。
航跡を削除する際の条件は、実施の形態1と同様に、式(26)により定義される。
航跡を削除する際の条件は、実施の形態1と同様に、式(26)により定義される。
上記のステップST2-1~ST2-7によって、m次~n次エコー追尾フィルタ部8と、このm次~n次エコー追尾フィルタ部8と対になる航跡信頼度計算部4とが動作する。航跡信頼度計算部4から出力されたm次~n次エコー航跡とその航跡信頼度は、航跡決定部6において、実施の形態1と同様の動作によって選ばれる表示航跡の候補となる。
なお、図示は省略するが、目標追尾装置1は、m次エコー追尾フィルタ部3-mとn次エコー追尾フィルタ部3-nとm次~n次エコー追尾フィルタ部8を、複数組備える構成であってもよい。例えば、3次エコー目標が検出される観測条件では、目標追尾装置1を、1次エコー追尾フィルタ部、2次エコー追尾フィルタ部、3次エコー追尾フィルタ部、1次~2次エコー追尾フィルタ部、及び2次~3次エコー追尾フィルタ部を備える構成にする。
以上のように構成された実施の形態2によれば、遠方から接近するまたは遠方へ離れていく目標を観測する場合、あるいはPRIが小さく多次エコーの次数が観測中に変わりやすい場合でも目標の追尾航跡が得られる。これは、m次~n次エコー追尾フィルタ部8が、前の時刻においてm次エコー目標として表していた追尾航跡を、n次エコー目標であると仮定した最新時刻の検出プロットで更新し、またn次エコー目標を表す航跡をm次エコー目標を仮定した検出プロットで更新することで、最大観測距離Rmaxの境界を跨ぐ目標の追尾航跡を作成するためである。
実施の形態3.
図10は、この発明の実施の形態3に係る目標追尾装置1の構成例を示すブロック図である。図10に示すように、実施の形態3に係る目標追尾装置1は、n次エコー追尾フィルタ部3-nと、航跡信頼度計算部4と、n次エコー計算ブロック5と、航跡決定部6とを備えている。航跡決定部6は、航跡仮説作成部9と、航跡仮説決定部10とを備えている。
なお、n次エコー追尾フィルタ部3-n、航跡信頼度計算部4及びn次エコー計算ブロック5の実装方法及び動作は、実施の形態1と同様であるため説明を省略する。
航跡仮説作成部9及び航跡仮説決定部10は、図3のメモリ102に格納されたプログラムを実行するプロセッサ101である。プロセッサ101がメモリ102に格納されているプログラムを実行することにより、航跡仮説作成部9及び航跡仮説決定部10の各機能が実現される。
図10は、この発明の実施の形態3に係る目標追尾装置1の構成例を示すブロック図である。図10に示すように、実施の形態3に係る目標追尾装置1は、n次エコー追尾フィルタ部3-nと、航跡信頼度計算部4と、n次エコー計算ブロック5と、航跡決定部6とを備えている。航跡決定部6は、航跡仮説作成部9と、航跡仮説決定部10とを備えている。
なお、n次エコー追尾フィルタ部3-n、航跡信頼度計算部4及びn次エコー計算ブロック5の実装方法及び動作は、実施の形態1と同様であるため説明を省略する。
航跡仮説作成部9及び航跡仮説決定部10は、図3のメモリ102に格納されたプログラムを実行するプロセッサ101である。プロセッサ101がメモリ102に格納されているプログラムを実行することにより、航跡仮説作成部9及び航跡仮説決定部10の各機能が実現される。
上記実施の形態1及び実施の形態2では、航跡決定部6において最も信頼度の高い航跡を1つ選択することから分かるように、観測領域内に存在する目標が高々1個であることを前提に、尤もらしい追尾航跡を決定する構成である。しかし、広範囲を観測するレーダ2に対して目標追尾装置1を適用する場合、観測領域内に複数の目標が存在し得るため、実施の形態1及び実施の形態2の上記前提は成り立たない。
したがって実施の形態3では、航跡仮説作成部9が、1次エコー追尾フィルタ部3及びn次エコー追尾フィルタ部3-nで作成された多数の追尾航跡の候補の中から、同時に実現し得る追尾航跡の組み合わせを作成し、航跡仮説決定部10が、航跡信頼度の合計が最も高い追尾航跡の組み合わせを選択し、選択した組み合わせに含まれる各追尾航跡を表示器7へ出力する構成とする。以下、追尾航跡の組み合わせを「航跡仮説」と表記する。
したがって実施の形態3では、航跡仮説作成部9が、1次エコー追尾フィルタ部3及びn次エコー追尾フィルタ部3-nで作成された多数の追尾航跡の候補の中から、同時に実現し得る追尾航跡の組み合わせを作成し、航跡仮説決定部10が、航跡信頼度の合計が最も高い追尾航跡の組み合わせを選択し、選択した組み合わせに含まれる各追尾航跡を表示器7へ出力する構成とする。以下、追尾航跡の組み合わせを「航跡仮説」と表記する。
ここで、「同時に実現し得る追尾航跡の組み合わせ」とは、ある追尾航跡について図5のステップST1-5で航跡更新に用いた検出プロット履歴と、別の追尾航跡について図5のステップST1-5で航跡更新に用いた検出プロット履歴の中に、同じ検出プロットが含まれていないことと定義する。
例えば、ある追尾航跡T1が過去の検出プロットz1 (T1)、z2 (T1)、・・・、zk (T1)から作成された航跡とし、別の追尾航跡T2が過去の検出プロットz1 (T2)、z2 (T2)、・・・、zk (T2)から作成された航跡とする。このとき、もしいずれかの検出プロットに重複がある、すなわち何れかの時刻k’においてzk’ (T1)=zk’ (T2)であった場合、重複した検出プロットは追尾航跡T1と追尾航跡T2のいずれか一方が観測された結果であるため、追尾航跡T1と追尾航跡T2は同時に実現し得ない航跡となる。
ただしこの条件では、観測時間が長いほど多くの検出プロット履歴を遡る必要があり処理負荷が高くなるため、後述する動作の説明では、実用的な処理として過去L回分の時刻における検出プロットについてのみ重複を判定するものとする。
例えば、ある追尾航跡T1が過去の検出プロットz1 (T1)、z2 (T1)、・・・、zk (T1)から作成された航跡とし、別の追尾航跡T2が過去の検出プロットz1 (T2)、z2 (T2)、・・・、zk (T2)から作成された航跡とする。このとき、もしいずれかの検出プロットに重複がある、すなわち何れかの時刻k’においてzk’ (T1)=zk’ (T2)であった場合、重複した検出プロットは追尾航跡T1と追尾航跡T2のいずれか一方が観測された結果であるため、追尾航跡T1と追尾航跡T2は同時に実現し得ない航跡となる。
ただしこの条件では、観測時間が長いほど多くの検出プロット履歴を遡る必要があり処理負荷が高くなるため、後述する動作の説明では、実用的な処理として過去L回分の時刻における検出プロットについてのみ重複を判定するものとする。
航跡仮説作成部9は、1次エコー追尾フィルタ部3と対になった航跡信頼度計算部4から1次エコー航跡とその航跡信頼度を受け取り、n次エコー追尾フィルタ部3-nと対になった航跡信頼度計算部4からn次エコー航跡とその航跡信頼度を受け取る。そして、航跡仮説作成部9は、受け取った多数の追尾航跡の中から1個以上の追尾航跡を組み合わせた航跡仮説を作成し、航跡仮説決定部10に出力する。
航跡仮説決定部10は、航跡仮説作成部9から航跡仮説を受け取り、航跡仮説に含まれる追尾航跡の航跡信頼度の合計を求める。以下、航跡仮説に含まれる追尾航跡の航跡信頼度の合計を「仮説信頼度」と表記する。そして、航跡仮説決定部10は、仮説信頼度が最大となった航跡仮説に含まれている単数または複数の追尾航跡を「表示航跡」として表示器7に出力する。
表示器7は、航跡仮説決定部10から単数または複数の表示航跡を受け取り、各表示航跡に含まれる目標の位置もしくは速度等の運動諸元、運動諸元の推定値の誤差を表す値、多次エコー次数、または航跡信頼度等を表示する。
次に、時刻kにおける航跡仮説作成部9及び航跡仮説決定部10の動作を、図11のフローチャートに沿って説明する。
なお、以下では、nは1以上の整数とし、1次エコー追尾フィルタ部3の動作を、n次エコー追尾フィルタ部3-nにおいてn=1の場合における動作として、まとめて説明する。
航跡仮説作成部9及び航跡仮説決定部10は、n次エコー追尾フィルタ部3-nと対になった航跡信頼度計算部4のそれぞれから、時刻kにおけるn次エコー航跡とその航跡信頼度とを受け取り、図11のフローチャートに示される処理を行う。
なお、以下では、nは1以上の整数とし、1次エコー追尾フィルタ部3の動作を、n次エコー追尾フィルタ部3-nにおいてn=1の場合における動作として、まとめて説明する。
航跡仮説作成部9及び航跡仮説決定部10は、n次エコー追尾フィルタ部3-nと対になった航跡信頼度計算部4のそれぞれから、時刻kにおけるn次エコー航跡とその航跡信頼度とを受け取り、図11のフローチャートに示される処理を行う。
始めにステップST3-1において、航跡仮説決定部10は、暫定的な最大仮説信頼度を極小値、つまりプログラム上の最小の負値に設定する。
ステップST3-2において、航跡仮説作成部9は、受け取ったn次エコー航跡の中から、時刻kでの処理内における未作成の組み合わせの追尾航跡を組み合わせて、航跡仮説を作成する。このとき、航跡仮説には1個以上の追尾航跡が含まれているものとし、各追尾航跡がいずれの多次エコーを仮定した場合の航跡であるかは区別しない。
ステップST3-2において、航跡仮説作成部9は、受け取ったn次エコー航跡の中から、時刻kでの処理内における未作成の組み合わせの追尾航跡を組み合わせて、航跡仮説を作成する。このとき、航跡仮説には1個以上の追尾航跡が含まれているものとし、各追尾航跡がいずれの多次エコーを仮定した場合の航跡であるかは区別しない。
ステップST3-3において、航跡仮説作成部9は、作成した航跡仮説に含まれる各々の追尾航跡について、時刻kから時刻k-Lまでの間に、図5のステップST1-5で航跡更新に用いた検出プロットの履歴を比較する。なお、Lは、0以上の整数とし、性能と処理負荷のバランスを決定するパラメータである。Lが大きいほど航跡仮説の推定精度が高くなり、一方で処理負荷は高くなる。
もし、ステップST3-2で作成された航跡仮説に含まれる各々の追尾航跡の過去L回分の検出プロットの履歴の中に同じ検出プロットが含まれていた場合(ステップST3-3“NO”)、航跡仮説作成部9は、この航跡仮説は「同時に実現し得る追尾航跡の組み合わせ」ではないと判定して棄却し、ステップST3-7へ移行する。一方、各々の追尾航跡の過去L回分の検出プロットの履歴の中に同じ検出プロットが含まれていない場合(ステップST3-3“YES”)、航跡仮説作成部9は、この航跡仮説は「同時に実現し得る追尾航跡の組み合わせ」であると判定して、ステップST3-4へ移行する。
もし、ステップST3-2で作成された航跡仮説に含まれる各々の追尾航跡の過去L回分の検出プロットの履歴の中に同じ検出プロットが含まれていた場合(ステップST3-3“NO”)、航跡仮説作成部9は、この航跡仮説は「同時に実現し得る追尾航跡の組み合わせ」ではないと判定して棄却し、ステップST3-7へ移行する。一方、各々の追尾航跡の過去L回分の検出プロットの履歴の中に同じ検出プロットが含まれていない場合(ステップST3-3“YES”)、航跡仮説作成部9は、この航跡仮説は「同時に実現し得る追尾航跡の組み合わせ」であると判定して、ステップST3-4へ移行する。
ステップST3-4において、航跡仮説決定部10は、「同時に実現し得る追尾航跡の組み合わせ」であると判定された航跡仮説を航跡仮説作成部9から受け取り、受け取った航跡仮説に含まれている各追尾航跡について、航跡信頼度の和を求め、仮説信頼度とする。仮説信頼度は、航跡仮説にどれほど多くの尤もらしい追尾航跡が含まれているかを表す値であり、値が大きいほど尤もらしい追尾航跡の組み合わせであることを表す。
ステップST3-5において、航跡仮説決定部10は、ステップST3-4で求めた仮説信頼度と、暫定的な最大仮説信頼度とを比較する。航跡仮説決定部10は、ステップST3-4で求めた仮説信頼度が暫定的な最大仮説信頼度より大きかった場合(ステップST3-5“YES”)、ステップST3-6へ移行する。一方、航跡仮説決定部10は、ステップST3-4で求めた仮説信頼度が暫定的な最大仮説信頼度以下であった場合(ステップST3-5“NO”)、ステップST3-6をスキップしてステップST3-7へ移行する。
ステップST3-6において、航跡仮説決定部10は、ステップST3-4の仮説信頼度で暫定的な最大仮説信頼度を上書きする。
ステップST3-7において、航跡仮説作成部9は、受け取ったn次エコー航跡から全通りの航跡仮説を作成し終えたか否かを判定する。航跡仮説作成部9は、全通りの航跡仮説を作成した場合(ステップST3-7“YES”)、ステップST3-8へ移行する。一方、航跡仮説作成部9は、未作成の組み合わせの航跡仮説がある場合(ステップST3-7“NO”)、ステップST3-2へ戻る。
ステップST3-7において、航跡仮説作成部9は、受け取ったn次エコー航跡から全通りの航跡仮説を作成し終えたか否かを判定する。航跡仮説作成部9は、全通りの航跡仮説を作成した場合(ステップST3-7“YES”)、ステップST3-8へ移行する。一方、航跡仮説作成部9は、未作成の組み合わせの航跡仮説がある場合(ステップST3-7“NO”)、ステップST3-2へ戻る。
ステップST3-8において、航跡仮説決定部10は、航跡仮説作成部9から全通りの航跡仮説を作成し終えた旨の通知を受け取り、この時点での最大仮説信頼度を持つ航跡仮説に含まれている追尾航跡すべてを、「表示航跡」として表示器7へ出力する。
以上のステップST3-1~ST3-8によって、表示器7に単数または複数の表示航跡が出力される。
以上のステップST3-1~ST3-8によって、表示器7に単数または複数の表示航跡が出力される。
なお、上記説明では、実施の形態1における1次エコー追尾フィルタ部3、航跡信頼度計算部4及びn次エコー計算ブロック5に対して、実施の形態3における航跡仮説作成部9及び航跡仮説決定部10を適用したが、実施の形態2におけるm次エコー追尾フィルタ部3-m、n次エコー追尾フィルタ部3-n、m次~n次エコー追尾フィルタ部8及び航跡信頼度計算部4に対して、実施の形態3における航跡仮説作成部9及び航跡仮説決定部10を適用してもよい。
以上のように構成された実施の形態3によれば、複数かつ多次エコーの次数が異なる目標が同時に観測される場合でも、各目標の追尾航跡を得ることができる。これは、航跡仮説作成部9及び航跡仮説決定部10によって、互いの追尾航跡が同じ検出プロットを共有せず、かつ尤もらしい追尾航跡が最も多く含まれる追尾航跡の組み合わせが出力されるためである。
この効果は特に、次数の異なる複数の多次エコー目標がレーダ2から出力される検出プロット上で近接して表れる場合において、各追尾航跡は同じ検出プロットを共有しないことを前提に表示する各追尾航跡が決定されるために、ある次数の多次エコー航跡の追尾航跡が別の次数の多次エコーに乗り移る事態が起こりにくくなる点で画期的である。
この効果は特に、次数の異なる複数の多次エコー目標がレーダ2から出力される検出プロット上で近接して表れる場合において、各追尾航跡は同じ検出プロットを共有しないことを前提に表示する各追尾航跡が決定されるために、ある次数の多次エコー航跡の追尾航跡が別の次数の多次エコーに乗り移る事態が起こりにくくなる点で画期的である。
また、従来技術との違いとして、同時に観測される目標の個数が多いほど多種類のPRIで得られた検出プロットを必要とするマルチPRIレンジングと異なり、最低2種類のPRIによる検出プロットの時系列から、任意の個数の多次エコー目標に対してそれぞれの航跡を推定することができる点がある。これは、航跡仮説作成部9において目標個数の上限を設定することなく、追尾航跡の組み合わせを生成するためである。
ところで、上記説明では、目標追尾装置1を、レーダ装置の観測結果を基に目標の航跡を推定する場合に利用する例について説明したが、例えば音波による測距センサ等、レーダ以外の測距センサにも利用できることはいうまでもない。
なお、本発明はその発明の範囲内において、各実施の形態の自由な組み合わせ、各実施の形態の任意の構成要素の変形、または各実施の形態の任意の構成要素の省略が可能である。
この発明に係る目標追尾装置は、多次エコーに対して目標の正しい航跡を推定するようにしたので、複数種類のPRIで目標を観測するレーダ装置等に対して用いるのに適している。
1 目標追尾装置、2 レーダ、3 1次エコー追尾フィルタ部、3-m m次エコー追尾フィルタ部、3-n n次エコー追尾フィルタ部、4 航跡信頼度計算部、5 n次エコー計算ブロック、6 航跡決定部、7 表示器、8 m次~n次エコー追尾フィルタ部(多次エコー追尾フィルタ部)、9 航跡仮説作成部、10 航跡仮説決定部、50 レーダ原点、51 1次エコー目標、52 2次エコー目標、53 3次エコー目標、54 1次エコー、55 2次エコー、56 3次エコー、61 1次エコー航跡、62 2次エコー航跡、63 3次エコー航跡、64 検出抜け、65 誤検出、66 m次~n次エコー航跡、101 プロセッサ、102 メモリ、103 入力装置、104 出力装置。
Claims (3)
- nを1以上の整数とし、観測対象の目標がn次エコーとして観測される距離に存在することを仮定して、センサによって観測された前記目標の情報に、前記目標の検出抜け及び前記目標の誤検出が含まれることを前提とし、前記目標の情報から前記目標の航跡の候補を作成する複数のn次エコー追尾フィルタ部と、
前記目標の情報に前記目標の検出抜け及び前記目標の誤検出が含まれることを前提とし、複数の前記n次エコー追尾フィルタ部により作成された航跡の候補の尤もらしさを表す航跡信頼度を計算する航跡信頼度計算部と、
前記航跡信頼度計算部により計算された航跡信頼度に基づいて、複数の前記n次エコー追尾フィルタ部により作成された航跡の候補の中から、表示器に表示させる航跡を決定する航跡決定部とを備える目標追尾装置。 - 前記目標が複数の次数のエコーとして観測される距離に存在することを仮定して、前記センサによって観測された前記目標の情報から、前記目標の航跡の候補を作成する多次エコー追尾フィルタ部を備えることを特徴とする請求項1記載の目標追尾装置。
- 前記航跡決定部は、
前記目標の航跡の候補の中から、同一観測時刻に実現し得る航跡の組み合わせを、複数通り作成する航跡仮説作成部と、
前記航跡信頼度計算部により計算された航跡信頼度に基づいて、前記航跡仮説作成部により作成された航跡の組み合わせの中から、前記表示器に表示させる航跡の組み合わせを決定する航跡仮説決定部とを有することを特徴とする請求項1記載の目標追尾装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP16883585.8A EP3392671A4 (en) | 2016-01-06 | 2016-01-06 | TARGET TRACKING DEVICE |
US15/778,595 US20180372857A1 (en) | 2016-01-06 | 2016-01-06 | Target tracking apparatus |
PCT/JP2016/050254 WO2017119081A1 (ja) | 2016-01-06 | 2016-01-06 | 目標追尾装置 |
JP2017559630A JP6279185B2 (ja) | 2016-01-06 | 2016-01-06 | 目標追尾装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2016/050254 WO2017119081A1 (ja) | 2016-01-06 | 2016-01-06 | 目標追尾装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2017119081A1 true WO2017119081A1 (ja) | 2017-07-13 |
Family
ID=59273557
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2016/050254 WO2017119081A1 (ja) | 2016-01-06 | 2016-01-06 | 目標追尾装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20180372857A1 (ja) |
EP (1) | EP3392671A4 (ja) |
JP (1) | JP6279185B2 (ja) |
WO (1) | WO2017119081A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2776868C1 (ru) * | 2021-07-02 | 2022-07-28 | Российская Федерация, От Имени Которой Выступает Министерство Промышленности И Торговли Российской Федерации | Способ идентификации измерений пеленгов источников излучения в многоцелевой обстановке в однопозиционной пассивной радиолокационной станции |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112946625B (zh) * | 2021-02-04 | 2022-07-15 | 江南大学 | 基于b样条形状驱动多扩展目标航迹跟踪及分类方法 |
CN113484866B (zh) * | 2021-07-05 | 2022-04-29 | 哈尔滨工程大学 | 一种基于被动声呐方位历程图的多目标检测跟踪方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005091174A (ja) * | 2003-09-17 | 2005-04-07 | Tech Res & Dev Inst Of Japan Def Agency | レーダ装置 |
JP2008261739A (ja) * | 2007-04-12 | 2008-10-30 | Mitsubishi Electric Corp | 多目標追尾装置 |
JP2011145096A (ja) * | 2010-01-12 | 2011-07-28 | Mitsubishi Electric Corp | 多目標追尾装置 |
JP2015121473A (ja) * | 2013-12-24 | 2015-07-02 | 三菱電機株式会社 | 目標追尾装置及び目標追尾方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ATE519126T1 (de) * | 2004-06-24 | 2011-08-15 | Bae Systems Plc | Verbesserungen in bezug auf die geschwindigkeitsextraktion |
US7626535B2 (en) * | 2006-11-09 | 2009-12-01 | Raytheon Company | Track quality based multi-target tracker |
-
2016
- 2016-01-06 US US15/778,595 patent/US20180372857A1/en not_active Abandoned
- 2016-01-06 WO PCT/JP2016/050254 patent/WO2017119081A1/ja unknown
- 2016-01-06 EP EP16883585.8A patent/EP3392671A4/en not_active Withdrawn
- 2016-01-06 JP JP2017559630A patent/JP6279185B2/ja active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005091174A (ja) * | 2003-09-17 | 2005-04-07 | Tech Res & Dev Inst Of Japan Def Agency | レーダ装置 |
JP2008261739A (ja) * | 2007-04-12 | 2008-10-30 | Mitsubishi Electric Corp | 多目標追尾装置 |
JP2011145096A (ja) * | 2010-01-12 | 2011-07-28 | Mitsubishi Electric Corp | 多目標追尾装置 |
JP2015121473A (ja) * | 2013-12-24 | 2015-07-02 | 三菱電機株式会社 | 目標追尾装置及び目標追尾方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2776868C1 (ru) * | 2021-07-02 | 2022-07-28 | Российская Федерация, От Имени Которой Выступает Министерство Промышленности И Торговли Российской Федерации | Способ идентификации измерений пеленгов источников излучения в многоцелевой обстановке в однопозиционной пассивной радиолокационной станции |
Also Published As
Publication number | Publication date |
---|---|
US20180372857A1 (en) | 2018-12-27 |
EP3392671A4 (en) | 2019-01-16 |
JPWO2017119081A1 (ja) | 2018-03-29 |
JP6279185B2 (ja) | 2018-02-14 |
EP3392671A1 (en) | 2018-10-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101628154B1 (ko) | 수신 신호 세기를 이용한 다중 표적 추적 방법 | |
US20160054430A1 (en) | Multi-sensor target tracking using multiple hypothesis testing | |
Ehlers et al. | Batch tracking algorithm for multistatic sonars | |
Trémois et al. | Optimal observer trajectory in bearings-only tracking for manoeuvring sources | |
Chavali et al. | Hierarchical particle filtering for multi-modal data fusion with application to multiple-target tracking | |
Liu et al. | Deinterleaving pulse trains in unconventional circumstances using multiple hypothesis tracking algorithm | |
JP6279185B2 (ja) | 目標追尾装置 | |
KR101627419B1 (ko) | 이동 노드의 위치 추정 방법 및 그 장치 | |
JP5904775B2 (ja) | 目標追尾装置 | |
JP2007024773A (ja) | 航跡相関統合装置 | |
JP2014211330A (ja) | 目標追尾装置及び目標追尾方法 | |
Nguyen et al. | Adaptive waveform scheduling for target tracking in clutter by multistatic radar system | |
JP2014102256A (ja) | 目標追尾装置及び目標追尾方法 | |
JP2021135473A (ja) | 捜索支援システム、捜索支援方法 | |
Huang et al. | A particle filter track-before-detect algorithm for multi-radar system | |
CN115220002B (zh) | 一种固定单站的多目标数据关联跟踪方法和相关装置 | |
JP2004219300A (ja) | 目標追尾装置 | |
CN112946568A (zh) | 辐射源航迹矢量直接估计方法 | |
JP2013002841A (ja) | 目標追尾装置 | |
Hem et al. | Compensating radar rotation in target tracking | |
US8149161B1 (en) | Method and system for azimuthal containment using largest gap method | |
Ikram et al. | A new data association method for 3-D object tracking in automotive applications | |
RU2619823C1 (ru) | Способ коррекции координат, высоты и вертикальной скорости летательного аппарата и устройство для его осуществления | |
Popovich et al. | Moving Objects Tracking in Distributed Maritime Observation Systems | |
Dezert et al. | A comparative analysis of QADA-KF with JPDAF for multitarget tracking in clutter |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 16883585 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2017559630 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |