Inverse Kinematics
This is the harder problem of Forward Kinematics.
poses joint positions
For a general n degree-of-freedom open chain with forward kinematics , , the inverse kinematics problem can be stated as follows: given a homogeneous transform , find solutions that satisfy .
Writing your own IK solver seems like quite the hassle. Instead, one of the following:
- Kinematics and Dynamics Library
- MoveIt
- CuRobo (?)