Changed all int coordinates to coord structs.
Split Lee's algorithm in several functions e.g. to determine the length of a route before actually using it.