|
Revision 1249, 0.6 kB
(checked in by zimamiro, 15 years ago)
|
|
|
| Line | |
|---|
| 1 | function [ztrata H]=lqg_control(system, apriori,regulator_parameters)
|
|---|
| 2 | horizont=system.horizont_rizeni;
|
|---|
| 3 | ztrata=0;
|
|---|
| 4 |
|
|---|
| 5 | H=zeros(horizont+1,size(apriori.H,1),size(apriori.H,2));
|
|---|
| 6 | u=zeros(2,horizont+1);
|
|---|
| 7 | H(1,:,:)=apriori.H;
|
|---|
| 8 |
|
|---|
| 9 | for i=1:horizont
|
|---|
| 10 | H0(:,:)=H(i,:,:);
|
|---|
| 11 | u(:,i)=simple_control(system,H0(:,1), regulator_parameters.horizont_simulace);
|
|---|
| 12 | system.x=get_next(system,system.x_skutecne,u(:,i));
|
|---|
| 13 | H1=kalman_filter(H0,u(:,i),system);
|
|---|
| 14 | H(i+1,:,:)=H1;
|
|---|
| 15 | ztrata=ztrata+(H1(:,1)-system.x_optimalni)'*system.ksi*(H1(:,1)-system.x_optimalni)+u(:,i)'*system.gamma*u(:,i);
|
|---|
| 16 | end
|
|---|
| 17 | end
|
|---|
| 18 |
|
|---|
