Apologies for not mentioning earlier, but we are using C++. We have been in FTC for the past couple years, and we decided to move to the big league.
Also, we have been practicing with PID for a while, and I think that it wouldn't be in there.
We'll try recalibrating the motors.