zxc852905168 发表于 2014-8-14 22:48
我还想问下,其实我刚学的pid,比例部分uk=kp*ek这里的ek是误差的角度,那uk是不是期望输出的角度?如果 ...
参照前面那个PID公式:
;位置型PID算法:
E(K)=R(K)-M(K) ;本次误差=本次设定值-本次测量值
Pp(K)=Kp*E(K) ;本次比例输出=比例系数×本次误差值
Pi(K)=Ki*E(K)+Pi(K-1) ;本次积分输出=积分系数×本次误差值+上次积分输出值
Pd(K)=Kd[E(K)-E(K-1)] ;本次微分输出=微分系数×(本次误差值-上次误差值)
P(K)=Pp(K)+Pi(K)+Pd(K) ;输出值=本次比例输出+本次积分输出+本次微分输出
其中比例部分Pp(K)=Kp*E(K),E(K)=R(K)-M(K),R(K)才是你期望的值,比如你希望四轴保持水平,则R(K)=0; |