CN110749879A - Distributed target tracking method based on multi-observer speed measurement information - Google Patents

Distributed target tracking method based on multi-observer speed measurement information Download PDF

Info

Publication number
CN110749879A
CN110749879A CN201911007086.XA CN201911007086A CN110749879A CN 110749879 A CN110749879 A CN 110749879A CN 201911007086 A CN201911007086 A CN 201911007086A CN 110749879 A CN110749879 A CN 110749879A
Authority
CN
China
Prior art keywords
target
observer
tracking
result
information
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
CN201911007086.XA
Other languages
Chinese (zh)
Other versions
CN110749879B (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.)
Beijing Qingyun Zhichuang Technology Co ltd
Original Assignee
Beijing One Hydrogen Technology Co Ltd
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 Beijing One Hydrogen Technology Co Ltd filed Critical Beijing One Hydrogen Technology Co Ltd
Priority to CN201911007086.XA priority Critical patent/CN110749879B/en
Publication of CN110749879A publication Critical patent/CN110749879A/en
Application granted granted Critical
Publication of CN110749879B publication Critical patent/CN110749879B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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

Abstract

The invention provides a distributed target tracking method based on multi-observer speed measurement information, which comprises four stages: local target positioning stage: firstly, each observer carries out positioning calculation on a target by utilizing the relative angle and relative distance information observed by the observer to obtain a local positioning result of the target; and (3) information communication stage: each observer sends the local positioning result to the fusion center, and the fusion center obtains a global positioning result after integrating the information of all the observers and feeds the result back to each observer; a local target tracking stage: performing target tracking calculation again on the target by using the global positioning result obtained by feedback in the stage 2 and the relative axial speed information observed by the target, so as to obtain a local tracking result of the target; and (3) information communication stage: and each observer sends the local tracking result to the fusion center, and the fusion center obtains a global tracking result after integrating the information of all the observers and feeds the result back to each observer.

Description

Distributed target tracking method based on multi-observer speed measurement information
Technical Field
The invention relates to the field of target tracking and positioning, in particular to a distributed target tracking method based on multi-observer speed measurement information.
Background
The target tracking problem is caused by the occurrence of radar stations, the occurrence of SCR-28 of the first tracking radar station in British before the second war in 1937 marks the formal occurrence of the target tracking problem, and various tracking technical means including target tracking systems such as radar, laser, infrared and sonar are developed successively later, and the technical means are continuously improved in the future development. Earlier, the target tracking technology was not well known, and until the 70 s, after the kalman filtering theory was successfully applied in the field of target tracking, people generally paid attention to the maneuvering target tracking technology and generated great interest. Later, the maneuvering target tracking technology is rapidly developed, and is one of the most popular fields of domestic and foreign research. In recent decades, new technologies such as extended kalman filtering, multi-model algorithms, and particle filtering have been developed and developed in order to meet the needs of science and technology and applications. With the development of the times, the related sensor technology is also continuously improved. The current target tracking sensor can acquire information such as a relative distance and a relative angle of a target, and can measure a relative axial velocity (a velocity component in a target-observer connecting line direction) of the target in real time to acquire the relative axial velocity of the target.
Disclosure of Invention
In order to further enhance the target tracking performance, the method introduces the relative axial speed information into the target tracking system, and can greatly improve the tracking capability and the tracking precision of the target; meanwhile, the same target is tracked by adopting a multi-observer cooperative observation mode, and the accuracy and stability of target tracking can be more effectively improved by utilizing the information of multiple observers, so that distributed target tracking and positioning under the condition that the speed measurement information of multiple observers exists are realized.
The purpose of the invention is realized by the following technical scheme:
a distributed target tracking method based on multi-observer speed measurement information comprises the following steps:
step 1: local target positioning stage: each observer estimates the position information of the target by using the target relative angle and the target relative distance information received by the observer to obtain a local positioning result of the observer;
step 2: and (3) information communication stage: each observer sends the local positioning result of the observer per se in the step 1 to a fusion center, the fusion center obtains a global positioning result after integrating the information of all the observers, and the result is fed back to each observer;
and step 3: a local target tracking stage: performing target tracking calculation again on the target by using the global positioning result obtained by feedback in the step 2 and the relative axial speed information observed by the target, so as to obtain a local tracking result of the target;
and 4, step 4: and (3) information communication stage: each observer sends the local tracking result of the observer in the step 3 to a fusion center, the fusion center obtains a global tracking result after integrating the information of all the observers, and the result is fed back to each observer;
and 5: and finishing the target tracking calculation of the current step and outputting a target tracking result.
Further, the specific method for obtaining the local positioning result in step 1 is as follows:
using the object localization model, the r sensed by observer a at time ka(k),θa(k),
Figure BDA0002243092380000025
As the filtering input, the extended kalman filtering algorithm (EKF) is used for filtering estimation to obtain the local target positioning result of the observer a in the target positioning stage at the moment k
Figure BDA0002243092380000021
The positioning error covariance matrix P corresponding theretoa(k) In that respect Take observer a as an example, and so on for the rest of the observers.
Further, the target location model is:
x1(k+1)＝Φ1x1(k)+w1(k)
z1(k)＝H1(x1(k))+r1(k)
the corresponding state vector and state transition matrix are:
sequentially setting the target three-axis position and the target three-axis speed under X, Y and Z axes;
Figure BDA0002243092380000023
t is the system sampling interval, and the state error w (k) is zero-mean Gaussian white noise of the corresponding dimension;
the corresponding observation vectors are:
Figure BDA0002243092380000024
namely a target relative distance, a target relative azimuth angle and a target relative pitch angle; the corresponding observation matrix is:
r1(k) the measurement noise of the corresponding dimension is zero mean Gaussian white noise;
Figure BDA0002243092380000032
at time k, tester a is in its own triaxial position.
Further, in the information communication stage in step 2, all observers send their own positioning results and corresponding positioning error covariance matrices to the fusion center, and in the calculation at time k, the fusion center may receive the following information:
Figure BDA0002243092380000033
Pa(k)，
Figure BDA0002243092380000034
Pb(k)，
Figure BDA0002243092380000035
Pc(k)；
based on the above information, the following fusion calculation is made:
P(k)＝((Pa(k))-1+(Pb(k))-1+Pc(k)-1)-1
wherein the content of the first and second substances,
Figure BDA0002243092380000037
p (k) is a covariance matrix of the positioning error of the fused positioning result; on the basis of the above, the fusion center will
Figure BDA0002243092380000038
And P (k) is fed back to the observers a, b, c.
Further, the target tracking calculation method in step 3 is as follows:
firstly, estimating a relative angle of a target by using a global positioning result obtained by feedback in the step 2;
then, dv sensed by the observer a at time k is analyzed by the target tracking modela(k) As filtering input, EKF calculation is carried out by using the target tracking model to obtain the local target tracking result of the observer a in the target tracking stage at the moment kThe covariance matrix of tracking error corresponding thereto
Figure BDA00022430923800000310
Further, the specific method for estimating the target relative angle by using the global positioning result obtained by feedback in step 2 in step 3 is as follows: take observer a as an example, and the rest observers are analogized by analogy;
θ1and
Figure BDA0002243092380000041
the calculated relative azimuth angle and the calculated relative pitch angle are both
Figure BDA0002243092380000042
And calculating to obtain the following results:
Figure BDA0002243092380000043
Figure BDA0002243092380000044
wherein
Figure BDA0002243092380000045
And
Figure BDA0002243092380000046
are respectively as
Figure BDA0002243092380000047
The 1 st 2 nd and 3 rd elements in (b).
Further, the target tracking model in step 3 is:
x2(k+1)＝Φ2x2(k)+w2(k)
z2(k)＝H2(x2(k))+r2(k)
the corresponding state vector and state transition matrix are:
Figure BDA0002243092380000048
sequentially setting target three-axis speed and target three-axis acceleration under X, Y and Z axes;
Figure BDA0002243092380000049
the corresponding observation vectors are: z2(k)＝[dv]TI.e. target relative axial velocity; the corresponding observation matrix is:
further, in the information communication stage in step 4, all observers send their tracking results and corresponding tracking error covariance matrices to the fusion center, and in the calculation at time k, the fusion center may receive the following information:
Figure BDA0002243092380000053
based on the above information, the following fusion calculation is made:
Figure BDA0002243092380000051
Figure BDA0002243092380000054
wherein the content of the first and second substances,for fused trace results, P2(k) And the covariance matrix of the positioning error of the fused tracking result is fed back to each observer by the fusion center.
The input of the target tracking algorithm of the invention additionally introduces the relative axial velocity of the target besides the information of the relative angle and the relative distance of the target; the target tracking algorithm is a distributed algorithm under the condition that multiple observers exist, and the calculation of target tracking is not only executed in a fusion center, but also executed locally by the observers; the target tracking algorithm comprises two tracking calculations and two communication between an observer and a fusion center, wherein the first tracking calculation is mainly used for estimating the position of a target, and the communication content of the first communication is the result of the first tracking calculation; the second tracking calculation is mainly used for estimating the speed and the acceleration of the target, and the communication content of the second communication is the result of the second tracking calculation; and the final output of the algorithm is the target tracking result after the second communication.
Compared with the prior art, the invention has the beneficial effects that:
1. compared with the traditional target tracking algorithm, the method has the advantages that the tracking accuracy and the tracking stability of the target tracking algorithm are remarkably improved by introducing the target axial speed observed quantity and introducing multiple observers;
2. the distributed algorithm architecture is adopted, so that on one hand, the complexity of calculation is reduced, and the operation efficiency is improved; on the other hand, the robustness of the target tracking system is enhanced, and the stability of the algorithm is enhanced;
3. the method adopts a target tracking calculation mode of two-stage calculation, effectively reduces the calculation complexity and the coupling between the parameters to be estimated, and is more convenient to apply in engineering practice.
Drawings
FIG. 1 is a block diagram of a distributed target tracking algorithm designed in the present invention;
FIG. 2 is a timing diagram of a distributed target tracking algorithm according to the present invention;
FIG. 3 is a schematic diagram of simulation of an operation result of the distributed target tracking algorithm of the present invention 1;
FIG. 4 is a schematic diagram of simulation of an operation result of the distributed target tracking algorithm of the present invention 2;
FIG. 5 is a schematic diagram of simulation of the operation result of the distributed target tracking algorithm of the present invention 3;
fig. 6 is a schematic diagram 4 illustrating simulation of an operation result of the distributed target tracking algorithm according to the present invention.
FIG. 7 is a schematic diagram 5 illustrating simulation of the operation result of the distributed target tracking algorithm according to the present invention;
fig. 8 is a schematic diagram 6 illustrating simulation of an operation result of the distributed target tracking algorithm according to the present invention.
Detailed Description
The invention is described in detail below by way of example with reference to the accompanying drawings.
The embodiment provides a distributed target tracking method based on multi-observer speed measurement information, and the overall flow block diagram of the method is shown in fig. 1, and the system timing diagram is shown in fig. 2.
For convenience of subsequent description, the following definitions are made in this embodiment:
defining that 3 observers in the system observe the target, which are named as a, b and c respectively (it should be noted that the method of the present invention is not limited to 3 observers, and the method of the present invention can also be extended to the case where more observers exist); at time k, the obtained corresponding observation information is sequentially:
Figure BDA0002243092380000061
wherein r isa(k),θa(k),dva(k) Sequentially and respectively obtaining a target relative distance, a target relative azimuth angle, a target relative pitch angle and a target relative axial speed of the observer a at the moment k;
wherein r isb(k),θb(k),
Figure BDA0002243092380000064
dvb(k) Sequentially and respectively obtaining a target relative distance, a target relative azimuth angle, a target relative pitch angle and a target relative axial speed of the observer b at the moment k;
Figure BDA0002243092380000065
wherein r isa(k),θa(k),dva(k) The relative distance of the target, the relative azimuth angle of the target, the relative pitch angle of the target and the relative axial velocity of the target obtained by the observer c at the time k are sequentially and respectively.
At time k, the motion information of three observers is:
observer a: three-axis positions of the self-body are
Figure BDA0002243092380000067
Self triaxial velocity of
Figure BDA0002243092380000068
Observer b: three-axis positions of the self-body are
Figure BDA0002243092380000071
Self triaxial velocity of
An observer c: three-axis positions of the self-body are
Figure BDA0002243092380000073
Self triaxial velocity of
Figure BDA0002243092380000074
The movement information of the observer is provided by a navigation system equipped with the observer.
Step 1: local target positioning stage: and each observer estimates the position information of the target by using the target relative angle and the target relative distance information received by the observer to obtain a local positioning result of the observer.
The following description will be made by taking the calculation flow of the observer a as an example:
firstly, the following target positioning model is constructed:
x1(k+1)＝Φ1x1(k)+w1(k)
z1(k)＝H1(x1(k))+r1(k)
the corresponding state vector and state transition matrix are:
Figure BDA0002243092380000075
sequentially setting the target three-axis position and the target three-axis speed under X, Y and Z axes;
Figure BDA0002243092380000076
t is the system sampling interval, and the state error w (k) is zero-mean white Gaussian noise of the corresponding dimension.
The corresponding observation vectors are:
Figure BDA0002243092380000077
namely a target relative distance, a target relative azimuth angle and a target relative pitch angle; the corresponding observation matrix is:
Figure BDA0002243092380000081
r1(k) the measurement noise corresponding to the dimension is zero mean white gaussian noise.
Using the object localization model described above, the r sensed by observer a at time k is measureda(k),θa(k),
Figure BDA0002243092380000082
As the filtering input, the extended kalman filtering algorithm (EKF) is used for filtering estimation to obtain the local target positioning result of the observer a in the target positioning stage at the moment k
Figure BDA0002243092380000083
The positioning error covariance matrix P corresponding theretoa(k) In that respect The EKF algorithm is a commonly used nonlinear filtering algorithm, and is specifically described as follows:
for a nonlinear continuous discrete system as follows:
Xk+1＝f(Xk)+wk
Zk＝h(Xk)+vk
wherein, XkIs a system state, ZkFor systematic observation of information, randomVariable wkAnd vkThe noise is the process noise and the measurement noise of the system respectively, and is the zero mean value Gaussian white noise which is independent from each other. Wherein, the variance of the process noise is Q, and the variance of the measurement noise is R. f is the sum system state variable X in the state equationkA time k dependent nonlinear function; h is the sum state variable X in the observation equationkA non-linear function related to time k.
Applying an EKF algorithm to the model:
Pk,k-1＝APk-1AT+Q
Kk＝Pk,k-1HT[HPk,k-1HT+R]-1
Figure BDA0002243092380000085
Pk＝[I-KkH]Pk,k-1
wherein the content of the first and second substances,
Figure BDA0002243092380000091
represents the result of the filtering of the previous step,
Figure BDA0002243092380000092
one-step prediction of the representative state, Pk,k-1Representing the one-step prediction error variance, KkRepresenting the filter gain, PkRepresenting the current step filter error variance, Pk-1Representing the filtering error variance of the k-1 step; i represents an identity matrix of corresponding dimension, wherein A and H represent f and H respectively
Figure BDA0002243092380000093
The jacobian matrix is a matrix in which the first partial derivatives of a function commonly used in mathematics are arranged in a certain way.
The same operations are performed for observers b and c, and the result isPositioning result of observer b in this step
Figure BDA0002243092380000094
The positioning error covariance matrix P corresponding theretob(k) And the positioning result of the observer c in the current step
Figure BDA0002243092380000095
The positioning error covariance matrix P corresponding theretoc(k)。
Step 2: and (3) information communication stage: and (3) each observer sends the local positioning result of the observer to the fusion center in the step (1), the fusion center obtains a global positioning result after integrating the information of all the observers, and the result is fed back to each observer.
After the calculation in step 1 is completed, all observers send their local positioning results and the corresponding positioning error covariance matrix to the fusion center, and in the calculation at time k, the fusion center can receive the following information:
Figure BDA0002243092380000096
Pa(k)，
Figure BDA0002243092380000097
Pb(k)，
Figure BDA0002243092380000098
Pc(k) in that respect Here, 3 observers are taken as an example for explanation, and it should be noted that the method can be extended to a case where more observers exist.
Based on the above information, the following fusion calculation is made:
Figure BDA0002243092380000099
P(k)＝((Pa(k))-1+(Pb(k))-1+Pc(k)-1)-1
wherein the content of the first and second substances,
Figure BDA00022430923800000910
p (k) is a covariance matrix of the positioning error of the fused positioning result. On the basis of the above, the fusion center will
Figure BDA00022430923800000911
And P (k) is fed back to the observers a, b, c.
Meanwhile, in order to further improve the target precision and stability for a long time, each observer replaces the local result of the observer with a global result, namely:
observer a:
Figure BDA0002243092380000101
Pa(k)＝P(k)
observer b:
Figure BDA0002243092380000102
Pb(k)＝P(k)
an observer c:
Figure BDA0002243092380000103
Pc(k)＝P(k)。
and step 3: a local target tracking stage: and (3) performing target tracking calculation again on the target by using the global positioning result obtained by feedback in the step (2) and the relative axial speed information observed by the target, so as to obtain a local tracking result of the target.
The following description will be made by taking the calculation flow of the observer a as an example:
firstly, estimating a target relative angle by using a positioning result obtained by feedback in the step 2, and as follows:
θ1and
Figure BDA0002243092380000104
the calculated relative azimuth angle and the calculated relative pitch angle are both
Figure BDA0002243092380000105
And calculating to obtain the following results:
Figure BDA0002243092380000106
Figure BDA0002243092380000107
whereinAnd
Figure BDA0002243092380000109
are respectively as
Figure BDA00022430923800001010
The 1 st 2 nd and 3 rd elements in (b).
Based on the above calculation results, the target tracking model is introduced as follows:
x2(k+1)＝Φ2x2(k)+w2(k)
z2(k)＝H2(x2(k))+r2(k)
the corresponding state vector and state transition matrix are:
sequentially setting target three-axis speed and target three-axis acceleration under X, Y and Z axes;
Figure BDA0002243092380000111
the corresponding observation vectors are: z2(k)＝[dv]TI.e. target relative axial velocity; the corresponding observation matrix is:
Figure BDA0002243092380000112
dv sensed by observer a at time k is measured using the above modela(k) As filtering input, EKF calculation is carried out by using the target tracking model to obtain the local target tracking result of the observer a in the target tracking stage at the moment kThe covariance matrix of tracking error corresponding thereto
Figure BDA0002243092380000114
The same operation is carried out on observers b and c, and the tracking result of the observer b in the step can be obtained
Figure BDA0002243092380000115
The covariance matrix of tracking error corresponding thereto
Figure BDA0002243092380000116
And the tracking result of the observer c in the current step
Figure BDA0002243092380000117
The covariance matrix of tracking error corresponding thereto
Figure BDA0002243092380000118
And 4, step 4: and (3) information communication stage: and (3) each observer sends the local tracking result of the observer to the fusion center, and the fusion center obtains a global tracking result after integrating the information of all the observers and feeds the result back to each observer.
After the calculation in step 3 is completed, all observers send their tracking results and the corresponding tracking error covariance matrix to the fusion center, and in the calculation at time k, the fusion center may receive the following information:
Figure BDA0002243092380000119
here, 3 observers are taken as an exampleIt should be noted that the method can be extended to situations where more observers are present.
Based on the above information, the following fusion calculation is made:
Figure BDA0002243092380000121
Figure BDA0002243092380000122
wherein the content of the first and second substances,
Figure BDA0002243092380000123
for fused trace results, P2(k) And the covariance matrix of the positioning error of the fused tracking result is fed back to each observer by the fusion center.
Meanwhile, in order to further improve the target precision and stability for a long time, each observer replaces the local result of the observer with a global result, namely:
observer a:
observer b:
Figure BDA0002243092380000125
an observer c:
Figure BDA0002243092380000126
the target tracking result at the time k is finally obtained as follows:
target three-axis position:
Figure BDA0002243092380000127
target triaxial speed:
Figure BDA0002243092380000128
target triaxial acceleration:
Figure BDA0002243092380000129
wherein the content of the first and second substances,
Figure BDA00022430923800001210
in turn represent
Figure BDA00022430923800001211
The 1 st, 2 nd and 3 rd elements of (a);
Figure BDA00022430923800001212
Figure BDA00022430923800001213
in turn represent
Figure BDA00022430923800001214
1 st, 2 nd, 3 rd, 4 th, 5 th and 6 th elements.
And (3) outputting the filtering result obtained in the step (5) as a final target tracking result, wherein the final output result is shown in fig. 3 to fig. 7, fig. 3 is a schematic diagram of a three-axis position real value and a tracking result, fig. 4 is a schematic diagram of a three-axis tracking position error, fig. 5 is a schematic diagram of a three-axis velocity real value and a tracking result, fig. 6 is a schematic diagram of a three-axis tracking velocity error, fig. 7 is a schematic diagram of a three-axis acceleration real value and a tracking result, and fig. 8 is a schematic diagram of a three-. It can be seen from the simulation graphs that, by using the target tracking algorithm designed by the invention, not only can the position tracking result and the velocity tracking result in the three axial directions converge to the vicinity of the real value quickly and accurately, but also the acceleration tracking result in the three axial directions can realize accurate long-term tracking of the real acceleration, that is, the accurate positioning and tracking of the target can be effectively realized by using the algorithm.
In summary, the above description is only a preferred embodiment of the present invention, and is not intended to limit the scope of the present invention. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

Claims (8)

1. A distributed target tracking method based on multi-observer speed measurement information is characterized by comprising the following steps:
step 1: local target positioning stage: each observer estimates the position information of the target by using the target relative angle and the target relative distance information received by the observer to obtain a local positioning result of the observer;
step 2: and (3) information communication stage: each observer sends the local positioning result of the observer per se in the step 1 to a fusion center, the fusion center obtains a global positioning result after integrating the information of all the observers, and the result is fed back to each observer;
and step 3: a local target tracking stage: performing target tracking calculation again on the target by using the global positioning result obtained by feedback in the step 2 and the relative axial speed information observed by the target, so as to obtain a local tracking result of the target;
and 4, step 4: and (3) information communication stage: each observer sends the local tracking result of the observer in the step 3 to a fusion center, the fusion center obtains a global tracking result after integrating the information of all the observers, and the result is fed back to each observer;
and 5: and finishing the target tracking calculation of the current step and outputting a target tracking result.
2. The distributed target tracking method based on multi-observer speed measurement information according to claim 1, wherein the specific method for obtaining the local positioning result in step 1 is as follows:
take observer a as an example, and the rest observers are analogized by analogy; using the object localization model, the r sensed by observer a at time ka(k),θa(k),
Figure FDA0002243092370000011
As the filtering input, the extended kalman filtering algorithm (EKF) is used for filtering estimation to obtain the local target positioning result of the observer a in the target positioning stage at the moment k
Figure FDA0002243092370000012
The positioning error covariance matrix P corresponding theretoa(k)。
3. The distributed target tracking method based on multi-observer speed measurement information according to claim 2, wherein the target positioning model is:
x1(k+1)＝Φ1x1(k)+w1(k)
z1(k)＝H1(x1(k))+r1(k)
the corresponding state vector and state transition matrix are:
Figure FDA0002243092370000013
sequentially setting the target three-axis position and the target three-axis speed under X, Y and Z axes;
Figure FDA0002243092370000021
t is the system sampling interval, and the state error w (k) is zero-mean Gaussian white noise of the corresponding dimension;
the corresponding observation vectors are:
Figure FDA0002243092370000022
namely a target relative distance, a target relative azimuth angle and a target relative pitch angle; the corresponding observation matrix is:
Figure FDA0002243092370000023
r1(k) to correspond toThe measurement noise of the dimension is zero mean Gaussian white noise;
Figure FDA0002243092370000024
at time k, observer a is in his own three-axis position.
4. The distributed target tracking method based on multi-observer speed measurement information according to claim 1, wherein in the information communication stage in step 2, all observers send their own positioning results and corresponding positioning error covariance matrices to the fusion center, and in the calculation at time k, the fusion center can receive the following information:Pa(k)，
Figure FDA0002243092370000026
Pb(k)，
Figure FDA0002243092370000027
Pc(k)；
based on the above information, the following fusion calculation is made:
Figure FDA0002243092370000028
P(k)＝((Pa(k))-1+(Pb(k))-1+Pc(k)-1)-1
wherein the content of the first and second substances,p (k) is a covariance matrix of the positioning error of the fused positioning result; on the basis of the above, the fusion center will
Figure FDA0002243092370000032
And P (k) is fed back to the observers a, b, c.
5. The distributed target tracking method based on multi-observer speed measurement information according to claim 1, wherein the target tracking calculation method in step 3 is as follows:
firstly, estimating a relative angle of a target by using a global positioning result obtained by feedback in the step 2;
taking observer a as an example, the rest observers can be analogized in the same way;
then, dv sensed by the observer a at time k is analyzed by the target tracking modela(k) As filtering input, EKF calculation is carried out by using the target tracking model to obtain the local target tracking result of the observer a in the target tracking stage at the moment k
Figure FDA0002243092370000033
The covariance matrix of tracking error corresponding thereto
Figure FDA0002243092370000034
6. The distributed target tracking method based on multi-observer speed measurement information according to claim 5, wherein the specific method for estimating the relative angle of the target by using the global positioning result obtained by feedback in step 2 in step 3 is as follows:
θ1and
Figure FDA0002243092370000035
the calculated relative azimuth angle and the calculated relative pitch angle are both
Figure FDA0002243092370000036
And calculating to obtain the following results:
Figure FDA00022430923700000311
wherein
Figure FDA0002243092370000038
Andare respectively as
Figure FDA00022430923700000310
The 1 st 2 nd and 3 rd elements in (b).
7. The distributed target tracking method based on multi-observer speed measurement information according to claim 5, wherein the target tracking model in step 3 is:
x2(k+1)＝Φ2x2(k)+w2(k)
z2(k)＝H2(x2(k))+r2(k)
the corresponding state vector and state transition matrix are:
sequentially setting target three-axis speed and target three-axis acceleration under X, Y and Z axes;
the corresponding observation vectors are: z2(k)＝[dv]TI.e. target relative axial velocity; the corresponding observation matrix is:
Figure FDA0002243092370000043
8. the distributed target tracking method based on multi-observer speed measurement information according to claim 1, wherein in the information communication stage in step 4, all observers send their tracking results and corresponding tracking error covariance matrices to the fusion center, and in the calculation at time k, the fusion center can receive the following information:
Figure FDA0002243092370000044
based on the above information, the following fusion calculation is made:
Figure FDA0002243092370000045
Figure FDA0002243092370000046
wherein the content of the first and second substances,for fused trace results, P2(k) And the covariance matrix of the positioning error of the fused tracking result is fed back to each observer by the fusion center.
CN201911007086.XA 2019-10-22 2019-10-22 Distributed target tracking method based on multi-observer speed measurement information Active CN110749879B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911007086.XA CN110749879B (en) 2019-10-22 2019-10-22 Distributed target tracking method based on multi-observer speed measurement information

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911007086.XA CN110749879B (en) 2019-10-22 2019-10-22 Distributed target tracking method based on multi-observer speed measurement information

Publications (2)

Publication Number Publication Date
CN110749879A true CN110749879A (en) 2020-02-04
CN110749879B CN110749879B (en) 2022-05-17

Family

ID=69279402

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911007086.XA Active CN110749879B (en) 2019-10-22 2019-10-22 Distributed target tracking method based on multi-observer speed measurement information

Country Status (1)

Country Link
CN (1) CN110749879B (en)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103048658A (en) * 2012-11-10 2013-04-17 中国人民解放军海军航空工程学院 RA-Signer-EKF (Random Access-Singer-Extended Kalman Filter) maneuvering target tracking algorithm based on radial acceleration
CN105044710A (en) * 2014-05-03 2015-11-11 袁俊泉 Tracking initiation method including radial velocity information for a circular motion target
US20160103214A1 (en) * 2014-10-08 2016-04-14 Src, Inc. Use of Range-Rate Measurements in a Fusion Tracking System via Projections
CN105548985A (en) * 2015-12-29 2016-05-04 中国人民解放军海军航空工程学院 Maneuvering target tracking method based on RAV-Jerk model
CN106646453A (en) * 2016-11-17 2017-05-10 电子科技大学 Doppler radar target tracking method based on predicted value measurement conversion
CN108802721A (en) * 2018-08-22 2018-11-13 哈尔滨工业大学 A kind of lower method for tracking target of arbitrary line constraint
CN109782269A (en) * 2018-12-26 2019-05-21 北京壹氢科技有限公司 A kind of distribution multi-platform cooperative active target tracking
CN110044356A (en) * 2019-04-22 2019-07-23 北京壹氢科技有限公司 A kind of lower distributed collaboration method for tracking target of communication topology switching

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103048658A (en) * 2012-11-10 2013-04-17 中国人民解放军海军航空工程学院 RA-Signer-EKF (Random Access-Singer-Extended Kalman Filter) maneuvering target tracking algorithm based on radial acceleration
CN105044710A (en) * 2014-05-03 2015-11-11 袁俊泉 Tracking initiation method including radial velocity information for a circular motion target
US20160103214A1 (en) * 2014-10-08 2016-04-14 Src, Inc. Use of Range-Rate Measurements in a Fusion Tracking System via Projections
CN105548985A (en) * 2015-12-29 2016-05-04 中国人民解放军海军航空工程学院 Maneuvering target tracking method based on RAV-Jerk model
CN106646453A (en) * 2016-11-17 2017-05-10 电子科技大学 Doppler radar target tracking method based on predicted value measurement conversion
CN108802721A (en) * 2018-08-22 2018-11-13 哈尔滨工业大学 A kind of lower method for tracking target of arbitrary line constraint
CN109782269A (en) * 2018-12-26 2019-05-21 北京壹氢科技有限公司 A kind of distribution multi-platform cooperative active target tracking
CN110044356A (en) * 2019-04-22 2019-07-23 北京壹氢科技有限公司 A kind of lower distributed collaboration method for tracking target of communication topology switching

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
ZHENG ZHANG 等: "Consensus Based Strong Tracking Adaptive Cubature Kalman Filtering for Nonlinear System Distributed Estimation", 《IEEE ACCESS》 *
向波: "目标跟踪与数据融合算法研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 *
程丰 等: "多基地雷达目标跟踪精确定位仿真研究", 《计算机仿真》 *
雒梅逸香: "基于组网雷达数据融合的目标跟踪技术研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 *

Also Published As

Publication number Publication date
CN110749879B (en) 2022-05-17

Similar Documents

Publication Publication Date Title
Yang et al. Comparison of unscented and extended Kalman filters with application in vehicle navigation
CN106772524B (en) A kind of agricultural robot integrated navigation information fusion method based on order filtering
García et al. Augmented state Kalman filtering for AUV navigation
Xiong et al. G-VIDO: A vehicle dynamics and intermittent GNSS-aided visual-inertial state estimator for autonomous driving
Stančić et al. The integration of strap-down INS and GPS based on adaptive error damping
CN108761512A (en) A kind of adaptive CKF filtering methods of missile-borne BDS/SINS deep combinations
Wen et al. Performance comparison of GNSS/INS integrations based on EKF and factor graph optimization
CN107690567A (en) The method being tracked using extended Kalman filter for the navigation to mobile vehicle equipment
CN108490433A (en) Deviation Combined estimator and compensation method and system when sky based on Sequential filter
CN109507706B (en) GPS signal loss prediction positioning method
CN110779519B (en) Underwater vehicle single beacon positioning method with global convergence
CN113376669B (en) Monocular VIO-GNSS fusion positioning algorithm based on dotted line characteristics
CN110865334B (en) Multi-sensor target tracking method and system based on noise statistical characteristics
CN110209180B (en) Unmanned underwater vehicle target tracking method based on HuberM-Cubasic Kalman filtering
CN101126806A (en) Method for revising maximum likelihood registration based information infusion
CN110672103B (en) Multi-sensor target tracking filtering method and system
CN111025229B (en) Underwater robot pure orientation target estimation method
CN110646822A (en) Integer ambiguity Kalman filtering algorithm based on inertial navigation assistance
CN107576932A (en) Cooperative target replaces Kalman's spatial registration method with what noncooperative target coexisted
Chu et al. Performance comparison of tight and loose INS-Camera integration
CN113091754A (en) Non-cooperative spacecraft pose integrated estimation and inertial parameter determination method
CN110044385B (en) Rapid transfer alignment method under condition of large misalignment angle
CN110749879B (en) Distributed target tracking method based on multi-observer speed measurement information
CN116577801A (en) Positioning and mapping method and system based on laser radar and IMU
Zarei et al. Performance improvement for mobile robot position determination using cubature Kalman filter

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
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20221208

Address after: 100041 room 42, 7th floor, building 7, yard 30, Shixing street, Shijingshan District, Beijing

Patentee after: Beijing Qingyun Zhichuang Technology Co.,Ltd.

Address before: Room 315, 3 / F, building 10, yard 1, JinFang Road, Chaoyang District, Beijing

Patentee before: BEIJING YIQING TECHNOLOGY Co.,Ltd.