Pure pursuit algorithm implementation.
Given a set of waypoints, the algorithm determines a curved path to follow throught them.
This is applicable in autonomous control in events such as FRC.
Here it is running the "FRC 2020 Lightspeed Circuit AutoNav challenge path: