Updated servo measurements to be more accurate