RBF or Fuzzy &pid

%Adaptive PID control based on RBF Identification
clear all;
close all;

xite=0.5;
alfa=0.05;
beta=0.01;
x=[0,0,0]';

ci=zeros(3,6);
bi=10*ones(6,1);
w=0.10*ones(6,1);

h=[0,0,0,0,0,0]';
    
ci_1=ci;ci_3=ci_1;ci_2=ci_1;
bi_1=bi;bi_2=bi_1;bi_3=bi_2;
w_1=w;w_2=w_1;w_3=w_1;

u_1=0;y_1=0;
xc=[0,0,0]';
error_1=0;error_2=0;
kp0=0.01;ki0=0.01;kd0=0.01;

pidu_1=0;pidy_1=0;
pidxc=[0,0,0]';
piderror_1=0;piderror_2=0;
pidkp=0.01;pidki=0.01;pidkd=0.01;

kp_1=kp0;
kd_1=kd0;
ki_1=ki0;

xitekp=0.15;
xitekd=0.15;
xiteki=0.15;

% ts=0.001;
ts=0.01
for k=1:1:3000
   time(k)=k*ts;
%    yd(k)=1.0;
   yd(k)=sin(time(k));
%    y(k)=(-0.1*y_1+u_1)/(1+y_1^2);
   y(k)=(-0.1*y_1+u_1)/(1+y_1^2);  %Nonlinear plant
   
   for j=1:1:6
      h(j)=exp(-norm(x-ci(:,j))^2/(2*bi(j)*bi(j)));
   end
   ym(k)=w'*h;

   d_w=0*w;
   for j=1:1:6
      d_w(j)=xite*(y(k)-ym(k))*h(j);
   end
   w=w_1+d_w+alfa*(w_1-w_2);
   
   d_bi=0*bi;
   for j=1:1:6
      d_bi(j)=xite*(y(k)-ym(k))*w(j)*h(j)*(bi(j)^-3)*norm(x-ci(:,j))^2;
   end
   bi=bi_1+ d_bi+alfa*(bi_1-bi_2);
   for j=1:1:6
     for i=1:1:3
      d_ci(i,j)=xite*(y(k)-ym(k))*w(j)*h(j)*(x(i)-ci(i,j))*(bi(j)^-2);
     end
   end
   ci=ci_1+d_ci+alfa*(ci_1-ci_2);
%%%%%%%%%%%%%%%%%%%%%%Jacobian%%%%%%%%%%%%%%%%%%%%%%%
  yu=0;
  for j=1:1:6
      yu=yu+w(j)*h(j)*(-x(1)+ci(1,j))/bi(j)^2;
  end
  dyu(k)=yu;
%%%%%%%%%%%%%%%%%%%%%%Start of Control system%%%%%%%%%%%%%%%%%%
   error(k)=yd(k)-y(k);
   kp(k)=kp_1+xitekp*error(k)*dyu(k)*xc(1);
   kd(k)=kd_1+xitekd*error(k)*dyu(k)*xc(2);
   ki(k)=ki_1+xiteki*error(k)*dyu(k)*xc(3);  
   if kp(k)<0
      kp(k)=0;
   end
   if kd(k)<0
      kd(k)=0;
   end
   if ki(k)<0
      ki(k)=0;
   end
   
   M=1;
   switch M
   case 1
   case 2  %Only PID Control
		kp(k)=kp0;
		ki(k)=ki0;     
		kd(k)=kd0;
   end
   du(k)=kp(k)*xc(1)+kd(k)*xc(2)+ki(k)*xc(3);
   u(k)=u_1+du(k);
%Return of parameters
   x(1)=du(k);
   x(2)=y(k);
   x(3)=y_1;

   u_1=u(k);
   y_1=y(k);
   
   ci_3=ci_2;
   ci_2=ci_1;
   ci_1=ci;
   
   bi_3=bi_2;
   bi_2=bi_1;
   bi_1=bi;
   
   w_3=w_2;
   w_2=w_1;
   w_1=w;
   
   xc(1)=error(k)-error_1;             %Calculating P
   xc(2)=error(k)-2*error_1+error_2;   %Calculating D
   xc(3)=error(k);                     %Calculating I
   
   error_2=error_1;
   error_1=error(k);
   
   kp_1=kp(k);
   kd_1=kd(k);
   ki_1=ki(k);  
   
   pidy(k)=(-0.1*pidy_1+pidu_1)/(1+pidy_1^2);
   piderror(k)=yd(k)-pidy(k);
   piddu(k)=pidkp*pidxc(1)+pidkd*pidxc(2)+pidki*pidxc(3);
   pidu(k)=pidu_1+piddu(k);
   pidu_1=pidu(k);
   pidy_1=pidy(k);
   pidxc(1)=piderror(k)-piderror_1;             %Calculating P
   pidxc(2)=piderror(k)-2*piderror_1+piderror_2;   %Calculating D
   pidxc(3)=piderror(k);                     %Calculating I
   
   piderror_2=piderror_1;
   piderror_1=piderror(k);
end
if M==1
figure(1);
% % plot(time,yd,'r',time,y,'k:','linewidth',2);
% xlabel('time(s)');ylabel('yd,y');
% legend('ideal position','position tracking');
% figure(2);
% plot(time,y,'r',time,ym,'b','linewidth',2);
% xlabel('time(s)');ylabel('y,ym');
% figure(3);
% plot(time,dyu,'r','linew
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值