Final program for 2014 robot