A control system that can be used on a hydrostatic pump has a feedback sensor to detect the angle of a swashplate. From the information gathered by the feedback sensor about the swashplate and another set command, this information is sent to a microprocessor. The microprocessor then uses an algorithm to create an output signal and also sends out a superimposed dither signal. This dithered output signal is then received by a pressure control that causes a dither servo pressure in a servo system. Because of the dither pressure the servo system adjusts the position of the swashplate.