Final Code Michael Brigham

Done:
Okay so I had an extra hour. I tested my code with the robot. It didn't
work so I changed it. It is now even MORE COMPLICATED! So it needs help
from other programmers. But right now it works flawlessly! YAY!