Quad plus Voltage testing merge

Merged in some of the changes from my 1.5.x branch.  In particular, can
define to be in quad mode as well as updates to when I read voltages
from servos