| Algorithm 1. Proposed fully adaptive PF algorithm | ||||||||||
| Initiation step: Sample N particles from initial distributions of states and parameters: Assign initial equal weights to all the particles Recursive steps: Prediction: Estimate for each parameter using the shrinkage rule in Equation (4) Draw new samples for parameter vector from: Propagate each particle one step forward using state process model with new sampled parameter: Update: Compute the predicted observations using the tentative measurement model: Update the parameters of to minimize the KLD: Calculate the weights for each particle as new measurement () becomes available: Normalize the weights: Estimate: Estimate the expected state: Resample: Resample (with replacement) new set of particles for states and process model parameters based on calculated weights (). |