Minor tweaks

Eliminated jitter of servo, increased reliability of system by
decreasing duration of DMA access, amongst other things. Servo reader
uses tolerance for deciding whether or not to move servo.