Setz erstmal das "Cursor off" vor der do-loop. Man muss dem Display dieses nur einmal zur Laufzeit mitteilen - und nicht permanent. Und anstatt Lowerline und Upperline wuerde ich fest definierte Cursorpositionen anspringen. Also z.B. mit Locate 1,1, oder Locate 2,1 usw.
Und wo ist das "Return" in Deiner Sr-Sub? Und wenn man schon mit Sub's arbeitet, wuerde ich dem Atmel obligatorisch auch etwas hwstack, swstack und framesize spendieren. Schau mal ins Bascom-Beispiel fuer "Debounce".
Und wo wir schon mal grad dabei sind: ein "Config Debounce" gibt's bei Dir auch nicht. :)

Mit freundlichen Gruessen
Digitali