Robots Project
A full report of the project can be found in the following PDF file:
Code
Video
Here's a video of the robot running the Project code. Notice how it pushes the pots aside in the beginning, then goes around picking blocks up.
Experimental Code (probably does not work!)
More Info
I was working on getting the "Internal Block Deliver" state to work. This is what I did so far. It probably doesn't work very well however.