|
Algorithm 1: Roll forward process |
1: Input: Initial belief state ; Number of the particles N
2: Output: LUG with the most likely belief state at each time step
3: Sample N particles using the prior probability distribution
4: Add the initial belief state to proposition layer
5: For each time-step t >0 do
6: For each belief state in do
7: If all the particles can be assigned according to a set of obtained a posteriori transitions
probability Then break
8: Execute possible transitions and store the corresponding effect into
9: If the successor belief state is consistent with observation
10: Save the belief state into proposition layer
11: Calculate the a posteriori transitions probability
12: Insert into a set of obtained a posteriori transitions probability
13: Else
14: Recalculate the normalization term
15: Update the set of obtained a posteriori transitions probability
16: End If
17: End For
18: Assign the particles for the belief state in according to a set of obtained a posteriori transitions probability
19: End For
|