Base code for the 2015 competition, using command based robot