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 (P_6T) may be slightly wrong and should be double-checked. (DH notation will be added in the future)