Electronics and code for a six DOF dc servo controller