Messed around with the path finding. Fixed a few minor problems. Committing before class starts.