corrected lack of addition to initial C matrix
corrected blocking bug
trying various improvements
split cases for small and large matrices