A gauge-invariant formulation for constrained robotic systems using square-root factorization and unitary transformation | IEEE Conference Publication | IEEE Xplore