Escape Behavior FSM
Spin in
direction d
backup
No action
forward
Left bump
Output d=right
Right bump
Output d=left
Moved distance f
Moved distance b
Turned through angle 0