电机控制案例 增量式PID及其MATLAB实现 含源代码.pdf

function f(a,M) %a选则输入信号，M为输出图形的横坐标最大值; %单位阶跃f(1,1); %正弦波f(2,2) %三角波f(3,1) ts=0.001;%采样时间 G=tf(50,[0.125,7, 0]) Gd=c2d(G,ts,'z');%Z变换 [num,den]=tfdata(Gd,'v') c_1=0;c_2=0; y_1=0;y_2=0; e_1=0;e_2=0; kp=10;Ti=0.1;Td=0.015; ki=kp*ts/Ti kd=kp*Td/ts A=kp*(1+ts/Ti+Td/ts); B=-kp*(1+2*Td/ts); C=kp*Td/ts; for k=1:1:M*1000 t(k)=k*ts; s=a; if s==1 r(k)=1; elseif s==2 r(k)=sin(pi*t(k)); elseif s==3 T=1000; if k>=0 & k<0.5*T r(k)=2*k; else r(k)=-2-2*(k-T); end