start to build algrithom

开始实现算法，创建矩阵