Se agrego el diagrama esquematico en el programa Fritzing.

Además se simplificó el código.