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

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