Fine tuned servo interface, need to calibrate