This is the code used for our robot during the 2023 season.
PS: We are a team of all highschool freshmen so please don't criticize our code too much but, if there is something that you see coud be fixed do not hesitate to submit a PR or leave a comment/feature request.
Liscense: MIT
All code posted here was written by me except the original PID code which was written by Evan Ingoldsby.