Added first version of map_2d.m

Documentation not complete, but I believe it works correctly.