Added MatrixMult and KDTree