Tracking_filter

This is a beta release for a suite of MATLAB based RFS filtering/tracking codes, from site[http://ba-tuong.vo-au.com/codes.html]

The "_common" subdirectory of shared functions should be added to your MATLAB path.

The remaining directories (except for "robust") contain various filters: "singletarget" Single target filter with RFS observations "bernoulli" Bernoulli filter "phd" PHD filter "cphd" CPHD filter "cbmember" CBMeMBer filter "glmb" Generalized Labeled Multi-Bernoulli Filter (via separate prediction and update) "lmb" Labeled Multi-Bernoulli filter (via separate prediction and update) "jointglmb" Generalized Labeled Multi-Bernoulli Filter (via joint prediction and update) "jointlmb" Labeled Multi-Bernoulli filter (via joint prediction and update)

Each filter has different implementation folders: "gms" Gaussian mixture solution for linear Gaussian models "ekf" EKF approximation for non-linear models "ukf" UKF approximation for non-linear models "smc" SMC implementation for nonlinear models

The "robust" directory contains implementations for "lccphd" Unknown lambda-CPHD filter (with GM/EKF/UKF/SMC versions) "pdcphd" Unknown P_D CPHD filter (with BGM/EKF/UKF/SMC versions) "jointcphd" Jointly unknown lambda and P_D CPHD filter (with BGM/EKF/UKF/SMC versions) "jointcbmember" Jointly unknown lambda and P_D CBMeMBer filter (SMC version only; but unlike the CPHD variants which estimate the clutter rate only (with known map), this estimates clutter maps on the fly)

How to run

For each filter and within each implementation folder, run the "demo" script to see a preconfigured example. e.g. to run the CPHD filter with a UKF based implementation:

>> addpath _common
>> cd cphd/ukf/
>> demo

Notes:

1. All linear Gaussian examples use a 4D CV model (x/y position and velocity) with 2D observations (position only).

2. All non linear examples use a 5D CT model (x/y position, velocity and unknown turn rate) with 2D observations (range and bearing).

3. The demo scripts all use the same basic calling sequence:

model= gen_model; %generate model parameters truth= gen_truth(model); %generate ground truths meas= gen_meas(model,truth); %generate measurements est= run_filter(model,meas); %perform filtering handles= plot_results(model,truth,meas,est); %plotting

4. The codes for the GLMB based filters will additionally show a plot for the OSPA^(2) metric which indicates the tracking error (taken over a preceeding time window), as well as the usual plot for the OSPA metric which indicates only the filtering error (at the current time only). For more details on the metric, see the associated script, which points to the relevant paper(s). The code for the OSPA metric was produced by Ba Tuong Vo, and the code for the OSPA^(2) metric was produced by Michael Beard.

5. These codes are provided for academic/research purposes only. They are designed for readability and demonstration thus they are not optimized for speed. The authors do not provide any guarantees implicit or otherwise regarding these codes. For commercial grade codes please contact the authors directly ([email protected], [email protected]). The authors acknowledge the input of and discussions with Michael Beard and Stephan Reuter respectively in the development of these particular GLMB and LMB codes. The codes for "robust" filtering were developed by Du Yong Kim.