[C++] Rewrite URDF parser

The geometries are now loaded by reading again the URDF file. From now,
one has to build a model first from a URDF file, then to load the
geometries according to this model.