1function Ad_g = calculateAdjointInverse(g) 2 3rotation = g(1:3,1:3); 4pos = g(1:3,4); 5 6Ad_g = [rotation', -rotation'*skew(pos); zeros(3,3), rotation']; 7 8end