Was ist denn konkret dein Problem?
Mit
Code:
uint8_t getPressedKeyNumber(void)
kannst du auslesen welcher Taster gedrückt ist....
Dann müsstest du bei jedem Tastendruck halt ein Zähler erhöhen oder kleiner machen und am Ende wenn das Programm gestartet werden soll noch gucken welche Nummer es sein soll. Da kannst du dann iwas mit switch machen.

Gruß,
Fabi