implemented the safeguarding behaviors (bump-backup + unsafe conditions) without the scripts and added a robot state machine