add matrix_blocking_fig.m for visulization