You could definitely get rid of all the do-while loops in kbd_poll. They are completely useless since it's almost certain that none of buttonUp, buttonDown, buttonLeft and buttonRight will ever...