k
k copied to clipboard
fix link transform calculation
Links are conceptually attached to their joints. The old code treats them as if they were attached to the joints of the parent node, which is the joints parent. This PR changes this so links use the joint of their node as their parent joint, which is in line with how urdfs are loaded.