modifying slam.h to match openslam. my_webmap.mat is to be the test grid for us