Started making the graphsearch structure
Created basic BFS graph search that is working.
Fixed a bug in isGoalState (You weren't checking the first or last positions)