Added test configuration to test.cpp and MPU9150