Added new compute_fem  function

Updates to FEMc.m