Labfans是一个针对大学生、工程师和科研工作者的技术社区。 | 论坛首页 | 联系我们(Contact Us) |
![]() |
|
![]() |
#1 |
初级会员
注册日期: 2010-04-14
帖子: 3
声望力: 0 ![]() |
![]()
当输出稳定后,如何给输出加一个脉冲干扰,求程序,万分感谢!!!
%PID Controller clc; clear all; close all; kp=6.2471;ki=10.7569;kd=0.4533; ts=0.001; sys=tf(400,[1,30,200,0]); dsys=c2d(sys,ts,'z'); [num,den]=tfdata(dsys,'v'); u_1=0.0;u_2=0.0;u_3=0.0; y_1=0.0;y_2=0.0;y_3=0.0; x=[0,0,0]'; error_1=0; for k=1:1:8000 time(k)=k*ts; rin(k)=1; %Step Signal rin(k)=1-yout(k); end u(k)=kp*x(1)+kd*x(2)+ki*x(3); %PID Controller %Restricting the output of controller if u(k)>=10 u(k)=10; end if u(k)<=-10 u(k)=-10; end %Linear model yout(k)=-den(2)*y_1-den(3)*y_2-den(4)*y_3+num(2)*u_1+num(3)*u_2+num(4)*u_3; error(k)=rin(k)-yout(k); %Return of parameters u_3=u_2;u_2=u_1;u_1=u(k); y_3=y_2;y_2=y_1;y_1=yout(k); x(1)=error(k); %Calculating P x(2)=(error(k)-error_1)/ts; %Calculating D x(3)=x(3)+error(k)*ts; %Calculating I error_1=error(k); end figure(1); plot(time,rin,'k',time,yout,'r'); xlabel('time(s)'),ylabel('rin,yout'); |
![]() |
![]() |