Code to run the belt-drive FRC robot