Add SLAM package