Closed loop servo control for stepper motors - View it on GitHub