function [R1,t1] = invForm(R,t)
    R1 = inv(R);
    t1 = -(R1*t');
end