Replace explicit A * M * A^T with M.similarity(A).

Initial foray into tiding up some of the GSF code per suggestion from @christos. This is a fairly superficial change just to get some more familiarity with the code.