pid 算法 第一个微分问题