-
Notifications
You must be signed in to change notification settings - Fork 46
Open
Description
Is your feature request related to a problem? Please describe.
Line 65 in 965e5e1
| , ik_seed_(Eigen::VectorXd::Zero(dof_)) |
It appears that the IK seed for the Descartes robot sampler is set to all zeros by default. Solving IK with a seed of zero for robots whose all-zeros configuration is a singularity (e.g,. Franka FR3) fails for gradient based solvers like KDL. This in turn makes Descartes fail.
Describe the solution you'd like
- The
RobotSamplerclass should accept an IK seed as an input argument (or give public access to it) DescartesDefaultPlanProfile::createWaypointSamplershould attempt to set the IK seed using the inputMoveInstruction
Describe alternatives you've considered
N/A
Additional context
See this issue for more context
Metadata
Metadata
Assignees
Labels
No labels