Calculate times to arrival, next/current direction, next point
Tidy ups, calculate timeToDirection at each gps tick