Hmm. I've got a pretty decent pathfinding algorithm that handles flat surfaces with a height variation of no more than 100 quants. I will wait for your 3d solution (which is no trivial task). Good luck with that.