Optimization

Created some files which take a converted map and use Dijkstra's algorithm to find the shortest path from a start to a destination. At this juncture, the code will find the path, however, the code is not able to convert it into an ArrayList that drives only on the right side of the road.