Matrix and Quaternion classes finished

Wrapped up Matrix3, Matrix4, and Quaternion for the time being. Still
needs testing.