相关代码 |
|
a=[0 1 0 0;0 -0.2 3.92 0;0 0 0 1;0 0.25 -7*9.8/4 0]; b=[0 0.2 0 -0.25]'; q=diag([100,5,50,5]); r=0.2; n=[0;0;0;0]; lk=size(ans); lk=lk(1); mydata=[]; for i=1:lk; %[a,b,c,d]=linmod('yyy',k(i,:)); [K,S,E]=lqr(a,b,q,r,n); X=ans(i,:)*K'; R=[ans(i,:),-X]; mydata=[mydata;R]; end mydata;
相关资源 |
|