A = [1, 0.1, 0; 0, 1, 0.1; -0.1, -0.2, 0.97];
B = [0; 0; 1];
C = [1, 0, 0];
D = 0;
x0 = [10; 0; 0];
Te = 0.1;
n = size(A,1);
p = size(C,1);

A1=A;
B1=B;
C1=C;
D1=D;