|
Algorithm 1 Particle Filter for Traffic State Estimation with Kriging Estimated Measurements [24] |
-
Road network approximation
Use compressed sensing to select m most significant locations out of the n segments to be used for the measurement update step as defined in Section 5.3.
-
Initialisation
At ; define all boundary conditions: number of samples, weight of samples as below,
For , number of particles;
End for
Start the iteration for
-
(a)
Prediction stage
For ,
sample according to SCM model equations
End for
-
(b)
Measurement Update:
This step is performed when the sampling time equals the iteration count as defined in Section 3.2
i. Estimate missing measurements in the m most significant locations with Kriging using Equations ( 28) and ( 33)
ii. Compute the likelihoods
Based on Equation ( 6) compute the likelihood, of the particles using Equations ( 25)–( 27)
iii. Update the weights of the particles using the likelihood calculated from Equation ( 6)
For
End For
iv. Normalise the weights: .
-
(c)
Update the predicted states (Output):
-
(d)
Re-sample the weights (Selection) only when =
|