Problema con menú al que se accede desde un interruptor

Y porque no usas las librerías de menú que existen?

Hay muchas librerías buscar Arduino Menu. Algunas son fáciles de usar y otras no tanto. Todas en inglés asi que tomalo con calma.
Un ejemplo es MenuBackEnd y hasta hay un tutorial

El tutorial esta hecho para varios pulsadores pero debe estar contemplado el uso para un teclado como el tuyo.
Revisa !!