Skip to main content
. 2019 Jun 24;19(12):2813. doi: 10.3390/s19122813
Algorithm 1 Particle Filter for Traffic State Estimation with Kriging Estimated Measurements [24]
  1. 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.

  2. Initialisation

    At k=0; define all boundary conditions: number of samples, weight of samples as below,

    For l=1,Np, Np number of particles;
    • generate Np samples {x0(l)} from the initial distribution p(x0)
    • initialise the particle weights w0(l)=1Np.

    End for

  3. Start the iteration for k=1,2,
    • (a)
      Prediction stage
      For l=1,...,Np,
      sample xk(l)p(xk|xk1(l)) according to SCM model equations
      End for
    • (b)
      Measurement Update:
      This step is performed when the sampling time ts equals the iteration count tk 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, p(zs|xs(l)) of the particles using Equations (25)–(27)
      iii. Update the weights of the particles using the likelihood p(zs|xs(i)) calculated from Equation (6)
      For l=1,...,Np
      ωs(l)=ωs1(l)p(zs|xs(l))
      End For
      iv. Normalise the weights: ω^s(l)=ωs(l)l=1Npωs(l).
    • (c)
      Update the predicted states (Output): x^s=l=1Npω^s(l)xs(l)
    • (d)
      Re-sample the weights (Selection) only when tk = ts