Working autonomous

Lots of changes, but autonomous works. Includes encoder code, reed
switch code, and a bunch of other things.
Bag and tag