Initial Commit for the uma-nav-slam-pkg