Include safety stop on kawada

Goal is to trigger a safety stop if a collision happens

• discuss with Rosa how to trigger a safety stop
• include necessary steps
• test on stationary robot