Drive Thread (Extra credit only)

[adnewhouse]

You should figure out how to spawn a thread that handles drive in auto and teleop faster than the normal scheduler runs (50ms or 20hz). Looks at last years code for example (we ran a thread at 200hz). This is helpful for autonomous drive path playback. Also play with autonomous routines based on command groups for simple autonomous mode construction.