Stepper Motor won't go more than one step when in an 'if'