iCub URDF Parsing