Adding code for shortest path alg, need to convert lat/long to x and y first.