Added class for handling test code

New class (bhs_test) for testing code. Utilized by the necessary classes
in order to use the testing functionality in the driver station. **Needs
to be tested / gone over by Silu / the powers that be**