Fixed a problem in the state machine which prevented the READY status to be sent. Also fixed the walk start procedure so that we start stepping only when we receive a command, and not when the module is started