Refactor URDF model parser
Merge pull request #132 from megawac/urdf-mp

Refactor URDF model parser