Flesh out unit tests

I spent a whole ton of time getting travis to build/setup ROS properly for CI, but its not really utilized in the unit tests yet. There's an empty file for integration testing with ROS (ie: send a ROS message and verify interop properly handles it).