sample code for a Stepper Robot in embedded systems Finite State Machines lecture