Abstract Auton Logic into Commands

[alicekuznetsov]

          This logic is repeated a lot (even repeated in preload and taxi) it might be smart to have a like command VisionDrivePathShoot that can be called multiple times with parameters because the steps are the same and this ensures we don't forget to do one.

Originally posted by @TaylerUva in #105 (comment)