The only other problem left to solve is the 3D bit, elevation could be added to nodes as well, but all we need then is GPS equipment that has more accurate elevation.