Tastenmatrix, mal wieder

[Martin K. (dschadu)]

Edit: Vergesst es, hab PullDowns vergessen...

Hi,
ich versuch grade eine Tastenmatrix auszulesen, aber irgendwie 
verzweifel ich grade.
Anzeigen tu ich mir die gedrückte Taste aktuell noch auf einer 7 Segment 
Anzeige, das funktioniert einwandfrei.
Die Anzeige springt aber hin und her, ich hab jetzt alles soweit raus 
gelöscht, das ich nurnoch 1, 4, 7 oder n (für Stern-Taste) anzeige.
Mal steht die Anzeige, dann springt alles wild hin und her. Ein 
Tastendruck wird nur manchmal wirklich angezeigt, danach flimmert alles 
wieder. Normal soll die letzte gedrückte Taste einfach dauerhaft 
angezeigt werden.
Angeschlossen ist im Konkreten Beispiel PC5 als Output, über die 
Tastenmatrix zurück auf PD0..PD3

Hat jemand Rat warum die Anzeige spinnt? Bzw warum's nicht so hinhaut 
wie ichs möchte?

#define F_CPU 16000000


/* Includes */
#include <avr/io.h>
#include <util/delay.h>
#include <avr/interrupt.h>

#include "config.h"

uint8_t pressed = 12;    //12 = Default Wert, 10 = *, 11 = #

int main (void)
{
  TCCR0 |= (1<<CS02)|(1<<CS00);        //CS02, CS00: Prescaler 1024, ~16,384ms
  TCCR2 |= (1<<CS22)|(1<<CS20);        //CS22: Prescaler 128, ~10,24ms
  TIMSK |= (1<<TOIE0)|(1<<TOIE2);      //Overflow Enable für Timer0&Timer2 (8bit)

  DDRD = 0b11110000;      //Ausgänge setzen
  DDRC |= (1<<DDC5);      //Ausgang setzen
  PORTC |= (1<<PC5);      //PullUps Einschalten

  sei();

  while(1)
  {
    [...] //Zuweisung Tastendruck -> Anzeige (und reset von 'pressed' auf 12)
  }
}

ISR(TIMER2_OVF_vect)
{
    [...]
}

ISR(TIMER0_OVF_vect)
{
  //Tastendruck zu "pressed" zuweisen
  if (Row1) pressed = 1;
  if (Row2) pressed = 4;
  if (Row3) pressed = 7;
  if (Row4) pressed = 10;  
}

config.h:

#define Row1 (PIND & (1<<PIND0))
#define Row2 (PIND & (1<<PIND1))
#define Row3 (PIND & (1<<PIND2))
#define Row4 (PIND & (1<<PIND3))