K = [ 768.5983         0  319.8981;
         0  768.1096  268.4945;
         0         0    1.0000];

kc= [-0.1800    0.1663   -0.0003    0.0012         0];