Added autonomous for pickup
Got rid of dead code
Misc Changes