Two ball autonomous!

Also fix pickup code