Create a testing suite

[pertbanking]

I don't think Vanderbilt Robotics is going to be using this class intensively, so coding a test suite now might be overkill. Down the road though (maybe after competition), I'll make a suite with gtest and create a test suite to make sure other people can use this properly.