Add template parameter to SMatrix
Add template parameter to DMatrix