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