Proposal of a new scheme for parsing urdf to kdl - consider urdf root as a real segment