Added lots of MPM energy function