pid2.m

基于二次型性能指标的单神经元pid控制程序

%Single Neural Net PID Controller based on Second Type Learning Algorithm 
clear all; 
close all; 

xc=[0,0,0]'; 

K=0.02;P=2;Q=1;d=6; 

xiteP=120; 
xiteI=4; 
xiteD=159; 

%Initilizing kp,ki and kd 
wkp_1=rand; 
wki_1=rand; 
wkd_1=rand; 

wkp_1=0.34; 
wki_1=0.32; 
wkd_1=0.33; 

error_1=0;error_2=0; 
y_1=0;y_2=0; 
u_1=0.1726;u_2=0;u_3=0;u_4=0;u_5=0;u_6=0;u_7=0; 

ts=0.001; 
for k=1:1:250 
time(k)=k*ts; 
rin(k)=1.0; %Tracing Step Signal 

ym(k)=0; 
if k==100 
ym(k)=0.10; %Disturbance 
end 
yout(k)=0.368*y_1+0.26*y_2+u_6+0.632*u_7+ym(k); 
error(k)=rin(k)-yout(k); 

wx=[wkp_1,wkd_1,wki_1]; 
wx=wx*xc; 

b0=yout(1); 
% b0=0.05; 
K=0.0175; 
wkp(k)=wkp_1+xiteP*K*[P*b0*error(k)*xc(1)-Q*K*wx*xc(1)]; 
wki(k)=wki_1+xiteI*K*[P*b0*error(k)*xc(2)-Q*K*wx*xc(2)]; 
wkd(k)=wkd_1+xiteD*K*[P*b0*error(k)*xc(3)-Q*K*wx*xc(3)]; 

xc(1)=error(k)-error_1; %P 
xc(2)=error(k); %I 
xc(3)=error(k)-2*error_1+error_2; %D 

wadd(k)=abs(wkp(k))+abs(wki(k))+abs(wkd(k)); 
w11(k)=wkp(k)/wadd(k); 
w22(k)=wki(k)/wadd(k); 
w33(k)=wkd(k)/wadd(k); 
w=[w11(k),w22(k),w33(k)]; 

u(k)=u_1+K*w*xc; % Control law 

if u(k)>10 
u(k)=10; 
end 
if u(k)<-10 
u(k)=-10; 
end 

error_2=error_1; 
error_1=error(k); 

u_7=u_6;u_6=u_5;u_5=u_4;u_4=u_3; 
u_3=u_2;u_2=u_1;u_1=u(k); 

wkp_1=wkp(k); 
wkd_1=wkd(k); 
wki_1=wki(k); 

y_2=y_1;y_1=yout(k); 
end 
figure(1); 
plot(time,rin,'r',time,yout,'b'); 
xlabel('time(s)');ylabel('rin,yout'); 
figure(2); 
plot(time,u,'r'); 
xlabel('time(s)');ylabel('u'); 
figure(3); 
subplot(311); 
plot(time,wkp,'r'); 
xlabel('time(s)');ylabel('wkp'); 
subplot(312); 
plot(time,wki,'r'); 
xlabel('time(s)');ylabel('wki'); 
subplot(313); 
plot(time,wkd,'r'); 
xlabel('time(s)');ylabel('wkd');