Initial implementation of April Tag response functions

[0novo]

Basically: 1) define a function in AprilTagFuncs 2) head down to the while (opModeIsActive()) loop 3) look for the switch statement and add a case statement for your new function

Pretty barebones at the moment and a little horrible We can add more functions later and/or remake the system as it stands (i.e. close this pull request in the latter case)

[0novo]

like in autonomous? or like in its own class in a different file?

[sevenbitscience]

Own class in separate file

[0novo]

a hardware map (#20) would be nice so we could pass it to functions instead of doing some awkward workaround