Please see this video for my work on this project during 2014 summer: https://www.youtube.com/watch?v=iE5uRYFK7Qs
The library used (besides the integrated servo library of Arduino) is Copyright (C) 2008 Mike McCauley, called AccelStepper please find this library online for use with this firmware