L=[ 0.3990   0.1295  0  -0.1718   0.0446 0 0;
    -0.4832    -0.1614 0  0.2003    -0.0998 0 0];
Kf=1.27*[1 1];

T_f=0.3;

