Java code for Team 178's 2014 robot