Boa noite Osvaldo,em primeiro lugar, parabens pelo projeto e iniciativa, ficou 1000!!!!
Tbem ja montei a minha, mas não usei as teclas  increm, set e const. Como a minha é uma placa de 4 eixos, acrescentei o A+ e A-.
Fiz tudo como vc postou mas não estou conseguinte resultados com as teclas reset e zero, mesmo apertando o f7 e o f8 no teclado, os mesmo não estão respondendo.
Gostaria de sua ajuda.
Desde ja, agradeço sua atenção.
Abraços.