EnvCreator. class for creating urdf files from occupancy grids. also supports generating A* trajectories with collision constraints