Improved Pathfinder.java, cleared classes of extra unused variables and memory