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

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