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

This reverts commit 00369101926018569cb664e0f36fb90afb913b19.
Rebase from 'upstream'
Trimmed the branch to only the kobuki_safety_controller sub directory