template Matrix scale.
Add UpperDiag mathod in Matrix
Matrix testcase