improve parse_urdf function, add simple_shapes.dae. Remains to take into account mesh transform and scale given in urdf