Robot control code for 2014 Ultimate Assist