-
kinmematics frame of each link is infered rather than defined in urdf
-
each joint position and orientation is defined relative to it's parents kinematics frame
-
the parent kinematics frame is defined as the frame of it's parent joint
-
the kinematics frame of root link is eye(4)
-
the inertia tag of each link is about it's dynamic property and is independent of kinematics
-
the visual tag of each link is about it's visual property and is independent of kinematics
-
the inertia and visual frame is defined relative to it's kinematics frame described above
-
start with frame eye(4) and succesively multiply the homogenuous transfrom constructed from origin:xyz-rpy of it's parent joint
-
joint absolute direction can be obtained by multiply joint axis: xyz with it's absolute orientation matrix