ich würde die waitMs noch mindestens in die if abfrage reintun, sonst fragt der controller den taster nur alle 200mS einmal ab und das ist schon recht viel zeit in der man den taste eben mal antippen kann ohne dass er es merkt ...

besser wäre noch, wenn du 2 if abfragen verschachteln würdest

so ala pseudocode

if (taste gedrück) warte 15ms; if (taste noch immer gedrückt) +1;

stichwort hier ist "entprellen" : wenn du drückst, registriert der controller ein oder zwei dutzend signale, daher beim ersten zeichen eines drückens, kurz warten und dann nochmal nachschauen ob auch wirklich gedrückt wurde