In regards to what the camera code will do with 2 tetras in sight, I believe I read that it will track the object with the largest bounding box (or closest tetra). However, by default, it will track the first thing it sees (such as another team's tetra). This is what we're doing:
1: Pan left and right while at a standstill.
2: Record the pan angle that located the largest amount of green.
3: Rotate accordingly and head forward.
NOTE: If you have to keep turning, your teammate may have that tetra...
5: When the bounding box is big enough stop, pick it up.
7: Relying on the starting position, and the initial turn from step 2, turn to the center goal (unless you dont want to cap the center).
8: Begin tracking yellow.
9: When the bounding box is big enough, stack.
10: Ungrab and backout.
11: Track a loading station?
Who needs drivers? Lets have a COMPLETELY autonomous robot!
