Robot code for the 2020 FRC game, Infinite Recharge.
./gradlew test will test that trajectories generate correctly and save them to paths/ for analysis.
To plot a trajectory, install gnuplot and use the provided gnuplot script: gnuplot -e "path='paths/TRAJECTORY_NAME.csv'" paths/path.plt