2D Splay tree incomplete implementation
Pathfinding fixed, stable version