Convert existing tests to automated GTests

We should set up a more automated way of making sure our code and hardware behave the way we expect it should.

Any sub-programs that can be used to gather data should be moved to utilities and the existing "Tests" should be converted to a GTest.