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

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