Aggiungere terzo livello menu Nokia 5110 display

Ciao a tutti, dopo svariati tentativi andati male e un intera giornata su google devo chiedervi aiuto. Il programma è un menu per Arduino con display Nokia 5110 e i sottomenu. Quello che non riesco a fare è aggiungere un altro livello più basso per il menu. Premetto che il circuito è collegato correttamente e che il tutto funziona bene a parte che appunto non riesco ad inserire un altro livello di sottomenu.

Vi faccio un esempio pratico di quello che succede nel programma:

Menu Principale (vengono mostrati i sottomenu) → Relays → Luci (se premuto esce il messaggio “impostazioni salvate”)

Quello di cui ho bisogno io è creare un sotto-sottomenu con alcune opzioni (dovrebbero essere on/off e imposta timer) e dopodiché venga fuori il messaggio “impostazioni salvate”.

Allego lo schema del menu e il codice del programma.

Ringrazio anticipatamente chiunque dedichi il suo tempo per aiutarmi.

schema menu.txt (488 Bytes)

codice menu a livelli.txt (9.31 KB)