Function to estimate current position of vehicle in route