Added gtest
Integrated SDM back in - going to merge everything next