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

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