Compute nearest index within threshold after walking distances | Tesla