Moved all functions over to separate file...only thing to do is clean up
the Pathfind function and testing will commence!