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

This reverts commit e18ac4a11780221e7582dc22fd4054b65dc5d901.
Rebase from 'upstream'
Trimmed the branch to only the ndt_costmap sub directory