Autonomous 2 code

Jake and i worked on the pseudocode for autonomous 2

-tyler and jake swag