http://www.hvlabs.com/superssc.html use with http://www.instructables.com/id/6-AXIS-ROBOTIC-ARM/
PID control