add get_diagonal_vector() to SGMatrix class