The principle and function of optical range finder are described. According to the defect of the low precision of optical range finder, the design of the step servo based on single chip microcomputer and digital processing equipment is given, which is considered as an improved optical range-finder and it is used to carry out digital calculation and precise control, and the measure precision of optical distance measuring equipment is raised.