COMMON: TransformationMatrix (updated)

Fix for various mistakes made when rewriting TransformationMatrix.