Code for the Magruder 2014-2015 First Tech Challenge robot