[King Nerd III]

So autonomous worked once the code was uploaded, so let me explain what it does. The robot starts ready to pickup both the first tote and can. Right when auto starts both elevators lift up. Once those finish the robot drives forward to the next tote, while swinging the left arm and first can out of the way. Once at the second tote it lowers both elevators at the same time. Right after that it swings the right arm in and lifts the second tote. Once the second tote is lifted it lefts the second tote. Once all of that is finished the robot lifts the second can. Right after that it continues to drive to the third tote while swinging the right arm and second can out. Once at the third tote it lowers and subsequently lifts the third tote. After lifting all three totes the robot turns towards the auto zone, drives to it while lifting the front elevator a little bit more, and then stops in the zone. Finally it drops the totes, and drives backwards so we aren't touching the stack.

All of this had to be split up into separate CommandGroups because the AddParallel() doesn't work as it is supposed to with our robot. So if anyone wonders why everything is shattered into small parts, that's why.

-Isaac, Chief Programmer/Head of Autonomous Control