Pure Pursuit
Pure Pursuit is a geometric path tracking built around the idea of “chasing” a lookahead point on the path ahead of it and then computing a curvature and corresponding angular velocity for the rover to drive along a circular arc that will intercept that lookahead point. Read more about that here.
To accomplish this, you will modify the DriveController class, overloading the get_drive_command function to accept a trajectory. This will allow us to still utilize the original well-tested drive control behavior before fully adopting Pure Pursuit.
Run git fetch and then git checkout nav/pure-pursuit to checkout the shared Pure Pursuit project branch. Here there is some skeleton code to begin with, and you can work collaboratively with others to complete this project.