Add GTest for CI and Off-Target Testing

Add GTests for each module so we don't need to hardware test individual modules on more minor changes. This should probably be done as I doubt SITL/HITL setups are prioritized in the near future for PROS. 