New MATLAB code for mapping toolbox