The inverse kinematics first constructs a functional representation of the endeffector position.
This should be abstracted to its own function which return a presentation of the full homogeneous transformation.
It could then be used to implement different kinematics and planning algorithms
The inverse kinematics first constructs a functional representation of the endeffector position. This should be abstracted to its own function which return a presentation of the full homogeneous transformation.
It could then be used to implement different kinematics and planning algorithms