#define F_CPU 16000000
#include <avr/io.h>
#include <avr/interrupt.h>

volatile uint16_t matrix[5];
volatile uint8_t flag_slow;

void Init();
void InitPorts();
void InitTimer();

int main(void) {
  uint16_t tmp=1;

  Init();
  while (1) {
    if (flag_slow) {
      flag_slow = 0;
      tmp <= 1;
      if (tmp > (1<<13)) tmp = 1;
      // Update der Matrix
      matrix[4] = matrix[3];
      matrix[3] = matrix[2];
      matrix[2] = matrix[1];
      matrix[1] = matrix[0];
      matrix[0] = tmp;
    }
  }
}

void Init() {
  InitPorts();
  InitTimer();
}

void InitPorts() {
  DDRA= 0xFF;
  DDRB= 0x1F;
  DDRC= 0xFF;
  DDRD= 0x00;
}

void InitTimer() {
  //Timer1
  TCCR1B |= (1<<CS10) | (1<<CS12) | (1<<WGM12);
  TIMSK |= (1<<OCIE1A);
  OCR1A = 5;
  
  sei();
}

ISR(TIMER1_COMPA_vect) {
  static uint8_t c;
  static uint16_t slowly;

  // Multiplexen der Spalten
  PORTB = 0xFF;       // Spalte aus, low active
  spalte <<= 1;
  c++;
  if (spalte==32) {
    spalte=1;
    c = 0;
  }
  //Ausgabe der neuen Spalte
  PORTA |= matrix[c]>>8;
  PORTC |= matrix[c];
  PORTB = ~spalte;    // neue Spalte ein, low active

  //Debug LED
  PORTA ^= (1<<PA7);

  // slowy für eine "angenehme" Geschwindigkeit
  slowly++;
  if (slowly == 1500) {
    slowly = 0;
    flag_slow = 1;
  }
}