|
Algorithm 1. The robust SMC-PHD filter. |
Step 1 Prediction for end for for end for |
Step 2 Update For Perform iteration initialization, set the iteration number , and update the parameters of measurement noise by Equations (49)–(60). end for |
Step 3 Resampling Step 4 State extraction Step 3 and step 4 are the same as that in the standard SMC-PHD filter. |