Added UsefulFunctions Library

You can include this library by putting it in the same folder as your
Autonomous/Teleop code and use #include "UsefulFunctions.c" at the top
of the code