For Reference I have these versions and surface mapping works.  Attached is a Picture of my 1st attempt once I got the probe to work.

Mach4 build 4089
ESS plugin 285
Screen Mach 5036
And I use an MB3 Board

If you cant download original files let me know I can send to you