Linked on this page are the two versions of Arduino code we used. The first version was used when there was still a threaded rod style claw. The second is the version we used during the tournament. It is more optimized than than the first version and was written for the servo style claw. The flowchart of our system is below the linked code.
Above is the flow chart for our robots turn. The robot approaches the tower and checks if the target block exists. If it doesn't it moves down to the next row it can grab and checks again. If the block does exist, the robot moves forward to grab while simultaneously checking if the middle block exists. If the middle block is there, the robot grabs the block, returns to the start, and drops the piece into a net.