Added state machine and motor functions