Restructured, added A* Pathfinding
restructure