Improved the creation of the non meshes from the urdf and added a test version for pr2