Robot code adjustments for WPI