implementing matrix math and tests
adding quaternion math and tests