Pathfinding

I made a bit of an update.
I’ve made the whole thing much faster (up to 300x when loading a mesh, up to 30x on the pathfinding) and much simpler, you can use it like this:

#import 
from pathfollower import PathFollower
from navgraph import NavGraph
#setup
seeker=PathFollower(node=some_node_of_mine)        
graph=NavGraph(mesh=some_loaded_model)
#usage
path=graph.find_path(start=(0,0,0), end=(1.23, 123., 0.0))
if path:
    seeker.follow_path(path)

On my PC it can find a path in 0.0005-0.0165 seconds (depending on the length of the path) in a graph with 14k nodes.
Tested both on Py3.6 and Py2.7