Fixed build
Updated CMakeLists
Updated SLAM