hmm... hast du dich mal mit interrutgesteuerter tastererkennung beschäftigt? das dürfte die sache einfacher machen. in der main-funktion steht dabei nur der code fürs geradeausfahren, und in der interruptroutine steht der code fürs anhalten und blinken.