Started working on the state machine

idle and random walk around impelemented