first version of stepper + servo control