First test of map + particle filter