FSM works between obs avoid and wall follow