matmult_p implemented with shared memory working