Ayuda con Menu

Hace muy poco que experimento con Arduino y los ejemplos que vi no son muy claros para mi, arme algo estraido de la web y modificado por mi , pero tengo algunos problemas al intentar realizar algunas subrutinas de lectura de acuerdo a la posicion dentro del menu, aca les dejo el sketch con la aclaracion de donde quiero leer los valores, estoy usando una placa Arduino leonardo con una LCD con Keypad, por eso los valores de los botones son analógicos.
A ver si me dan una mano, yo se mucho de PLC, pero con esta forma de programar algunas veces me pongo loco... Ja Ja!!

Les adjunto el Sketch como archivo porque supera el limite

sketch_apr14c.ino (4.69 KB)

Podrías especificar que LCD estas usando...?

Usa el shield LCD que tiene los 5 botones conectados al A0.

Existen librerías de menú que hacen lo que quieres con gran calidad. Busca MENWIZ y verás de que hablo.
Esta en el Playground de Arduino.

Repito no te respondo porque veo todo tu código pero no se que esta mal.