Copy/Paste of old EM MATLAB code