The vision code for FRC 3501's 2014 robot