JAVA code for the Harlem Knights 2014 FRC Robot