Configurazione Tastiera e schermo LCD

Buongiorno a tutti! Utilizzo un Mega2560 e sto cercando un metodo per inizializzare l'esecuzione di un codice. Vorrei utilizzare lo schema presente nella seguente immagine

In particolare vorrei inserire dei valori numerici da tastiera e utilizzare il simbolo '#' per cancellare un valore scritto (oppure cancellare totalmente il valore e richiedere l'inserimento) mentre utilizzare '*' per l'invio del valore desiderato.
Per farvi un esempio, quando il programma inizia vorrei:

"inserire Kp" (quindi una volta aver inserito un numero, premo '*' e salvo questo numero in una variabile)
Dopo aver salvato questo valore devo avere:
"inserire Ki"

Spero di essere stato abbastanza chiaro.
Grazie

Per la gestione della keypad puoi vedere qui.

Per la gestione dello schermo lcd puoi vedere qui.

Gli esempi sono significativi e chiari. Poi butta giù un programma e dicci che problemi hai.

Ciao,
P.

Ciao, grazie mille per i link. Proverò quindi a programmare e se ho problemi riscrivo su questo post.