模糊控制PID MATLAB M文件實現

clear all
close all
ts = 0.001;
sys = tf(133,[1,25,0]);
dsys = c2d(sys,ts,'z');
[num,den] = tfdata(dsys,'v');


e_1 = 0;
u_1 = 0;
u_2 = 0;
y_1 = 0;
y_2 = 0;
I = 0;
for k = 1:1:30000
    time(k) = k*ts;
    %yd(k) = cos(k*ts);
    yd(k) = 1;
    y(k) = -den(2)*y_1 - den(3)*y_2 + num(2)*u_1 + num(3)*u_2;
    e(k) = yd(k) - y(k);
    de(k) = e(k) - e_1;
    
    for l1 = 1:1:3
        gs1 = -[(e(k) + pi/6 - (l1-1)*pi/6)/(pi/12)]^2;
        u1(l1) = exp(gs1);
    end
    
    for l2 = 1:1:3
        gs2 = -[(de(k) + pi/6 - (l2-1)*pi/6)/(pi/12)]^2;
        u2(l2) = exp(gs2);
    end
    U = [-1000 -100 0;-1000 0 100;0 100 1000];
    fnum = 0;
    fden = 0;
    for i = 1:1:3
        for j = 1:1:3
        fnum = fnum + u1(i)*u2(j)*U(i,j);
        fden = fden + u1(i)*u2(j);
        end
    end
    u(k) = fnum/(fden+0.01);
    u_2 = u_1;
    I = I + e(k);
    u_1 = e(k)*(0.35*u(k)+50)+5*(e(k) - de(k))+0.1*I;
    y_2 = y_1;
    y_1 = y(k);
    e_1 = e(k);
end
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,u,'r','linewidth',2);
發佈了27 篇原創文章 · 獲贊 119 · 訪問量 17萬+
發表評論
所有評論
還沒有人評論,想成為第一個評論的人麼? 請在上方評論欄輸入並且點擊發布.
相關文章