which is based on this method https://www.ri.cmu.edu/publications/implementation-of-the-pure-pursuit-path-tracking-algorithm/