CN111175736B - Point trace correlation distribution method based on quasi-Newton method - Google Patents

Point trace correlation distribution method based on quasi-Newton method Download PDF

Info

Publication number
CN111175736B
CN111175736B CN202010018377.5A CN202010018377A CN111175736B CN 111175736 B CN111175736 B CN 111175736B CN 202010018377 A CN202010018377 A CN 202010018377A CN 111175736 B CN111175736 B CN 111175736B
Authority
CN
China
Prior art keywords
track
point
trace
quasi
acceleration
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010018377.5A
Other languages
Chinese (zh)
Other versions
CN111175736A (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.)
724th Research Institute of CSIC
Original Assignee
724th Research Institute of CSIC
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 724th Research Institute of CSIC filed Critical 724th Research Institute of CSIC
Priority to CN202010018377.5A priority Critical patent/CN111175736B/en
Publication of CN111175736A publication Critical patent/CN111175736A/en
Application granted granted Critical
Publication of CN111175736B publication Critical patent/CN111175736B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • G01S13/00Systems 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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems

Landscapes

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

Abstract

The invention provides a point track correlation distribution method based on a quasi-Newton method, which comprises the steps of firstly, providing a displacement calculation formula of a flight track under the influence of tangential and normal acceleration on the basis of a uniform acceleration model; secondly, decomposing a displacement change formula to reduce the calculation complexity, and establishing an iterative model for solving the tangential acceleration and the normal acceleration based on a quasi-Newton method; constructing an energy formula again to evaluate the influence degree determined by different trace distribution schemes; and finally, giving a lane crossing avoidance rule and a minimum energy rule, optimizing a trace point distribution scheme and preventing trace point distribution errors.

Description

Point trace correlation distribution method based on quasi-Newton method
Technical Field
The invention belongs to the technical field of radar data processing.
Background
The association of the point track and the track is a key problem of multi-sensor tracking, and the stability and the correctness of a track target and the accuracy and the reliability of a track filtering state are determined to a great extent, so that the application guarantee capability of track target data is influenced. The current main data association methods comprise a nearest neighbor method, a global optimum method, a Probability Data Association (PDA), an interactive multi-model, a Joint Probability (JPDA), a neural network and the like, the association method based on the probability theory and the neural network ignores the flight path target navigation dynamics characteristics, the association method based on the probability model needs to calculate the point track membership, the situations of high complexity and poor adaptability exist, and the methods of the interactive multi-model, the neural network and the like are difficult to balance the contradiction between the model complexity and the calculated quantity.
In order to fully utilize track target dynamics characteristics determined by point track distribution, a target displacement change formula determined by tangential and normal acceleration is given by means of a uniform acceleration model, and the track target displacement change formula is split to reduce the calculation difficulty, so that a quasi-Newton iteration calculation model based on a Jacobian matrix is constructed; the invention provides an energy formula to evaluate the reasonable degree of different track distribution schemes, and considers that track crossing conditions possibly exist in adjacent areas, the invention provides track crossing avoidance and minimum energy rules to avoid meeting and even collision of the track under the condition that non-deceleration avoidance measures are not taken, optimize the track distribution scheme and correct track distribution errors.
Disclosure of Invention
The purpose of the invention is: a method for estimating track-point distribution influence, judging track cross meeting track-point track association distribution and scheme adjustment is provided.
The solution of the invention is:
on the basis of analyzing a track target data association processing flow, the invention provides an acceleration evaluation value of the last period, dynamically corrects the size of a wave gate, preliminarily screens out point track data with a potential association relation, thereby obtaining the displacement difference between the point track and the current position of the track, further iteratively calculates the acceleration values of the target in the normal direction and the tangential direction by using a quasi-Newton method, calculates and evaluates the track association influence degree determined by the association point track based on an energy formula provided by the invention, and preliminarily selects the point track with the minimum association degree as an alternative association point track.
Secondly, finding and marking a track target with an adjacent relation through multiple traversals; and (4) performing straddle judgment on the adjacent track pair, and if the current distribution scheme is judged to have the track crossing condition and the time difference of the meeting point of the adjacent track pair is less than 1s, exchanging the point track distribution to avoid ship collision or track batch change.
And after all adjacent track pairs are adjusted, the obtained point track distribution and adjustment results are used as track association results, and finally track updating, filtering and outputting are finished.
Drawings
Fig. 1 is a flow of trace point assignment processing based on quasi-newton method, wherein the dotted line provides the core processing steps of the present invention.
FIG. 2 is a schematic diagram of the determination of the straddle experiment
Fig. 3 is a schematic diagram of adjusted trace point distribution when intersection is determined by a straddle experiment, and the time difference of the intersected track target reaching the intersection point is less than 1 s.
Detailed Description
The method mainly comprises the steps of establishing a target displacement calculation formula, constructing a quasi-Newton iterative calculation model and distributing the point traces based on the acceleration.
(1) Target displacement calculation formula
Due to the fact that the time difference between an unallocated point track and a flight track is usually short, the target data updating rate of a typical navigation radar is usually about 3s, and the data updating rate of an early warning radar isThe rate is higher, the finer period is shorter, therefore, the normal and tangential stress of the target can be assumed to be uniform in a shorter time, namely the normal and tangential acceleration values of the target are not changed, and the invention calculates the tangential acceleration a of the target based on the following formulatAnd normal acceleration an
Figure BDA0002359796590000021
Figure BDA0002359796590000022
(2) quasi-Newton iterative computation model
Due to f1(an,at) And f2(an,at) The method adopts a quasi-Newton method to estimate the normal and tangential acceleration values of the track target. The quasi-Newton method is to solve a nonlinear equation set:
Figure BDA0002359796590000023
the numerical value of (a) is solved by (X)1,x2,...,xn) Iterative calculations are performed based on:
X(K+1)=X(K)-F(X(K))-1f(X(K))
where F (X) is a Jacobian matrix. The core difficulty for the problem faced by the present invention is the computation
Figure BDA0002359796590000024
Figure BDA0002359796590000031
Thereby constructing a Jacobian matrix
Figure BDA0002359796590000032
Figure BDA0002359796590000033
To reduce the computational complexity, the present invention first defines
Figure BDA0002359796590000034
Figure BDA0002359796590000035
Figure BDA0002359796590000036
Therefore, there are:
Figure BDA0002359796590000037
Figure BDA0002359796590000038
Figure BDA0002359796590000039
Figure BDA00023597965900000310
Figure BDA0002359796590000041
Figure BDA0002359796590000042
Figure BDA0002359796590000043
thus, the following results were obtained:
Figure BDA0002359796590000051
obtaining a Jacobian matrix
Figure BDA0002359796590000052
Then, iterative calculations are performed according to the following formula:
Figure BDA0002359796590000053
when the condition is satisfied
Figure BDA0002359796590000054
When it is taken
Figure BDA0002359796590000055
As a numerical solution.
(3) Acceleration-based trace point assignment and adjustment
The change process of the target motion state can be described by acceleration, and the civil ships and aircrafts usually do not have violent speed change in the sailing process, otherwise, larger oil consumption and sailing risks are caused. For this purpose, the invention proposes the velocity and energy change degree determined based on the tangential acceleration and normal acceleration measurement trace distribution, namely the correlation influence degree:
Figure BDA0002359796590000056
based on the concept of relevance influence, the invention firstly proposes an energy minimum principle, namely a flight path target selects a plurality of point paths to meet min { Eval }iAnd taking the point trace of | i ═ 1,2,3, …, n } as an alternative associated point trace.
If there are 2 orIf the adjacent tracks do not have route crossing, the route distribution scheme is not adjusted, namely the route distribution scheme is selected to meet min { sum (Eval)i+Evalj) The association of the track target and the point track is completed by the distribution scheme of 1,2,3, …, n, i ≠ j }; otherwise, if the tracks are judged to be intersected, the phenomena of collision and batch change of the adjacent tracks under the current point track distribution scheme are caused, and the point track distribution scheme needs to be adjusted.
The invention provides a track target route cross avoidance rule which is mainly provided for near multi-track target data distribution, and because the time difference between unallocated trace points and tracks is usually short, the calculation speed is improved for reducing the calculation complexity. The basic schematic diagram of the straddle experiment is shown in FIG. 2, in which the track O is1、O2Has an update position of a and c, an assigned dot trace of b and d, and a velocity of v1、v2The following 4 values were calculated:
u=(c.x-a.x)*(b.y-a.y)-(b.x-a.x)*(c.y-a.y)
v=(d.x-a.x)*(b.y-a.y)-(b.x-a.x)*(d.y-a.y)
w=(a.x-c.x)*(d.y-c.y)-(d.x-c.x)*(a.y-c.y)
z=(b.x-c.x)*(d.y-c.y)-(d.x-c.x)*(b.y-c.y)
when u.v ≦ 0& & w.z ≦ 0, the two routes are intersected.
When the two routes are judged to intersect, the intersection point is solved, and then the target O is solved1、O2To the intersection o:
o.x=[(a.x-b.x)·(c.y·d.x-c.x·d.y)-c.x(c.x-d.x)·(a.y·a.x-a.x·b.y)]/[(a.y-b.y)·(c.x-d.x)-(c.y-d.y)·(a.x-b.x)]
o.y=[(a.y-b.y)·(c.y·d.x-c.x·d.y)-(c.y-d.x)·(a.y·b.x-a.x·b.y)]/[(a.y-b.y)·(c.x-d.x)-(c.y-d.y)·(a.x-b.x)]
the time difference Δ t thus obtained:
Figure BDA0002359796590000061
if delta t is less than 1s, the trace point distribution is considered to be wrong, and the distribution scheme is adjusted to be O1A → d and O2C → b, as shown in FIG. 3, continue to pick the trace points. Under the condition that the number of the point tracks is more than 1, the original point track with the minimum correlation influence degree is removed from the adjacent point track set of the current track, the distributed point tracks of the adjacent tracks are added, the point track with the minimum correlation influence degree is selected again to serve as the alternative point track of the current track until the two adjacent tracks are ensured not to intersect, and the rule is called a track target route cross avoidance principle.
And after the preliminary distribution and adjustment of the trace point distribution scheme are finished, outputting the correlation result of the track target, and finally finishing the filtering update of the track state.

Claims (2)

1. A point trace correlation distribution method based on a quasi-Newton method is characterized in that:
the method comprises the following steps: based on the assumption of uniform acceleration, a displacement change calculation formula of the flight path under the influence of normal acceleration and tangential acceleration is given:
Figure FDA0002359796580000011
step two: the displacement variation calculation formula is decomposed into two components:
Figure FDA0002359796580000012
thereby reducing the calculation difficulty and constructing a Jacobian matrix:
Figure FDA0002359796580000013
establishing an iterative model based on a quasi-Newton method by initializing a tangential normal acceleration value and giving a termination condition, and if the conditions are met:
Figure FDA0002359796580000014
obtaining two acceleration values of normal direction and tangential direction
Figure FDA0002359796580000015
As a numerical solution;
step three: selecting the point track with the minimum energy from the alternative point tracks as a correlation result of the flight track and the point track, wherein an energy formula is calculated according to the following formula:
Figure FDA0002359796580000021
2. the dot trace correlation distribution method based on quasi-Newton method as claimed in claim 1, wherein: the method comprises the following steps of providing a track cross avoidance principle to solve track distribution errors possibly caused by track cross meeting, firstly judging whether tracks are crossed or not based on a straddle experiment, and if so, solving a track cross point:
Figure FDA0002359796580000022
Figure FDA0002359796580000023
and further solving the time difference delta t of the track to the meeting point:
Figure FDA0002359796580000024
and if the delta t is less than 1s, deleting the current trace from the adjacent trace set by the crossed tracks, adding the trace of the other side, and further performing cross avoidance judgment and trace distribution adjustment on the newly screened trace with the minimum energy until the tracks are not intersected.
CN202010018377.5A 2020-01-08 2020-01-08 Point trace correlation distribution method based on quasi-Newton method Active CN111175736B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010018377.5A CN111175736B (en) 2020-01-08 2020-01-08 Point trace correlation distribution method based on quasi-Newton method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010018377.5A CN111175736B (en) 2020-01-08 2020-01-08 Point trace correlation distribution method based on quasi-Newton method

Publications (2)

Publication Number Publication Date
CN111175736A CN111175736A (en) 2020-05-19
CN111175736B true CN111175736B (en) 2022-04-05

Family

ID=70654576

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010018377.5A Active CN111175736B (en) 2020-01-08 2020-01-08 Point trace correlation distribution method based on quasi-Newton method

Country Status (1)

Country Link
CN (1) CN111175736B (en)

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7567203B2 (en) * 2005-04-11 2009-07-28 Raytheon Canada Limited Classification system for radar and sonar applications
CN105510896B (en) * 2015-12-03 2019-07-02 成都能通科技有限公司 A kind of weighted nearest neighbor numeric field data correlating method of centralization multi-radar data processing
CN106680806A (en) * 2016-11-24 2017-05-17 清华大学 Multi-radar plot fusion method
CN107255803B (en) * 2017-07-24 2020-07-24 中电科技(合肥)博微信息发展有限责任公司 Ship track logic initiation algorithm

Also Published As

Publication number Publication date
CN111175736A (en) 2020-05-19

Similar Documents

Publication Publication Date Title
CN112099496B (en) Automatic driving training method, device, equipment and medium
CN114005280B (en) Vehicle track prediction method based on uncertainty estimation
CN113065074B (en) Track destination prediction method based on knowledge graph and self-attention mechanism
CN111695299B (en) Mesoscale vortex trajectory prediction method
CN104700617A (en) High-precision lane information extracting method based on low-precision GPS track data
CN111338350A (en) Unmanned ship path planning method and system based on greedy mechanism particle swarm algorithm
CN111473794B (en) Structural road unmanned decision planning method based on reinforcement learning
CN110285817B (en) Complex road network map matching method based on self-adaptive D-S evidence theory
CN115265555B (en) Map matching correction method and system based on hidden Markov multi-noise perception
CN111695737A (en) Group target advancing trend prediction method based on LSTM neural network
CN111967094B (en) Backward lane line calculating method based on Mobileye lane line equation
CN110986965A (en) Low-frequency floating vehicle track data road network matching method based on hidden Markov model
Elshrif et al. Network-less trajectory imputation
CN105910611A (en) Road matching method based on matching degree feedback
CN113639757B (en) Map matching method and system based on bidirectional scoring model and backtracking correction mechanism
CN115206099A (en) Self-adaptive path inference method for vehicle GPS track
CN109147322B (en) Multi-source data self-adaptive fusion method in urban traffic big data processing
CN111175736B (en) Point trace correlation distribution method based on quasi-Newton method
CN113721969A (en) Multi-scale space vector data cascade updating method
CN111123333B (en) Vehicle track positioning method fusing bayonet and GPS data
Blazquez et al. An instance-specific parameter tuning approach using fuzzy logic for a post-processing topological map-matching algorithm
CN116543602B (en) Situation complexity identification method and system for aircraft clusters
CN110763234B (en) Submarine topography matching navigation path planning method for underwater robot
CN113465613B (en) Map matching optimization method for tunnel network positioning in urban rail transit
CN115585814A (en) Aircraft variable-scale terrain following method based on settlement mechanism

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