Added submatrix class
Template magic
Test cases for submatrix object