Функционал работы щупа настраивается в hal-файле.
УП съема карты высот генерируется в стороннем приложении.
Я использую G-Code Ripper, который имеет и другие полезные функции.
А для получения карты высот, скармливаешь ему УП, которую собираешься выполнить на кривой заготовке - получаешь УП съема карты высот.
Снимаешь карту с помощью этой УП - получаешь текстовый файл с данными замеров.
Скармливаешь этот файл G-Code Ripper - получаешь скорректированную на кривизну исходную УП.
В GRBL это делается попроще, а здесь - так.
