add everything back and done matmult_p.c and matformatter.c