用C ++对角对矩阵排序