Added movmement motor and Finite State Machine.