Adding Makefile and code for matmult_p