GOALS are not 3d proof
goals are defined without a z-coordinate.
As long as they are outside, we can assume, they are well-defined. Are goals allowed to be inside a building? (I think, they are. At least the program checks, if a pedestrian reached its goal even if he is inside.)
If so, we need to talk about that.