To improve the rapid response capabilities of servo system, it is necessary to improve the PID control algorithm. On the basis of systematic study of a linear or nonlinear PID control algorithm, a new control algorithm is designed to work on the basis of actual object. The new control algorithm is multiplexed control algorithm using feed-forward control algorithm and step control algorithm. The experiments prove that the new control method decrease the response time of servo system and improve the rapid response capabilities of servo system.