K = [568.996140852 0 643.21055941;
     0 568.988362396 477.982801038;
     0 0 1]