Our java code for FRC, it includes basic use of drivetrain with encoders to drive to the line