adds yocs_safety_controller package

Migration of kobuki_safety_controller