Add Nodes, optimize and fix some code. Generate tree from walkable sections.