伺服电机控制算法及其应用