FastSLAM Using Compressed Occupancy Grids

Algorithm 8

Updated form of reconstruction algorithm that is performed without needing to calculate the pseudoinverse of the compression matrix or perform the matrix-vector multiplication.

() procedure  FASTLTWORECONSTRUCTION

()  for  ,   do

()    

()  end for

()  for  ,   do

()    

()  end for

() end procedure