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

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