Planning along Differentiable Charts of Constraint Manifolds with General-Purpose IK Solvers
A new approach for computing gradients of analytic IK parameterizations is presented, using the inverse function theorem to recover the desired gradients from the ordinary forward kinematic Jacobian, and a least-squares domain extension and an optimization-amenable description of the reachability constraint are present...