UNO: Create a state machine for the robot logic. Cleaned the code up like I can't belive.