Fix tests to use mocks until wpilib is available