Code of the FRC 2014 robot "Jorge" from team #4673 "Solar Engineering"