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

This reverts commit 19ab0337393adc8db5e2008cbb9d727da5f94336.
Rebase from 'upstream'
Trimmed the branch to only the clear_costmap_recovery sub directory