add collision shapes when load_to_world()
create function get_collision_shapes when loading from urdf