I\'m trying to use some inverse kinematics algorithm to perform a path planning task. I take my path as a kinematic chain with joined segments and define the start and targe