Removing makeIdentity function and making it a member function for now: identity(). Fixing isOrthogonal() function and tests.