Starting refactor of state machine
Deleted DEPRECATED function for walking.
Fixing state machine