LCPMotionPlanner
LCPMotionPlanner copied to clipboard
Detect manipulator singularities
Kinematic singularities can cause the M matrix of the LCP to lose rank. Detect these singularities and reduce the dimension of the LCP to yield a valid solution.