Finished up path finding and added special comparisons for coordinates