Move some tests to .cpp files
refactor Matrix tests
Re-factor MatrixOps tests
TestPoint3D
Move test implementations to .cpp files