Calculate the mass matrix (still need some verification).