Du hast Deine LCD-Ausgabe in der Interruptroutine, das ist nicht besonders schön, weil das LCD die Int ausbremst.

Für Tasten brauchts auch keine Interrupts, so schnell sind die Tasten nicht.
Aus der Mainloop per debounce Befehl aufgerufen würde dicke reichen.

Goto ist so ziemlich das größte Schreckgespenst .... brrrrr