Disclosure of Invention
The invention aims to solve the problems, and provides a method for seamlessly tracking a point target and an extended target, so as to track the shape change of an ET (augmented reality) and simultaneously track a PT (potential Transformer) and the ET under the conditions of clutter and missing detection, and solve the problems of measurement and data association of shape points.
The key technology for realizing the invention is as follows: the variable dimension GP is used for modeling the variable outline of the target, the Poisson rate is introduced to estimate the number of measurement sources, and the number of the measurement sources reflects the number of outline points, so that the number of the radii of the GP model can be dynamically adjusted by the Poisson rate, and the model is adapted to the change of the outline of the target. And the PMHT algorithm is adopted to solve the data association problem, so that the tracking of a plurality of extended targets in the clutter is completed.
The technical problem proposed by the invention is solved as follows:
a method for seamless tracking of a point target and an extended target comprises the following steps:
step 1, initializing ET-GP-PMHT algorithm parameters:
step 1a, initializing state background parameters and GP model parameters: state transition matrix, state noise covariance, initial state covariance, hyper-parameters, etc.;
step 1b, initializing various parameters of the observation environment: observing noise variance R, clutter density, sampling interval Δ t, monitored space V, sensor position, detection probability Pd;
Step 1c, importing observation information: including T frame data, T in each sliding windowbFrame data, 1-T in sliding windowbFrame measurement data set Z, tth frame measurement data set ZtThe number of measurement sets M of the t-th framet,1≤t≤Tb;
Step 2. initialize T in sliding windowbSetting the current iteration times i as 1 for a frame data and measurement data set Z;
step 2a, removing the measurement related to the existing track in the measurement space, stacking the measurement with the Euclidean distance between the other measurements lower than the distance threshold in the measurement space, and initializing the new target track by using the two-point difference method of the measurement stack center of the previous 2 frames; if a new target track exists, initializing various parameters of the state environment: number of targets N
tAnd initializing the number of GP model radiuses of the target track according to the result of comparing the number of elements in the measurement set obtained by each pile division in the first frame with the detection probability
Obtaining the target initial state by two-point difference
Initializing a state transition matrix, an initial state covariance, a state noise covariance, a poisson rate and a poisson parameter;
step 2b. introduction
Of a radius-corresponding outline point
Measuring the model;
step 3, constructing a posterior probability calculation formula of the T frame of the ET-GP-PMHT:
step 3a. poisson velocity vector:
wherein N is 1
t,
The Poisson velocity vector λ is 1 to T
bIn the poisson rate vector set of the frame, the invention assumes that the measured number of the target and the clutter number in the measurement interval meet poisson distribution, so the prior probability in the original PMHT can be replaced by the poisson rate, and the poisson rate can also reflect the average number of the measurement generated by the target; lambda [ alpha ]
0,tThe number obeying mean value of the representative clutter is lambda
0,tThe poisson distribution of (1), set as a constant in this invention; poisson rate λ
n,l,tObeys a distribution of
n,l,t|tAnd beta
n,l,t|tGamma distribution lambda as poisson parameter
n,l,t=γ(λ
n,l,t;α
n,l,t|t,β
n,l,t|t),α
n,l,t|tAs a shape parameter, β
n,l,t|tIs a scale parameter;
and 3b, calculating a likelihood according to the formula:
assuming that the clutter is spatially uniform, the likelihood value is:
wherein z is
j,tIs the jth (
j 1.., M) of the t frame
t) Measurement, x
n,tIs the target state for the t frame n target,
is shown in
As a mean value, with R
n,l,tIs a gaussian probability density function of the covariance,
h
l,t(. R) represents the metrology function of the metrology model corresponding to the ith topographical point of the target at time t, n
n,l,tFor its covariance matrix corresponding to the metrology model,
the angle of the ith appearance point of the nth target of the tth frame on the global coordinate axis (as shown in FIG. 1) is the same, and the measurement models of different targets are the same;
step 3c, posterior probability formula:
wherein, ω isj,l,n,tMeasurement z at a time tj,tIs derived from the object xn,tThe posterior probability of the l contour point;
step 3d. poisson rate formula:
αn,l,t-1|t=exp{-Δt/τ}αn,l,t|t βn,l,t-1|t=exp{-Δt/τ}βn,l,t|t
where exp is the exponential power, αn,l,t|t-1To predict the shape parameter, betan,l,t|t-1For predicting the scale parameter, tau is a time constant, which means the response speed of estimating the change of the evolution Poisson rate;
step 4, calculating the comprehensive measurement and the comprehensive covariance:
comprehensive measurement
And integrated covariance
Respectively as follows:
so far, the problem of fuzzy association between measurement and target appearance points in an extended target scene is solved, and only one comprehensive measurement and one comprehensive covariance exist for one appearance point of each target;
step 5, judging T as TbWhether the result is true or not, if so, executing the next step; otherwise, returning to execute the step 3, if t is t + 1;
step 6, extended Kalman smoothing:
because the measurement function of the extended target is nonlinear, the state is estimated by the extended Kalman smoothing algorithm. The measurement matrix, the comprehensive measurement and the comprehensive covariance can be stacked by adopting a stacking method, and then an extended Kalman smoothing algorithm is applied.
Because the measurement function is a nonlinear function, a Jacobian matrix is required to be obtained for the measurement function as a measurement matrix:
then, stacking the measurement matrix, the comprehensive measurement and the comprehensive covariance respectively to obtain:
wherein diag (·) represents a diagonalized matrix; finally, for the target xn,tThe algorithm steps of the executed extended Kalman smoothing algorithm are consistent with those of the traditional extended Kalman smoothing algorithm;
step 7, judging whether the iteration number i meets the loop iteration convergence condition, and returning to the step 3 if the iteration number i does not meet the loop iteration convergence condition; convergence is performed 8;
step 8, judging the track termination: defining an average estimated rate
If xi is smaller than threshold xi
THIf the flight path is finished, otherwise, the flight path continues;
step 9, self-adapting the dynamic target shape, and adjusting the number of target shape points:
step 9a, estimating the number of measurement sources by using the target Poisson rate:
estimating the difference between the number of the measurement sources and the number of the appearance points:
step 9b, if var is larger than 0, finding out the target radii with the front var poisson parameters being large, and adding new radii with the same poisson parameters beside the radii;
if var is less than 0, deleting the radius of the-var bar with the minimum Poisson parameter;
if var ≠ 0, update the state transition matrix, state noise covariance Qn,tState covariance Pn,t;
If var is 0, executing step 10;
step 10, judging whether the sliding window contains the last T of the T frame data setbFrame data, if not, the sliding window slides forward by TsAt one moment, a new in-window T is formedbReturning to execute the step 2 after the frame data and the measured data set Z are collected; otherwise the algorithm ends.
The method estimates the number of measurement sources by using the Poisson rate, adjusts the number of radii of the GP model, and records each sensor resolution unit occupied by the target contour as a measurement source. If the target observed relative to the sensor is smaller, the number of measurement sources on the target profile is smaller, the number of radii of the GP is estimated to be smaller, and vice versa. When the target is PT, ET-GP-PMHT tracks and outputs only the position of the target. The PMHT algorithm is adopted as the target tracking algorithm, and the algorithm is premised on the assumption that one target can generate a plurality of measurements and accords with the actual situation of an extended target.
The invention has the beneficial effects that:
(1) the ET-GP-PMHT can track the shape change of the ET and seamlessly track the mutual conversion of the ET and the PT, and when the shape is the ET with the unchanged form, the number of GP radiuses estimated by an algorithm is almost unchanged, so that the better tracking performance can be kept; when the target is PT, the ET-GP-PMHT tracks only the position of the target.
(2) The calculation complexity of the ET-GP-PMHT algorithm is related to the measurement number, the radius number and the target number. When the ET external deformation is small, the number of radii of the adopted GP model is reduced, and the calculation complexity is reduced.
Detailed Description
The invention is further described below with reference to the figures and examples.
The embodiment provides a method for seamlessly tracking a point target and an extended target, wherein simulation is performed in a scene with clutter, as shown in fig. 1, four moving targets are tracked, and root mean square error RMSE (RMSE) verification algorithm performance is calculated. And comparing the ET-GP-PMHT with ET-GP-PMHT-FBP26, ETGP-PMHT-FBP10, and ET-RM-PMHT. The ET-GP-PMHT-FBP represents an ET-GP-PMHT algorithm with fixed number of appearance points, the ET-GP-PMHT-FBP26 represents that the number of the appearance points is 26, and the PMHT algorithm based on the RM model is marked as ET-RM-PMHT.
The state equation adopts a uniform linear model, the
target 1 is close to the sensor from near to far and then close, the target is changed from an extended target to a point target and then to an extended target, and the motion time is 1-701 s; the target 2 is far from the sensor, the target is changed from a point target to an expanded target and then to a point target, and the movement time is 5-701 s. The
objects 1 and 2 make uniform circular motion, i.e. turn, at 230-481s, and the angular velocity is 1/80 rad/s. The
target 3 is far away from the sensor all the time and is represented as a point target, and the movement time is 21-230 s; the
target 4 is always close to the sensor and is represented as an extended target with the same size, and the movement time is 31-230 s. Number of target real measurement sources
In relation to the position S between the target sensors:
the method of the embodiment comprises the following steps:
step 1, initializing ET-GP-PMHT algorithm parameters:
step 1a, initializing state background parameters and GP model parameters: state transition matrix, state noise covariance, initial state covariance, hyper-parameters, etc.;
the target state is
In the state of motion, the device is in motion,
in the form of the external shape state,
is formed by
The vector formed by the contour radii corresponding to the contour points,
representing the position of the target center in two-dimensional space,
indicating its corresponding speed, #
n,tThe angle at which the target is rotated, i.e. the angle between the global and local coordinates (as shown in figure 1),
for the angular velocity, the angle and the angular velocity of the initialized target rotation are respectively 0rad and 0 rad/s; the state transition matrix is
Wherein the transition matrix of the motion state
A state transition matrix of a uniform velocity linear (CV) model and a shape state transition matrix
The dimension of expression is
Where the frame time interval Δ t is 1s, the forgetting parameter α of the state space=0.0001;
State noise covariance
Noise of motion state
Is the state noise of CV model, in which the standard deviation of the state noise of position and angle is sigma
q=0.05,σ
ψ0.001, noise of shape state
Is a basic vector formed by the angles of the target outline points in the local coordinates, the angles of the outline points in the local coordinates are also called basic points (as shown in figure 1), the included angles between adjacent outline points are equal, namely, the outline points are distributed on the target outline in an angular average manner, and the outline points are distributed on the target outline in an equal manner
Covariance matrix for GP model:
covariance is a modified Squared Exponential (SE) function with a period of 2 pi, u and u' being arguments of the k function
The hyper-parameters of the GP model are set as: sigmar=0.3,σfAnother hyper-parameter, the length scale, is adjusted according to the following rule:
the initial states of the four targets are respectively:
the state covariance of the four targets is
The motion state covariance is the diagonal matrix diag ([0.01,0.001,0.01,0.001,0.001, 0.0001)]) The covariance of the shape state is
Step 1b, initializing various parameters of the observation environment: observing noise variance R, clutter density, sampling interval Δ t, monitored space V, sensor position, detection probability Pd;
The sensor position is (0m,0m)TThe two-dimensional detection area x, y has a range of [0,450 ]]×[0,450]m2The clutter in the region is uniformly distributed, the number of the clutter in the region follows Poisson distribution, and the average clutter number at each moment is 20; the signal-to-noise ratio of the scene is 21dB, and the detection probability of the target is Pd=0.92;
Measuring the noise as
exp { - Δ t/τ } -0.9; duration of each batch process T in PMHT
bAt 3 frame times, a sliding length T
s2 frame times. The fixed cycle iteration times are 5 times in each batch of processing;
step 1c, importing observation information: including T frame data, T in each sliding windowbFrame data, 1-T in sliding windowbFrame measurement data set Z, tth frame measurement data set ZtThe number of measurement sets M of the t-th framet,1≤t≤Tb;
Step 2. initialize T in sliding windowbSetting the current iteration times i as 1 for a frame data and measurement data set Z;
step 2a, removing the measurement related to the existing track in the measurement space, dividing the measurement by a certain distance threshold value to judge whether the measurement is related to the existing track, stacking the measurement with the Euclidean distance between the rest measurements being lower than the distance threshold value by 15m in the measurement space, and initializing the new target track by using the center of the measurement stack of the previous 2 frames to carry out a two-point difference method; if a new target track exists, initializing various parameters of the state environment: number of targets N
tAnd initializing the number of GP model radiuses of the target track according to the result of comparing the number of elements in the measurement set obtained by each pile division in the first frame with the detection probability
Obtaining the target initial state by two-point difference
Initial state covariance, state noise covariance, Poisson rate and Poisson parameter lambda
n,l,t=0.7,α
n,l,t|t=8,β
n,l,t|t=10;
Step 2b. introduction
Of a radius-corresponding outline point
Measuring the model;
after the ET-GP-PMHT algorithm environmental parameters are determined, an observation model is determined. Mapping from the state space to the observation space, and measuring the model of the outline point corresponding to the ith radius:
wherein, the direction vector is:
the angle of the ith contour point of the nth target on the local coordinate axis (as shown in FIG. 1) in the tth frame
t,jN (0, R) represents a Gaussian distribution with a mean of 0 and a covariance of R;
step 3, constructing a posterior probability calculation formula of the T frame of the ET-GP-PMHT:
step 3a. poisson velocity vector:
wherein N is 1
t,
The Poisson velocity vector λ is 1 to T
bIn the poisson rate vector set of the frame, the invention assumes that the measured number of the target and the clutter number in the measurement interval meet poisson distribution, so the prior probability in the original PMHT can be replaced by the poisson rate, and the poisson rate can also reflect the average number of the measurement generated by the target; lambda [ alpha ]
0,tThe number obeying mean value of the representative clutter is lambda
0,tThe poisson distribution of (1), set as a constant in this invention; poisson rate λ
n,l,tObeys a distribution of
n,l,t|tAnd beta
n,l,t|tGamma distribution lambda as poisson parameter
n,l,t=γ(λ
n,l,t;α
n,l,t|t,β
n,l,t|t),α
n,l,t|tAs a shape parameter, β
n,l,t|tIs a scale parameter;
and 3b, calculating a likelihood according to the formula:
assuming that the clutter is spatially uniform, the likelihood value is:
wherein z is
j,tIs the jth (
j 1.., M) of the t frame
t) Measurement, x
n,tIs the target state for the t frame n target,
is shown in
As a mean value, with R
n,l,tIs a gaussian probability density function of the covariance,
h
l,t(. R) represents the metrology function of the metrology model corresponding to the ith topographical point of the target at time t, n
n,l,tFor its covariance matrix corresponding to the metrology model,
for the nth target of the t frame, the l outline point isAngles on the global coordinate axis (as in fig. 1), the measurement models of different targets are the same;
step 3c, posterior probability formula:
wherein, ω isj,l,n,tMeasurement z at a time tj,tIs derived from the object xn,tThe posterior probability of the l contour point;
step 3d. poisson rate formula:
αn,l,t-1|t=exp{-Δt/τ}αn,l,t|t βn,l,t-1|t=exp{-Δt/τ}βn,l,t|t
where exp is the exponential power, αn,l,t|t-1To predict the shape parameter, betan,l,t|t-1For predicting the scale parameter, tau is a time constant, which means the response speed of estimating the change of the evolution Poisson rate;
step 4, calculating the comprehensive measurement and the comprehensive covariance:
comprehensive measurement
And integrated covariance
Respectively as follows:
so far, the problem of fuzzy association between measurement and target appearance points in an extended target scene is solved, and only one comprehensive measurement and one comprehensive covariance exist for one appearance point of each target;
step 5, judging T as TbWhether the result is true or not, if so, executing the next step; otherwise, returning to execute the step 3, if t is t + 1;
step 6, extended Kalman smoothing:
because the measurement function of the extended target is nonlinear, the state is estimated by the extended Kalman smoothing algorithm. Will slide the window inside TbThe 3s stacking method stacks the measurement matrix, the comprehensive measurement and the comprehensive covariance, and then uses the extended kalman smoothing algorithm.
Because the measurement function is a nonlinear function, a Jacobian matrix is required to be obtained for the measurement function as a measurement matrix:
then, stacking the measurement matrix, the comprehensive measurement and the comprehensive covariance respectively to obtain:
wherein diag (·) represents a diagonalized matrix; finally, for the target xn,tThe algorithm steps of the executed extended Kalman smoothing algorithm are consistent with those of the traditional extended Kalman smoothing algorithm;
step 7, judging whether the current iteration times i are equal to 5, and if not, returning to the step 3; if yes, executing 8;
step 8, judging the track termination: defining an average estimated rate
If xi is smaller than threshold xi
THIf the track is 0.2, the track is ended, otherwise, the track continues;
step 9, self-adapting the dynamic target shape, and adjusting the number of target shape points:
step 9a, estimating the number of measurement sources by using the target Poisson rate:
estimating the difference between the number of the measurement sources and the number of the appearance points:
step 9b, if var is larger than 0, finding out the target radii with the front var poisson parameters being large, and adding new radii with the same poisson parameters beside the radii;
if var is less than 0, deleting the radius of the-var bar with the minimum Poisson parameter;
if var ≠ 0, the transition matrix, state noise covariance Q is updatedn,tState covariance Pn,t;
If var is 0, executing step 10;
step 10, determining whether the sliding window contains a frame data set last T of 701sbFrame data, if not, the sliding window slides forward by TsForming new in-window T at 2s momentsbReturning to execute the step 2 after the frame data and the measured data set Z are collected; otherwise the algorithm ends.
In this example implementation, FIG. 2 shows a real target and an estimated target in a single Monte Carlo simulation, with the real and estimated target outlines drawn every 10 frames, and the point targets represented by five-pointed stars. FIG. 2 demonstrates that ET-GP-PMHT can initialize PT and ET, track PT and ET simultaneously, and seamlessly track the interconversion between PT and ET. When PT is converted into ET, the target measurement number is increased, and ET-GP-PMHT can continuously track the position of a target even the shape of the ET and can track the deflection of the target.
FIG. 3 shows the position RMSE of the four targets, with the peak in RMSE due to dynamic model mismatch when targets 1, 2 transition between ET and PT, and target 4 being a contour-invariant ET with RMSE less than PT target 3 because target 4 can detect more measurements.
For better performance of the checking algorithm, in addition to RMSE, we can also calculate the following performance index: the average track number of the target; average initialization time delay, namely the time difference between the start of tracking the target and the start of the real target; average track termination delay. As shown in the following table:
TABLE 1
Performance index
|
Average number of tracks
|
Average initialization time delay
|
Average track end delay
|
Object |
1
|
2.08
|
0s
|
0s
|
Object 2
|
1.49
|
1.62s
|
0.1s
|
Target 3
|
1.2
|
1.02s
|
10.88s
|
Target 4
|
1
|
0.02s
|
12.38s |
ET-GP-PMHT was compared to ET-GP-PMHT-FBP26, ETGP-PMHT-FBP10, and ET-RM-PMHT. Target 1 has 10 measurement sources at 121s, as shown in fig. 5, ET-GP-PMHT and ET-GP-PMHT-FBP10 can better track the target profile, and the target profile estimated by ET-GP-PMHT-FBP26 is larger than the actual target profile; when the target 1 only has 2 measurement sources at 181s and 1 measurement source at 241s, the ET-GP-PMHT judges that the target is PT, and other algorithms still estimate the target shape of a closed curve; when the target measurement sources are more, such as 691s, ET-GP-PMHT and ET-GP-PMHT-FBP26 have better shape estimation.
Therefore, the ET-GP-PMHT-FBP is only suitable for tracking a target of a certain size, and the target shape estimated by the ET-RM-PMHT is elliptical regardless of the real ET shape even when the target is PT (see fig. 5, 6, 7, 8). The ET-GP-PMHT can simultaneously and stably track a large target, a small target and the PT, when the target shape in the graph 8 is not changed, the better tracking precision is kept, and the PT in the graph 7 can also be better tracked.
Finally, the above embodiments are only for illustrating the technical solutions of the present invention and are not limited, and all equivalent changes and modifications made in the claims of the present invention should be covered by the present invention.