Como hacer un cabezal divisor 5C controlado con motor de paso y Arduino pantalla tactil Parte 2

Esta es la parte 2 de "Como hacer un cabezal divisor 5C controlado con motor paso a paso y Arduino touchscreen".
Cambie un poco el codigo del arduino, lo expliquo al final.