matlab积分饱和消除一例

最新推荐文章于 2024-05-15 15:34:53 发布

FreeWake

最新推荐文章于 2024-05-15 15:34:53 发布

阅读量766

点赞数

分类专栏： MATLAB 文章标签：积分饱和

本文链接：https://blog.csdn.net/JISANSAN/article/details/103673270

版权

MATLAB 专栏收录该内容

42 篇文章

订阅专栏

clc;clear all;close all
%convert transfer function to state spaces
num=conv([1 -3],[1 5]);
den_temp=conv([1 0],[1 1]);
den=conv(den_temp,[1 3]);
[Ap,Bp,Cp,Dp]=tf2ss(num,den);
%calculate gain of observer
po_temp=conv([1 10],[1 10]);
po=conv(po_temp,[1 10]);
Kob=T2place(Ap',Cp',po)';
%calculate coficient matrix
O1=zeros(3,1);O2=zeros(1,1);O3=zeros(1,1);
A=[Ap O1;Cp O2];
B=[Bp;O3];
%calculate gain of expended state spaces
p_temp1=conv([1 2],[1 2]);
p_temp2=conv(p_temp1,[1 2]);
p=conv(p_temp2,[1 2]);
K=T2place(A,B,p);
%initional
Kp=K(1,1:3);
Ky=K(1,4);%
delta_t=0.001;
t=0:delta_t:20;

xp_hat_dot=zeros(3,1);
xp=zeros(3,1);
y_plot=zeros(1,length(t));
u_plot=zeros(1,length(t));
y=0;
y_pre=0;
y_plot(1)=y;

u=0;
u_pre=0;
u_plot(1)=u;

r=ones(1,length(t));
disturbance=[zeros(1,(length(t)-1)/2) ones(1,(length(t)-1)/2+1)];
u_max=1.5;
u_min=-1.5;

for k=2:length(t)
    %
    u_dot=-K*[xp_hat_dot;y-r(k)];
    u=u_pre+u_dot*delta_t;
    u_pre=u;
    u=u+disturbance(k);
    if u>u_max
        u=u_max;
    elseif u<u_min
        u=u_min;
    end
    xp_hat_dot=xp_hat_dot+delta_t*(Ap*xp_hat_dot+Bp*u_dot-Kob*Cp*xp_hat_dot)+Kob*(y-y_pre);
    xp=xp+delta_t*(Ap*xp+Bp*u);
    y_pre=y;
    y=Cp*xp;
     
    y_plot(k)=y;
    u_plot(k)=u;
end
figure(1)
plot(t,y_plot,'-r')
xlabel('time (sec)');
ylabel('y');
hold on
figure(2)
plot(t,u_plot,'-g')
xlabel('time (sec)');
ylabel('u');