Jacobian for differential motion
J = tr2jac(T)
J = TR2JAC(T) is a Jacobian matrix (6x6) that maps spatial velocity or differential motion from the world frame to the frame represented by the homogeneous transform T.