A general algorithm for derivation and analysis of constraint for motion of polyhedra in contact | IEEE Conference Publication | IEEE Xplore