CN115379560A - Target positioning and tracking method only under distance measurement information in wireless sensor network - Google Patents

Target positioning and tracking method only under distance measurement information in wireless sensor network Download PDF

Info

Publication number
CN115379560A
CN115379560A CN202211008876.1A CN202211008876A CN115379560A CN 115379560 A CN115379560 A CN 115379560A CN 202211008876 A CN202211008876 A CN 202211008876A CN 115379560 A CN115379560 A CN 115379560A
Authority
CN
China
Prior art keywords
target
information
distance measurement
distance
positioning
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202211008876.1A
Other languages
Chinese (zh)
Other versions
CN115379560B (en
Inventor
赵宣植
陈博
刘增力
张文
刘康
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kunming University of Science and Technology
Original Assignee
Kunming University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kunming University of Science and Technology filed Critical Kunming University of Science and Technology
Priority to CN202211008876.1A priority Critical patent/CN115379560B/en
Publication of CN115379560A publication Critical patent/CN115379560A/en
Application granted granted Critical
Publication of CN115379560B publication Critical patent/CN115379560B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W64/00Locating users or terminals or network equipment for network management purposes, e.g. mobility management
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W84/00Network topologies
    • H04W84/18Self-organising networks, e.g. ad-hoc networks or sensor networks
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02DCLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
    • Y02D30/00Reducing energy consumption in communication networks
    • Y02D30/70Reducing energy consumption in communication networks in wireless communication networks

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

The invention relates to a target positioning and tracking method only under distance measurement information in a wireless sensor network, belonging to the technical field of information fusion. For target positioning under only distance measurement information, the invention deduces covariance information of an error item, reconstructs a 0-mean error item, obtains optimal multilateral positioning by using a generalized least square method, and then integrates the optimal multilateral positioning and Kalman filtering to realize target tracking under only distance measurement information. The optimal multilateral positioning precision is superior to that of the prototype multilateral positioning; and the optimal multilateral Kalman filtering method is also superior to other methods, and has excellent tracking consistency under different noise and motion models.

Description

Target positioning and tracking method only under distance measurement information in wireless sensor network
Technical Field
The invention relates to a target positioning and tracking method only under distance measurement information in a wireless sensor network, belonging to the technical field of information fusion.
Background
Wireless sensor networks have been an active area of research. Various sensors, radars, sonars and the like are deployed to form a wireless sensor network, so that the wireless sensor network is widely applied. For example, vehicles carrying a sensor of a millimeter wave radar and other types of sensors realize automatic driving, autonomous underwater vehicles carry sensors to form a wireless sensing network for target tracking, unmanned aerial vehicle path planning and the like. An important application in wireless sensor networks is to realize the positioning and tracking of targets. For positioning and target tracking, due to the easy distributability of the sensor network, the sensors are arranged in areas without advanced infrastructure preparation, and tasks such as environment monitoring, safety monitoring, battlefield information acquisition and the like are injected. In addition, the sensor has the characteristics of small volume, light weight, mobility, convenience in deployment, strong real-time performance and the like, is suitable for being applied to various fields of military affairs, environmental monitoring, medical treatment and the like, and has wide application prospect.
In the wireless sensor network, each sensor can realize the positioning and tracking of the target by acquiring information such as distance measurement information, direction measurement information and the like, however, for some special application scenarios, only distance measurement information can be acquired, so that the problem of the target positioning and tracking of the wireless sensor network under the condition of only the distance measurement information is a research focus. In a radar wireless sensor network, the inverse synthetic aperture radar controls a range gate and an antenna direction by using the output of a distance measurement tracker only; due to the limitation of antenna aperture, high Frequency Ground Wave Radar (HFGWR) cannot provide antenna arrays of hundreds of meters or even thousands of meters to form narrow beams, so that the azimuth resolution is poor, and accurate azimuth information cannot be provided; the low frequency interference used in some passive radars, such as the "silent sentinel" system of rockschid martin, prevents them from providing accurate azimuth vignetting. Furthermore, range-only object location and tracking for multiple static or multiple single static sensors is considered to be a key technology for replacing large aperture antennas with low cost sensor networks in the future. In a wireless sensor network, ranging techniques such as time of arrival (DOA), time difference of arrival (TDOA), angle of arrival (AOA), and Received Signal Strength (RSS) are used to obtain range cropping information to achieve target location. In addition, the distance measurement information and the target state form a nonlinear mapping, namely Euclidean distance, so that only target tracking under the distance measurement information can be regarded as a nonlinear filtering problem. The nonlinear filtering has the problems of instability, complex linearization and the like, and the problems can influence the target tracking accuracy. Therefore, it is necessary to research the target positioning and tracking only under the information of the distance cultivator and improve the target tracking precision.
Disclosure of Invention
The invention provides a target positioning and tracking method only under distance measurement information in a wireless sensor network. For target positioning under the condition of only distance quantity information, the invention deduces covariance information of an error term, reconstructs a 0-mean error term, and then obtains optimal multilateral positioning by using a generalized least square method. By constructing pseudo-visual quantity, integrating optimal multilateral positioning and Kalman filtering, and using standard Kalman filtering to realize target tracking under only distance quantity information, instability of nonlinear filtering is avoided. The method can improve the target positioning precision under only distance measurement information and the target tracking precision left only by distance measurement, and solves the problems of instability and the like caused by nonlinear filtering.
In order to achieve the purpose, the invention is realized by the following technical scheme, which comprises the following specific steps:
step 1, acquiring distance measurement information between a moving target and each sensor by using m sensors which are deployed in space and only acquire distance information
Figure BDA0003809998610000021
Their deployment is not in-line. Distance observation information of moving object is obtained by deployed distance-only vision sensor
Figure BDA0003809998610000022
There are the following observation models:
Figure BDA0003809998610000023
Figure BDA0003809998610000024
Figure BDA0003809998610000025
Figure BDA0003809998610000026
Figure BDA0003809998610000027
where i =1,2,3.. M, denotes the i-th sensor, and m denotes the number of sensors in the wireless sensor network;
Figure BDA0003809998610000028
a distance nimble representing the view of the i-th sensor station at time k;
Figure BDA0003809998610000029
is the corresponding measurement noise, which is obeyed to a zero mean with a variance of
Figure BDA00038099986100000210
(ii) a gaussian distribution of; p x,k And P y,k Respectively representing the position of the target in the x direction and the y direction at the k time; s. the x,i And S y,i Respectively, the position of the ith sensor observation station in the x-direction and the y-direction.
Step 2, calculating first moment statistical information and second moment statistical information of error items in the distance measurement and segmentation equation set
Figure BDA00038099986100000211
Reconstructing a 0-mean error term e;
for the distance measurement information:
Figure BDA00038099986100000212
in the formula
Figure BDA00038099986100000213
It is indicated that during the movement of the object, at the time k, the range vignetting measured by the ith sensor,
Figure BDA00038099986100000214
distance measurement information representing the i-th sensor without noise interference.
Figure BDA00038099986100000215
Is shown as
Figure BDA0003809998610000031
P x,k And P y,k Respectively representing the position of the target in the x direction and the y direction at the k time; s x,i And S y,j Respectively representing the position of the ith sensor observation station in the x-direction and the y-direction,
Figure BDA0003809998610000032
is the corresponding measurement noise, which is obeyed to a zero mean with a variance of
Figure BDA0003809998610000033
A gaussian distribution of (a). It is also expressed by a standard normal distribution as:
Figure BDA0003809998610000034
wherein w 0 Obeying a standard normal distribution, k i Are coefficients to summarize the distribution of measurement noise at different variances.
From the above analysis, if the true distance information is known
Figure BDA0003809998610000035
Distance measurement information
Figure BDA0003809998610000036
Becomes a random variable whose distribution is gaussian centered around the true value:
Figure BDA0003809998610000037
in practice, only the true distance information can be estimated from the distance observation information. For the function expressed by the expression (10),
Figure BDA0003809998610000038
is a known parameter, and
Figure BDA0003809998610000039
is the only unknown variable, thus obtaining
Figure BDA00038099986100000310
The likelihood function of (a) is as follows:
Figure BDA00038099986100000311
from the above formula, it is found that
Figure BDA00038099986100000312
The likelihood function and the Gaussian probability density function have the same mathematical form, namely, the method obtains
Figure BDA00038099986100000313
Likelihood distribution of (2). Thus, for
Figure BDA00038099986100000314
Is provided with
Figure BDA00038099986100000315
The positions of the unknown target and the sensor satisfy the following equation (without accounting for observation noise):
Figure BDA00038099986100000316
Figure BDA00038099986100000317
Figure BDA00038099986100000318
Figure BDA00038099986100000319
Figure BDA00038099986100000320
wherein
Figure BDA00038099986100000321
Distance information of the i-th sensor observation station indicating no noise interference at time k.
Subtracting the ith equation in the above equation from the remaining equations yields:
Figure BDA00038099986100000322
Figure BDA00038099986100000323
Figure BDA00038099986100000324
Figure BDA00038099986100000325
the above formula is expanded and simplified to be rewritten into a matrix form:
Figure BDA0003809998610000041
the above formula is abbreviated as:
S=Mp k +U k
wherein:
Figure BDA0003809998610000042
p k =[p x,k p y,k ] T
in the above formula, S, M is the information known for determination, however U is
Figure BDA0003809998610000043
Since it contains the true distance
Figure BDA0003809998610000044
In practice
Figure BDA0003809998610000045
Is agnostic and thus
Figure BDA0003809998610000046
Information unknown to the user. In the case of sufficiently considering noise interference, U is a problem causing an assumption that the gaussian-markov theorem is not satisfied. In reality
Figure BDA0003809998610000047
Are not available. Can only pass through
Figure BDA0003809998610000048
And distance observation information containing noise interference
Figure BDA0003809998610000049
To obtain the relation between
Figure BDA00038099986100000410
Thereby estimating the position of the target.
Thus, by the step (2) for
Figure BDA00038099986100000411
And with
Figure BDA00038099986100000412
The following relationships exist:
Figure BDA00038099986100000413
the relevant information of the distance truth value is removed from the distance observation information containing noise interference, so that the state information of the target is more accurate.
Therefore, will solve for U
Figure BDA00038099986100000414
First order moment statistical information and second order moment statistical information of
Figure BDA00038099986100000415
I.e. to solve for
Figure BDA00038099986100000416
And
Figure BDA00038099986100000417
in the formula E [. C]D[·]And Cov [. C]Respectively, mathematical expectation, variance and covariance. And further constructing a 0 mean error term e to meet the assumption of the Gaussian-Markov theorem.
So for the first moment of U:
Figure BDA00038099986100000418
the second moment of U includes a second-order central moment and a second-order mixed moment. For the second central moment of U, there are:
Figure BDA0003809998610000051
for the second order mixing moments of U:
Figure BDA0003809998610000052
in summary, U is at r 1:i ,n 1:i Lower second moment
Figure BDA0003809998610000053
Has an analytic formula R · As follows.
Figure BDA0003809998610000054
The unified analytic formula (c) is as follows, and on this basis, the scenario of multiple sensors can be extended:
for 1 ≦ i, j ≦ m-1, i = j:
Figure BDA0003809998610000055
for I is less than or equal to I, j is less than or equal to m-1,i is not equal to j, the following:
Figure BDA0003809998610000056
i, j respectively represent covariance matrices
Figure BDA0003809998610000057
The row of (c), m is the total number of sensors,
Figure BDA0003809998610000058
and
Figure BDA0003809998610000059
respectively represent covariance matrices
Figure BDA00038099986100000510
Diagonal elements and non-diagonal elements which together form a covariance matrix
Figure BDA00038099986100000511
Covariance of U
Figure BDA00038099986100000512
Is the key to causing the hypothesis that the gaussian-markov theorem is not satisfied. Construction of 0 mean error term to S = Mp k +U k The formula satisfies the assumption of the gaussian-markov theorem. Constructing a random vector e as an error term, which is a mean of 0,
Figure BDA00038099986100000513
gaussian distribution of (a). The analysis was as follows: since E is 0 mean, there is E (U) + E = U, resulting from 0 mean gaussian distribution symmetry:
Figure BDA00038099986100000514
for the same specification of sensor, the distribution of the halo noise is the same, i.e. when all k are equal i When the phase difference is equal to each other,
Figure BDA00038099986100000515
the sum of c is recorded as s:
Figure BDA00038099986100000516
the corresponding specific S is as follows:
Figure BDA0003809998610000061
in summary, the optimal polygon positioning formula after reconstruction is:
S=Mp k +e
wherein
Figure BDA0003809998610000062
Step 3, obtaining the minimum variance unbiased estimation of the target position by using a generalized least square method;
optimal multilateration S = Mp after reconstruction k In + e, its error term e is the 0 mean, which satisfies the assumption of the gaussian-markov theorem. Therefore, by the generalized least squares method, the least variance unbiased estimate of the target state can be obtained:
Figure BDA0003809998610000063
Figure BDA0003809998610000064
the target minimum variance unbiased estimate is shown.
And 4, constructing pseudo measurement of the target position, and designing a corresponding Kalman filter to realize target tracking.
The second-order statistical information of the error term e provides a basis for realizing target tracking, and a target tracking estimator under the distance quantity is designed.
In the designed target tracking estimator under only distance halo measurement, the estimation of the target state is generated through at least three times of distance measurement and then pseudo measurement is constructed and combined with a Kalman filter. The method mainly comprises the following steps:
obtaining target minimum variance unbiased estimation
Figure BDA0003809998610000065
Meanwhile, the noise covariance of the target state estimation is:
Figure BDA0003809998610000066
to this end, the model of the target can be represented as: x k =F k-1 X k-1 +G k-1 W k-1 . On the basis of optimal multilateral positioning, pseudo-cut Z of a target is constructed k The measurement equation can expressComprises the following steps: z k =HX k +N k . Where Z is k The pseudo quantity nimble of the target position at time k obtained by the optimal multilateral positioning is shown. x is the number of k Is the target state, G k-1 Coefficient matrix of the corresponding dimension, W k-1 As covariance of Q k-1 Process noise of, N k As covariance of R k And W is k-1 Is irrelevant and H is the measurement matrix. R is k And H is as follows:
Figure BDA0003809998610000067
in order to achieve target tracking, the last step is to use the pseudo-sensing and corresponding noise information in combination with kalman filtering to update the state of the target. Therefore, the expression of the optimal multilateral positioning combined with kalman filtering to realize target tracking is as follows:
1) And (3) state prediction:
Figure BDA0003809998610000071
2) Prediction of covariance matrix:
Figure BDA0003809998610000072
3) Calculating a gain matrix:
Figure BDA0003809998610000073
4) And (3) updating the state:
Figure BDA0003809998610000074
5) And (3) updating the covariance matrix:
P k/k =(I 4×4 -K k H)P k/k-1
the obvious progress and the creative technical characteristics of the invention are as follows: through analysis and derivation, an optimal multilateral positioning method and a method for realizing target tracking by combining Kalman filtering are provided. Covariance information derived from the error term in optimal multilateration is exactly what is needed for noise covariance in kalman filtering. The optimal multilateral positioning is combined with Kalman filtering to realize real-time updating of the measured noise covariance along with the target motion in target tracking, and the method is different from the conventional filtering technology and improves the target tracking precision. A series of simulation researches show that the precision of the proposed optimal multilateral positioning is superior to that of the prototype multilateral positioning. The tracking algorithm combining optimal multilateral positioning and Kalman filtering is also superior to other methods in the aspect of tracking precision, and has excellent tracking consistency under different noise and motion models. The method can realize the positioning and tracking of the target in the wireless sensor network under the condition of only distance measurement, and has high precision and high consistency under different noise and motion models; the technical purpose is realized as follows: only the distance is stripped, and high-precision target positioning and tracking can be realized; the beneficial effects are that: according to the invention, only distance reclamation and measurement information is available, and target positioning and target tracking can be realized; the method solves the problems of target positioning under only distance measurement, instability caused by nonlinear filtering and the like.
Drawings
Fig. 1 is a general flow chart of the present invention.
FIG. 2 is a graph comparing the root mean square error of the positioning method of the present invention with the original multilateral positioning and the Cramer-Lo boundary.
FIG. 3 is a comparison graph of contour lines of the positioning method of the present invention and the original multilateral positioning method.
FIG. 4 is a comparison graph of the near-uniform linear motion trajectory of the target tracking method and different algorithms in the present invention.
FIG. 5 is a graph showing the result of the consistency of the target tracking method in the present invention under the condition of near-uniform linear motion.
FIG. 6 is a diagram showing the comparison of the position root mean square error of the target tracking method with different algorithms and the posterior Clalmelo boundary under the nearly uniform linear motion.
FIG. 7 is a graph comparing the root mean square error of the target tracking method with different algorithms and posterior Clalmelo boundaries under near uniform linear motion.
FIG. 8 is a comparison graph of the constant rate turning motion trajectory of the target tracking method and different algorithms in the present invention.
FIG. 9 is a graph showing the results of the consistency of the target tracking method in the present invention under a constant rate turning motion.
FIG. 10 is a graph comparing the position root mean square error of the target tracking method with different algorithms and the posterior Clarithrome bound under the constant velocity turning motion in the present invention.
FIG. 11 is a graph comparing the root mean square error of the velocity of the target tracking method with different algorithms and the posterior Clalmelo bound under constant rate turning motion.
FIG. 12 is a graph showing the result of the mean normalized estimation error squared under different noise variances in uniform linear motion according to the present invention.
FIG. 13 is a graph of the result of the mean normalized estimation error squared for different noise variances in constant rate cornering maneuvers for the target tracking method of the present invention.
Detailed Description
The invention is further described with reference to the following figures and specific examples.
Embodiment 1, as shown in fig. 1, a method for positioning and tracking a target in a wireless sensor network only with distance view information includes the following steps:
step 1-1, acquiring distance observation of moving target by using m sensors which are deployed in space and only acquire distance information
Figure BDA0003809998610000081
The deployment of the sensors is not on the same line, and the deployed sensor distance observation station acquires the distance observation information of the moving target
Figure BDA0003809998610000082
The distance measurement model of the sensor viewing station is as follows:
Figure BDA0003809998610000083
the motion state of the object is selected from the motion of a two-dimensional planar structure, where x k =[p x,k ,v x,k ,p y,k ,v y,k ] T Each representing the abscissa, the lateral velocity, the ordinate and the longitudinal velocity relative to a fixed coordinate system, the motion model of the object of the invention moving as follows:
x k =F k-1 x k-1 +G k-1 w k-1
wherein F k-1 Is a state transition matrix, x k Is composed of p x,k 、p y,k 、v x,k And v y,k Target state of equal correlation quantity, G k-1 A matrix of coefficients of corresponding dimensions, w k-1 Obey a zero mean with a covariance of Q k-1 And process noise of
Figure BDA0003809998610000091
Are not relevant.
Step 1-2, calculating a second order statistical information of error items in the distance measurement equation set
Figure BDA0003809998610000092
The 0-mean error term e is reconstructed.
Firstly, the distance measurement model is measured
Figure BDA0003809998610000093
Analysis is carried out to obtain information about
Figure BDA0003809998610000094
Likelihood distribution of (2); then, the distance is the second order statistical information of the error term in the equation set
Figure BDA0003809998610000095
The 0 mean error term e is reconstructed.
Step 1-3, obtaining the minimum variance unbiased estimation of the position by using a generalized least square method;
optimal multilateration S = Mp after reconstruction k + e, its errorThe difference term e is a 0-mean, which satisfies the assumption of the gaussian-markov theorem. Therefore, by the generalized least squares method, the least variance unbiased estimate of the target state can be obtained:
Figure BDA0003809998610000096
the least-squares unbiased estimate of the target location is shown.
Step 1-4, constructing a pseudo-measurement Z of the target position k And designing a corresponding Kalman filter to realize target tracking.
The second-order statistical information of the error term e provides a basis for realizing target tracking, and a target tracking estimator under only distance measurement is designed. In the designed target tracking estimator under only distance measurement, the estimation of the target state is generated by at least three times of distance measurement and then constructing a pseudo measurement combined with a Kalman filter. In the case of deriving the amount of statistical information for the error term e, the noise covariance of the target state estimate is:
Figure BDA0003809998610000097
to this end, the model of the target can be represented as: x is the number of k =F k-1 x k-1 +G k-1 w k-1 . The metrology model for converting a plurality of non-linear distance measurements to linear measurements with respect to the target location may be represented as: z is a radical of k =Hx k +N k . Where Z is k Representing a new measurement, x, at time k with respect to the target position transformed from a plurality of non-linear distance measurements k =[p x,k ,v x,k ,p y,k ,v y,k ] T Is the target state, G k-1 Coefficient matrix of the corresponding dimension, w k-1 Is covariance Q k-1 Process noise of, N k As covariance of R k Is equal to W k-1 Is irrelevant and H is the measurement matrix.
Example 2 the calculation was carried out according to the method in example 1, wherein 4 sensor stations are considered, which take only the distance reclamation as distinct, and their positions are (30,40) m, respectively; (0,150) m; (100, 150) m; (100, O) m. The target motion model is uniform linear motion (NCV) and constant velocity of a two-dimensional planeTurning motion (CT), initial state of [60m,1.5m/s,60m,2.5m/s]The running time step is 100 steps, gaussian white noise is added to the state in each time step, the noise is 2-dimensional, the obedient mean value is zero, and the variance is 1m 2 A gaussian distribution of (a).
The Root Mean Square Error (RMSE) is calculated as:
Figure BDA0003809998610000101
in the above formula, M represents the number of Monte Carlo experiments, N is the time step,
Figure BDA0003809998610000102
represents the estimated target state, x, at time k of the i-th trial k The real target state of the signal is represented, and | is | · | | | | represents the Frobenius norm of the matrix.
The measure of consistency analysis is the mean Normalized Estimation Error Squared (ANEES), which represents the stability of the filter and is calculated as:
Figure BDA0003809998610000103
where M represents the number of monte carlo experiments, the ANEES is close to 1 if the estimation error matches the estimation covariance, i.e. the filter is stable.
Assuming that the target starts to move in an initial state of 60m,1.5m/s,60m,2.5m/s, the method is compared with the conventional Unscented Kalman Filter (UKF) method, particle Filter (Particle Filter PF) method and post-test Claritol Bound (PCRLB) respectively, and 100-step and 100-time Monte Carlo experiments are carried out to calculate corresponding RMSE respectively.
For the simulation setup of target positioning, assume that the position deployment of the range sensors is as follows: sensor1 (30m, 100m), sensor2 (40m, 0m), sensor3 (50m, 120m) and sensor4 (0m, 30m). For the simulation results, root Mean Square Error (RMSE), position estimation Bias (Bias), and Cramer-Rao Lower Bound (CRLB) were used as performance evaluation indexes. The calculation formula of the root mean square error and the position estimation deviation is as follows:
Figure BDA0003809998610000104
Figure BDA0003809998610000105
here, the
Figure BDA0003809998610000106
The estimate for the target position obtained in the i-th experiment is shown, and M represents the number of monte carlo simulations. z denotes the actual position of the unknown object.
Fig. 2 shows a comparison of the root mean square error of the positioning of the unknown target [100,80] by the Optimal multilateral positioning (OM) of the positioning method of the present invention and other methods under 10000 monte carlo simulations under different observation noise conditions. As can be seen from fig. 2, under the different observation of nimble noise, the OM has a smaller root mean square error (PM) than the original multilateration (PM) and is closer to the lower boundary of cramer. Furthermore, as the measurement noise increases, the root mean square error of the OM also gets closer to the CRLB.
Fig. 3 shows a plot of the mean value of the target locations and their distribution contour obtained by locating an unknown target with OM and prototype multilateral locating PM under 10000 monte carlo simulations. Wherein, + and o represent OM and the positioning mean value of prototype multilateral positioning respectively, and Δ represents the actual position of the unknown target. The solid line and the dotted line respectively represent the contour lines of the respective distribution of OM and prototype multilateral positioning to the unknown target after positioning. As shown in fig. one, after OM and prototype multilateral positioning are subjected to monte carlo simulation, the OM estimates the target unit are closer to the actual unit, and the deviation of the prototype multilateral positioning from the target position is significantly larger than OM. The contour range of OM is smaller than that of the prototype multilateral localization, so the variance of OM estimation is smaller than that of the prototype multilateral localization estimation as a whole. In the central region, the contour of OM is observed to be contained by the contour of the prototype multilateral location, which further illustrates that the variance of the OM estimate is smaller than the variance of the prototype multilateral location estimate.
FIG. 4 is an optimal multilateration Kalman Filter (optimal-multilateration Kalman Filter) of the target tracking method of the present invention
Figure BDA0003809998610000111
OMKF) under uniform linear motion is compared with the track maps of different algorithms, and the OMKF can realize the tracking of the target.
Fig. 5 is a result diagram of tracking consistency of the target tracking method OMKF under uniform linear motion. The mean normalized estimation error square of the OMKF is 1, which shows that the designed filter is stable and effective.
The results of the mean square error tests of the position and the speed under the uniform linear motion are shown in fig. 6 and 7, respectively, wherein: the abscissa represents the step size and the ordinate represents the mean square error.
As seen in figure 6, the bit units Root Mean Square Error (RMSE) for all three methods decreased with increasing time in 100 monte carlo experiments, but the RMSE of the inventive method OMKF converged faster, significantly less than the other two algorithms and closer to the posterior cralmelo boundary.
In the speed root mean square error comparison of FIG. 7, the RMSE of the OMKF of the present invention is significantly less than that of the other methods and is closer to the posterior Cramer-Lo boundary, demonstrating the effectiveness of the method.
Fig. 8 is a comparison between the optimal multilateral kalman filtering OMKF of the target tracking method of the present invention and the trajectory diagrams of different algorithms under the constant velocity turning motion.
FIG. 9 is a graph of the tracking consistency results of the target tracking method OMKF of the present invention under constant rate cornering maneuvers. Under the constant-speed turning motion, the square of the average normalized estimation error of the OMKF is 1, which shows that the designed filter is stable and effective.
The results of the mean square error test of the position and the speed under the constant-speed turning motion are respectively shown in fig. 10 and fig. 11, wherein: the abscissa represents the step size and the ordinate represents the mean square error.
From fig. 10, it can be seen that the RMSE of the OMKF of the present invention method is smaller than the other two algorithms in the Root Mean Square Error (RMSE) of the three methods in 100 monte carlo experiments, and converges faster and closer to the posterior cralmelo boundary.
In the speed root mean square error comparison of FIG. 11, the RMSE of the OMKF of the present invention is significantly less than that of the other methods and is closer to the posterior Cramer-Lo boundary, demonstrating the effectiveness of the method.
Fig. 12 and 13 are graphs showing the results of the mean normalized estimation error squared of the target tracking method OMKF under different noise variances in different motion models in the present invention.
As seen from FIG. 12, the mean normalized estimation error square of the target tracking method OMKF in the invention is around 1 under different noise variances in uniform linear motion, which shows that the method of the invention is stable and effective under different noise conditions.
Similarly, as seen from fig. 13, the mean normalized estimation error square of the target tracking method OMKF in the constant velocity turning motion under different noise variances is also around 1, which shows that the method of the present invention is stable and effective under different noise conditions in different motion models.
In conclusion, the method can realize target tracking under the condition of only distance measurement and segmentation information, and has the advantages of small estimation error, and good stability and consistency.
While the present invention has been described in detail with reference to the embodiments, the present invention is not limited to the embodiments, and various changes can be made within the knowledge of those skilled in the art without departing from the spirit of the present invention.

Claims (4)

1. A target positioning and tracking method only under distance measurement information in a wireless sensor network is characterized in that: the method comprises the following specific steps:
step 1: obtaining distance measurement information between a moving target and each sensor by using m sensors which are deployed in space and only obtain distance information
Figure FDA0003809998600000011
The deployment of the sensors is not in-line;
step 2: for the distance measurement information
Figure FDA0003809998600000012
Analyzing and calculating the first moment statistical information and the second moment statistical information of the error items in the distance measurement equation set
Figure FDA0003809998600000013
Reconstructing a 0 mean error term e;
and step 3: obtaining a minimum variance unbiased estimate of a position using generalized least squares
Figure FDA0003809998600000014
And 4, step 4: constructing pseudo-measurements Z of target locations k And designing a corresponding Kalman filter to realize target tracking.
2. The method of claim 1, wherein the target is located and tracked in a wireless sensor network with only distance measurement information, and wherein the method comprises: the information about the distance measurement in step 2 is
Figure FDA0003809998600000015
Get about
Figure FDA0003809998600000016
The method of likelihood distribution of (1) is as follows:
for the distance measurement information:
Figure FDA0003809998600000017
in the formula
Figure FDA0003809998600000018
It shows the distance measurement measured by the ith sensor at the time k in the process of moving the target,
Figure FDA0003809998600000019
distance measurement information representing an ith sensor without noise interference;
Figure FDA00038099986000000110
is shown as
Figure FDA00038099986000000111
P x,k And P y,k Respectively representing the position of the target in the x direction and the y direction at the k time; s. the x,i And S y,i Respectively representing the position of the ith sensor observation station in the x-direction and the y-direction,
Figure FDA00038099986000000112
is the corresponding measurement noise, which is obeyed to a zero mean with a variance of
Figure FDA00038099986000000113
(ii) a gaussian distribution of; it is expressed by a standard normal distribution as:
Figure FDA00038099986000000114
wherein w 0 Obeying a standard normal distribution, k i Is a coefficient to generally represent the distribution of measurement noise under different variances;
from the above analysis, if the true distance information is known
Figure FDA00038099986000000115
Distance measurement information
Figure FDA00038099986000000116
Becomes a random variable whose distribution is gaussian centered around the true value:
Figure FDA00038099986000000117
in practice, only the actual distance information can be estimated according to the distance observation information; for the function expressed by the expression (10),
Figure FDA00038099986000000118
is a known parameter, and
Figure FDA00038099986000000119
is the only unknown variable, thus obtaining
Figure FDA00038099986000000120
The likelihood function of (a) is as follows:
Figure FDA00038099986000000121
by the formula as above, the compound has the advantages of high purity,
Figure FDA0003809998600000021
the likelihood function and the Gaussian probability density function have the same mathematical form, and obtain
Figure FDA0003809998600000022
Likelihood distribution of (2); therefore, for
Figure FDA0003809998600000023
Is provided with
Figure FDA0003809998600000024
The positions of the unknown target and the sensor satisfy the following equation:
Figure FDA0003809998600000025
wherein
Figure FDA0003809998600000026
Distance information of the ith sensor which shows no noise interference at the k moment;
subtracting the ith equation in the above equation from the remaining equations yields:
Figure FDA0003809998600000027
the above formula is simplified and rewritten into a matrix form:
Figure FDA0003809998600000028
the above formula is abbreviated as:
S=Mp k +U
wherein:
Figure FDA0003809998600000029
p k =[p x,k p y,k ] T
Figure FDA00038099986000000210
in the above formula, S, M is the information known for certain, however U is
Figure FDA00038099986000000211
Since it contains the true distance
Figure FDA00038099986000000212
In practice
Figure FDA00038099986000000213
Is agnostic and thus
Figure FDA00038099986000000214
Is unknown information; in the case of noise interference, U is an assumption that does not satisfy the gaussian-markov theorem; in reality
Figure FDA0003809998600000031
Is not available; can only pass through
Figure FDA0003809998600000032
And distance observation information containing noise interference
Figure FDA0003809998600000033
To obtain the relation between
Figure FDA0003809998600000034
Thereby estimating the position of the target;
for the
Figure FDA0003809998600000035
And
Figure FDA0003809998600000036
the following relationships exist:
Figure FDA0003809998600000037
the relevant information of the distance truth value is counted in the distance observation information containing the noise interference, so that the state information of the target is more accurate;
solve for U is
Figure FDA0003809998600000038
Of a second moment, i.e. solving
Figure FDA0003809998600000039
Figure FDA00038099986000000310
And
Figure FDA00038099986000000311
in the formula E [. C]、D[·]And Cov [. C]Respectively representing mathematical expectation, variance and covariance; further constructing a 0 mean error term e to meet the assumption of Gauss-Markov theorem;
so for the first moment of U:
Figure FDA00038099986000000312
the second moment of U has a second-order central moment and a second-order mixed moment. For the second central moment of U, there are:
Figure FDA00038099986000000313
for the second order mixing moments of U:
Figure FDA00038099986000000314
in summary, U is at r 1∶i ,n 1∶i Lower second moment
Figure FDA00038099986000000315
The analytic formula (2) R DEG is as follows;
Figure FDA00038099986000000316
the unified analytical formula (2) is shown below, and hereThe scenario is scalable to a maximum number of sensors on a basic basis:
for 1 ≦ i, j ≦ m-1, i = j:
Figure FDA0003809998600000041
for i is more than or equal to 1, j is more than or equal to m-1,i is not equal to j, the following components are provided:
Figure FDA0003809998600000042
i, j respectively represent covariance matrices
Figure FDA0003809998600000043
M is the total number of sensors,
Figure FDA0003809998600000044
and
Figure FDA0003809998600000045
respectively represent covariance matrices
Figure FDA0003809998600000046
Diagonal elements and non-diagonal elements which together form a covariance matrix
Figure FDA0003809998600000047
Covariance of U
Figure FDA0003809998600000048
Is the key to causing the hypothesis that the gaussian-markov theorem is not satisfied; construction of 0 mean error term to S = Mp k +U k The formula satisfies the assumption of the Gauss-Markov theorem; constructing a random vector e as an error term, which is a mean of ●,
Figure FDA0003809998600000049
(ii) a gaussian distribution of;
since E is 0 mean, there is E (U) + E = U, resulting from 0 mean gaussian distribution symmetry:
Figure FDA00038099986000000410
for sensors of the same specification, the distribution of the measurement noise is the same, i.e. when all k are equal i When the phase difference is equal to each other,
Figure FDA00038099986000000411
and the sum of c is recorded as S:
Figure FDA00038099986000000412
the corresponding specific S is as follows:
Figure FDA00038099986000000413
in summary, the optimal polygon positioning formula after reconstruction is:
S=Mp k +e
wherein
Figure FDA00038099986000000414
3. The method of claim 1, wherein the target is located and tracked in a wireless sensor network with only distance measurement information, and wherein the method comprises: the specific process of the step 3 is as follows:
optimal multilateration S = Mp after reconstruction k In + e, the error term e is the mean value of 0, which meets the assumption of Gauss-Markov theorem; obtaining the minimum variance unbiased estimation of the target state by a generalized least square method:
Figure FDA0003809998600000051
Figure FDA0003809998600000052
the target minimum variance unbiased estimate is shown.
4. The method of claim 1, wherein the target is located and tracked in a wireless sensor network with only distance measurement information, and wherein the method comprises: the specific process of the step 4 is as follows:
second moment statistics of error term e
Figure FDA00038099986000000510
Providing a basis for realizing target tracking, and designing a target tracking estimator only under distance measurement; in a designed target tracking estimator under only distance measurement, the estimation of a target state is generated by at least three times of distance measurement and then constructing a pseudo measurement combined with a Kalman filter; the method mainly comprises the following steps:
obtaining target minimum variance unbiased estimation
Figure FDA0003809998600000053
Meanwhile, the noise covariance of the target state estimation is:
Figure FDA0003809998600000054
to this end, the model of the target may be expressed as: x is the number of k =F k-1 x k-1 +G k-1 W k-1 (ii) a On the basis of optimal multilateral positioning, pseudo-measurement Z of a target is constructed k The measurement equation is expressed as: z k =Hx k +N k (ii) a Where Z is k A pseudo-metric representing the target location at time k from the optimal multilateration; x is a radical of a fluorine atom k Is the target state, G k-1 Coefficient matrix of the corresponding dimension, W k-1 As covariance of Q k-1 Process noise of, N k As covariance of R k And W is k-1 Is irrelevant, H is the measurement matrix; r is k And H is as follows:
Figure FDA0003809998600000055
in order to realize target tracking, the last step is to use pseudo measurement and corresponding noise information to update the state of the target in combination with Kalman filtering; therefore, the expression of the optimal multilateral positioning combined with kalman filtering to realize target tracking is as follows:
1) And (3) state prediction:
Figure FDA0003809998600000056
2) Prediction of covariance matrix:
Figure FDA0003809998600000057
3) Calculating a gain matrix:
Figure FDA0003809998600000058
4) And (3) updating the state:
Figure FDA0003809998600000059
5) Covariance matrix update:
P k/k =(I 4×4 -K k H)P k/k-1
CN202211008876.1A 2022-08-22 2022-08-22 Target positioning and tracking method in wireless sensor network under condition of only distance measurement information Active CN115379560B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211008876.1A CN115379560B (en) 2022-08-22 2022-08-22 Target positioning and tracking method in wireless sensor network under condition of only distance measurement information

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211008876.1A CN115379560B (en) 2022-08-22 2022-08-22 Target positioning and tracking method in wireless sensor network under condition of only distance measurement information

Publications (2)

Publication Number Publication Date
CN115379560A true CN115379560A (en) 2022-11-22
CN115379560B CN115379560B (en) 2024-03-08

Family

ID=84068621

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211008876.1A Active CN115379560B (en) 2022-08-22 2022-08-22 Target positioning and tracking method in wireless sensor network under condition of only distance measurement information

Country Status (1)

Country Link
CN (1) CN115379560B (en)

Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1995916A (en) * 2006-12-27 2007-07-11 北京航空航天大学 Integrated navigation method based on star sensor calibration
US20110105161A1 (en) * 2008-03-27 2011-05-05 Sics, Swedish Institute Of Computer Science Ab Method for localization of nodes by using partial order of the nodes
US20140106776A1 (en) * 2010-05-24 2014-04-17 Nice-Systems Ltd. Method and system for estimation of mobile station velocity in a cellular system based on geographical data
CN105676181A (en) * 2016-01-15 2016-06-15 浙江大学 Underwater moving target extended Kalman filtering tracking method based on distributed sensor energy ratios
CN107193028A (en) * 2017-03-29 2017-09-22 中国航空无线电电子研究所 Kalman relative positioning methods based on GNSS
CN108318856A (en) * 2018-02-02 2018-07-24 河南工学院 The target positioning of fast accurate and tracking under a kind of heterogeneous network
CN109508445A (en) * 2019-01-14 2019-03-22 哈尔滨工程大学 A kind of method for tracking target for surveying noise and variation Bayesian adaptation Kalman filtering with colo(u)r specification
CN109829938A (en) * 2019-01-28 2019-05-31 杭州电子科技大学 A kind of self-adapted tolerance volume kalman filter method applied in target following
CN110501696A (en) * 2019-06-28 2019-11-26 电子科技大学 A kind of radar target tracking method based on Doppler measurements self-adaptive processing
CN111328015A (en) * 2020-01-28 2020-06-23 浙江大学 Wireless sensor network target tracking method based on Fisher information distance
CN113567918A (en) * 2021-02-25 2021-10-29 昆明理工大学 Sensor network target tracking method combining trilateration and U transformation
CN114217339A (en) * 2021-11-18 2022-03-22 中铁第四勘察设计院集团有限公司 Positioning method, positioning device, electronic equipment and storage medium
CN114384569A (en) * 2022-01-12 2022-04-22 腾讯科技(深圳)有限公司 Terminal positioning method, device, equipment and medium
CN114705223A (en) * 2022-04-02 2022-07-05 上海交通大学 Inertial navigation error compensation method and system for multiple mobile intelligent bodies in target tracking
CN114729982A (en) * 2019-08-23 2022-07-08 三星电子株式会社 Method and device for positioning

Patent Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1995916A (en) * 2006-12-27 2007-07-11 北京航空航天大学 Integrated navigation method based on star sensor calibration
US20110105161A1 (en) * 2008-03-27 2011-05-05 Sics, Swedish Institute Of Computer Science Ab Method for localization of nodes by using partial order of the nodes
US20140106776A1 (en) * 2010-05-24 2014-04-17 Nice-Systems Ltd. Method and system for estimation of mobile station velocity in a cellular system based on geographical data
CN105676181A (en) * 2016-01-15 2016-06-15 浙江大学 Underwater moving target extended Kalman filtering tracking method based on distributed sensor energy ratios
CN107193028A (en) * 2017-03-29 2017-09-22 中国航空无线电电子研究所 Kalman relative positioning methods based on GNSS
CN108318856A (en) * 2018-02-02 2018-07-24 河南工学院 The target positioning of fast accurate and tracking under a kind of heterogeneous network
CN109508445A (en) * 2019-01-14 2019-03-22 哈尔滨工程大学 A kind of method for tracking target for surveying noise and variation Bayesian adaptation Kalman filtering with colo(u)r specification
CN109829938A (en) * 2019-01-28 2019-05-31 杭州电子科技大学 A kind of self-adapted tolerance volume kalman filter method applied in target following
CN110501696A (en) * 2019-06-28 2019-11-26 电子科技大学 A kind of radar target tracking method based on Doppler measurements self-adaptive processing
CN114729982A (en) * 2019-08-23 2022-07-08 三星电子株式会社 Method and device for positioning
CN111328015A (en) * 2020-01-28 2020-06-23 浙江大学 Wireless sensor network target tracking method based on Fisher information distance
CN113567918A (en) * 2021-02-25 2021-10-29 昆明理工大学 Sensor network target tracking method combining trilateration and U transformation
CN114217339A (en) * 2021-11-18 2022-03-22 中铁第四勘察设计院集团有限公司 Positioning method, positioning device, electronic equipment and storage medium
CN114384569A (en) * 2022-01-12 2022-04-22 腾讯科技(深圳)有限公司 Terminal positioning method, device, equipment and medium
CN114705223A (en) * 2022-04-02 2022-07-05 上海交通大学 Inertial navigation error compensation method and system for multiple mobile intelligent bodies in target tracking

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
XUSHENG YANG; WEN-AN ZHANG; BO CHEN; LI YU: ""A bank of sequential unscented Kalman Filters for target tracking in range-only WSNs"", 《2017 13TH IEEE INTERNATIONAL CONFERENCE ON CONTROL & AUTOMATION (ICCA)》, 7 August 2017 (2017-08-07) *
刘康: ""贝叶斯滤波的概率似然乘积方法研究"", 《中国优秀硕士学位论文全文数据库(电子期刊)》, 15 January 2019 (2019-01-15) *
张文: ""PHD多目标跟踪的概率似然积实现方法研究"", 《《中国优秀硕士学位论文全文数据库(电子期刊)》》, 15 April 2020 (2020-04-15) *
张文;赵宣植;刘增力;金文骏: ""稀疏高斯厄米特PHD机动多目标跟踪算法"", 《信息与控制》, 15 June 2019 (2019-06-15) *
陈博;岳凯;王如生;胡明南: ""基于学习策略的多速率多传感器融合定位方法"", 《航空学报》, 19 March 2022 (2022-03-19) *
陈博;李擎: ""多传感器融合在无人机室内三维定位中的应用"", 《传感器世界》, 25 March 2022 (2022-03-25) *

Also Published As

Publication number Publication date
CN115379560B (en) 2024-03-08

Similar Documents

Publication Publication Date Title
CN107315171B (en) Radar networking target state and system error joint estimation algorithm
Nguyen et al. Algebraic solution for stationary emitter geolocation by a LEO satellite using Doppler frequency measurements
CN113342059B (en) Multi-unmanned aerial vehicle tracking mobile radiation source method based on position and speed errors
RU2660498C1 (en) Method of tracking of airborne maneuvering radiation sources according to angle information from airborne single-position electronic reconnaissance system
Agate et al. Road-constrained target tracking and identification using a particle filter
CN108134640A (en) A kind of co-positioned system and method based on joint movements state constraint
Aernouts et al. Combining TDoA and AoA with a particle filter in an outdoor LoRaWAN network
CN108871365B (en) State estimation method and system under course constraint
CN113325452A (en) Method for tracking maneuvering target by using three-star passive fusion positioning system
NGOC et al. Evaluating process and measurement noise in extended Kalman filter for GNSS position accuracy
He et al. Bias compensation for AOA-geolocation of known altitude target using single satellite
Alkhatib et al. Further results on a robust multivariate time series analysis in nonlinear models with autoregressive and t-distributed errors
Li et al. A novel single satellite passive location method based on one-dimensional cosine angle and Doppler rate of changing
Beck et al. Real-time, anchor-free node tracking using ultrawideband range and odometry data
Mallick et al. Comparison of measures of nonlinearity for bearing-only and GMTI filtering
CN115379560A (en) Target positioning and tracking method only under distance measurement information in wireless sensor network
CN110595470A (en) Pure orientation target tracking method based on external bounding ellipsoid collective estimation
CN114705223A (en) Inertial navigation error compensation method and system for multiple mobile intelligent bodies in target tracking
Oliveira et al. GNSS-denied joint cooperative terrain navigation and target tracking using factor graph geometric average fusion
Wang et al. Bias compensation Kalman filter for 3D angle-only measurements target traking
Kaune Gaussian Mixture (GM) Passive Localization using Time Difference of Arrival (TDOA).
Moawad et al. Study a bearing-only moving ground target tracking problem using single seismic sensor
CN105259564B (en) A kind of spaceborne and poor amplitude-comparison monopulse DF and location method, apparatus and system
Li et al. Particle filter based synthetic aperture reconstruction approach for real-time 3D wireless local positioning
Wang et al. Heterogeneous Sensor-Based Target Tracking With Constant Time Delay

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant