Autonomous and Tele-op code for FTC's Ring It Up game