Copied drivetrain code from Robot2012