Brought in code from UglyBetty

transferred all the new code into real robot code
mergey merge