参考文献:《最优控制与姿控喷流在导弹姿态控制中的应用》
%跟踪正弦结果可以看出,实际偏航角与指令值存在一定的跟踪误差
%从仿真结果可以看出,时间最优bang-bang控制律是以牺牲跟踪精度来满足时间最短的要求
clear
clc
A=2500;
B=10.625;
a=A/B;
Mf=245;
x1=0;%偏航角初始值
x2=0;%偏航角速率初始值
n=1;
t=0;
dt=0.001;
for i=1:20000
feac=30*pi/180;%期望的偏航角---常值
% feac=5*sin(pi/5*t)*pi/180;%期望的偏航角---正弦值
fea2=feac-a*x2+Mf/B*a*sign(x2)*log(1+B/Mf*abs(x2));%开关线方程
if x1>fea2
U=-1;
end
if x1<fea2
U=1;
end
if x1==fea2 && x2>0
U=-1;
end
if x1==fea2 && x2<0
U=1;
end
if x1==fea2 && x2==0
U=0;
end
% if abs(x1-feac)<0.001%当误差足够小时不再调整
% U=0;
% end
Dx1=x2;
Dx2=-B/A*x2+U*Mf/