Here is the NEW NEW code design because the last one wasn't working for us. Here has everything in one class in the simple robot template. everything looks like it is going to work but we just need to test it. :)

~TurtleXing