Write autonomous code

[NickOtt]

Tasks:

• [x] Logic for writing and reading file

• [x] Auton selection code based on dashboard input

• [x] Record inputs and store them to file

• [x] Playback inputs

Tasks for testing:

• [x] Test encoder accuracy (+/- 0 encoder pulses)

• [x] Test playback speed (record time = playback time)

• [ ] Test ground accuracy (robot ends in the same location as in recording)

• [ ] Test ground playback speed (add everything else, retest if record time = playback time)

[bholmbertelsen]

I added points 3 and 4

[bholmbertelsen]

I added points 5-8