Mapping almost ok in MATLAB