Update usability of multiply and add methods.
Refactor generating of matrix T.