Works again. Back to old state. We have sliding window, but no forgetting. This should be compiled against the original openslam_gmapping code