graph structure for kinematic chain
Parts of Chain
Chain
Build a Link<T>
Link<T>
Node for joint tree struct