Siento no poder comentar nada sobre el mach, ya que no lo uso.
Para el montaje que he usado en este post solo hay que añadir una linea en algún fichero hal.
Si conectamos la "sonda" a la entrada 10 de la breakboard hay que añadir lo siguiente:
net probe parport.0.pin-10-in => motion.probe-inputEsta linea lo que hace es decirle al emc a que entrada tenemos conectada la probe. Por supuesto en el caso de usar un puerto paralelo que es lo que habitualmente hacemos.
En el código G que puse mas arriba esta parametrizada la zona a escanear, solo hay que modificar esos valores. Poner a 0 la maquina y ejecutar el programa.
Mientras escanea, va guardando en formato x y z un fichero, el "probe-results.ngc" que guarda en el mismo directorio que esta la maquina.
He usado el programa meshlab
http://meshlab.sourceforge.net/ que permite importar nube de puntos y representarlos. es dominio publico aunque esta en ingles.
Para que el meshlab reconozca el fichero con la nube de puntos hay que cambiarle la extensión al fichero por .asc
En el meshlab importas un mesh y ya lo tienes en pantalla.
Si queda alguna duda, intentare responder mejor a las preguntas.