Revert "Trimmed the branch to only the crsm_slam sub directory"

This reverts commit d1b998020096ceeb6e0f1284b23f89f4196a8a5b.
Rebase from 'upstream'
Trimmed the branch to only the crsm_slam sub directory