Adds basic functionality to calculate distance, angle between each subsequent vertex in dijkstras