Robot Kinematics

Robot Kinematic using POE notation from available xacro (URDF) file. All dimensions are in meters. The distance to the end effector mounting location (P6T) may be slightly wrong and should be double-checked. (DH notation will be added in the future)