The map is a fairly large 3D dynamic environment but I\'m having a hard time determining whether to use diagonal distance or euclidean distance. My robot in question is able to
