April 2004 Dartmouth College 1 A Hybrid Tracker and Smoother for Highly Maneuvering Targets Stephen Linder This material is based on work supported by Dr. Teresa McMullen through the Office of Naval Research under Contract No. N00039-D-0042, Delivery Order No. D.O. 278.
27
Embed
April 2004Dartmouth College 1 A Hybrid Tracker and Smoother for Highly Maneuvering Targets Stephen Linder This material is based on work supported by Dr.
This document is posted to help you gain knowledge. Please leave a comment to let me know what you think about it! Share it to your friends and learn new things together.
Transcript
April 2004 Dartmouth College 1
A Hybrid Tracker and Smootherfor
Highly Maneuvering Targets
Stephen Linder
This material is based on work supported by Dr. Teresa McMullen through the Office of Naval Research under
Contract No. N00039-D-0042, Delivery Order No. D.O. 278.
April 2004 Dartmouth College 2
Problem Context
A weaving target track constructed of linked
coordinated turns
April 2004 Dartmouth College 3
Research Goals
Develop and algorithm that tracks highly maneuverable targets with sparse measurements.
Perform data compression on track data so that a succinct description of target track can be obtained “Target traveled at heading of 20° for 100
yards; Turned left at 10°/sec to heading of 100°”
Classification of target and target behavior
April 2004 Dartmouth College 4
Approach – Segmenting Track Identifier (STI)
Use batch processing of data rather than recursive Kalman filter approach
Segment track into discrete segments with each segment have only one mode of motion
support multiple localized nonlinear models of target motion most tracking techniques require either linearized models or
use of Extended Kalman Filters that have stability problems Avoid statistical mixing of models as with the IMM approach
Generate locally optimal track by minimizing mean square error of each track segment, and minimizing discontinuity of segments at the knots
connecting the segments
April 2004 Dartmouth College 5
Maneuvering Target Models Target models used by Bayesian trackers
Constant Velocity Coordinate Turns – sustained turn rate at constant
speed Statistical Models
Singer maneuver model Maneuvers are modeled as zero-mean, time-correlated
accelerations
STI target models Any model for which a cost function can be written Continuity condition at knots
Position Direction
April 2004 Dartmouth College 6
Linking coordinated turns
knots
April 2004 Dartmouth College 7
Position and velocity continuity
Match position
Match velocity
April 2004 Dartmouth College 8
Knot Placement Approach (1) Phase I – initial segmentation
Add data to current segment keeping continuity with previous segment
Fit model Determine if the new measurements are a
good fit to model Place knot if residuals of new measurements is
greater than for the older measurements Err on the side of generating two many knots and
then recombine knots in second phase of processing
Estimate current position, velocity and acceleration
April 2004 Dartmouth College 9
Knot Placement Approach (2) Phase II – optimize knots
Recursively optimize previous knot placement if
positions and velocity are not continuous at knot, or
a new knot has been place Combine segments that reduce cost of track Refine current position, velocity and
acceleration estimates
April 2004 Dartmouth College 10
Selecting Track Model Selection of model affects effectiveness
of optimization
Arc Centric Target CentricCenter of Arc – x Starting Position – x
Center of Arc – y Starting Position – y
Angle to Start Heading
Radius Turn Rate
Length Speed
April 2004 Dartmouth College 11
Affect of Model on Optimization
Difference in Two Arcs Arc Centric
large change in location of arc center Target Centric
Small change in starting location and turn rate
April 2004 Dartmouth College 12
Costs for joining segments The C0 and C1 continuity condition is given
by
is the difference in position at the knot between the n and n+1 segment
is the difference in heading at the knot between the n and n+1 segment
kp is a proportionality constant based on
the number points in the segments
, 1 , 1( )C p n n n nQ n k R
, 1n nR
, 1n n
April 2004 Dartmouth College 13
Example weaving track
Noisy Measurements
Track Estimates
Kalman Filter Track
STI Track
April 2004 Dartmouth College 14
Benchmark comparison
1.5 2 2.5 3 3.5 4 4.5 5 5.5 6 x 10 4
2.5
3
3.5
4
4.5
5
5.5
6 x 10 4
meters
met
ers
Semerdjiev, Emil, Ludmila Mihaylova and X. Rong Li (2000). Variable- and Fixed-Structure Augmented IMM Algorithms Using Coordinated Turn Model. International Conference on Information Fusion (Fusion' 2000), Paris, France.