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

This reverts commit 87b7685e2b0b03b5bdb7037749a02557f3a7339e.
Rebase from 'upstream' @ version '0.3.5'
Trimmed the branch to only the kobuki_safety_controller sub directory