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

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