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

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