I wrote a very fast pathfinding algorithm (a*) in lite-c. I sell the license of the easy to use sourcecode. Two (both) very fast methods are available.
The method for 3DGS-pathtrees:click the image for the demo
The method for nodes:click the image for the demo
If you're interested licensing the sources please contact