L=[  0.1585   0.0668  0  -0.0863   0.0251 0 0
  -0.2060    -0.0871  0 0.1120    -0.0339 0 0];

Kf=0.4*[1;1];

T_f=0.3;
