Function added for Path Finding (imcomplete) -- still working

-halfway done implementing Java into the code
-still understanding the use of PriorityQueue
-will be done by the end of Friday in the least