Autonomous 2 actual code

missing arm movement and goal grabbing.

-Tyler Nelson