adds yocs_safety_controller package

Migration of kobuki_safety_controller
OK. Will change.