Fixes for Matrix and Vector. Unit tests for Matrix.
Additions to Math<Real> (atan, atan2, fastinvsqrt)