Pues podría ser eso.
Como he dicho soy electrónico y la programación... 
Ya probé con if (pero no me funciono) buscando y buscando por internet fue lo único que el simulador me dio ok ( y funcionaba), pero en el simulador, en placa como que no, nada de nada, a veces responde otras no, otras hace lo que quiere.
Como lógica para mi pe parece obvio, aunque se ve que para la placa no.