Modified stepper control code

Modified to move a set angle; currently untested.