Added a skeleton SLAM package