#include "../config.h"
#include "../makros.h"

#include <avr/interrupt.h>
#include <avr/io.h>
#include <avr/wdt.h>

#include "borg_hw.h"


#define ROWPORT  PORTC
#define ROWDDR DDRC

#define COLPORT PORTA
#define COLDDR DDRA

#define MYPORT PORTC
#define MYPORT2 PORTA

#define SHOW 0
#define DATA 1

#define PIN_ENABLE 0
#define PIN_DATA 1

unsigned char pixmap[NUMPLANE][NUM_ROWS][LINEBYTES];


inline void rowshow(unsigned char row, unsigned char plane){
	
  unsigned char p, n,m, outb, clkmsk;

  clkmsk = 0x80>>row;
  
  // if (row==4)
  {
     MYPORT &= ~(1 << PIN_ENABLE) ;
     //MYPORT |= (1 << PIN_ENABLE) ; //hide
    // MYPORT |= (1 << PIN_ENABLE) ; //hide
    for (n=7;n<8;n--)
    {
      outb = pixmap[plane][row][n];
      p=0x80;
      for (m=0;m<8;m++)
      {
        if (outb & p)
         // MYPORT |= (1 << PIN_DATA);
         MYPORT &= ~(1 << PIN_DATA) ;
        else
         // MYPORT &= ~(1 << PIN_DATA) ; //off
          MYPORT |= (1 << PIN_DATA);
       
        MYPORT2 &= ~clkmsk ;
        MYPORT2 |= clkmsk ;

        p>>=1;

      }
    }  
  }
  MYPORT |= (1 << PIN_ENABLE) ; //
   //MYPORT &= ~(1 << PIN_ENABLE) ;
   // for(n=0;n<250;n++) asm ("nop");
 

}

SIGNAL(SIG_OUTPUT_COMPARE0)
{
  static unsigned char plane = 0;
  unsigned char row = 0;

  switch (plane){
    case 0:
      OCR0 = 60;
      break;
    case 1:
      OCR0 = 120;
      break;
    case 2:
      OCR0 = 160;
      break;
   // case 3:
     // OCR0 = 24;
    //  break;
   // case 4:
   //   OCR0 = 48;
   //   break;
  }
  
  for(row=0;row<NUM_ROWS;row++){
  	rowshow(row, plane);
  }
  
  if(++plane==NUMPLANE) plane=0;
  wdt_reset();
}



void timer0_on(){
/* 	TCCR0: FOC0 WGM00 COM01 COM00 WGM01 CS02 CS01 CS00
  CS02 CS01 CS00
  0    0    0	       stop
  0    0    1       clk
  0    1    0       clk/8
  0    1    1       clk/64
  1    0    0       clk/256
  1    0    1       clk/1024
	
*/
  TCCR0 = 0x08 |0x04;	// CTC Mode, clk/256 MH: slower 5 statt 4
  TCNT0 = 0;	// reset timer
  OCR0  = 0x30;	// Compare with this value   0x30
  TIMSK = 0x02;	// Compare match Interrupt on
}

void timer0_off(){
  cli();
 
    MYPORT &= ~(1 << PIN_ENABLE) ;
   //MYPORT |= (1 << PIN_ENABLE) ; //hide
	//COLPORT |= (1<<PIN_LINE_EN);//blank display
 // PORTD |= 0x01;//blank display
  TCCR0 = 0x00;
  sei();
}

void watchdog_enable()
{
  wdt_reset();
  wdt_enable(0x00);  // 17ms

}

void borg_hw_init(){
	//COLPORT |= (1<<PIN_CLK) | (1<<PIN_LINE_EN);
	//COLDDR |= (1<<PIN_CLK) | (1<<PIN_LINE_EN) | (1<<PIN_DATA);
	
	//ROWDDR |= 0x07;
	
  DDRA = 0xFF;

  DDRC = 0xFF;
        
  watchdog_enable();
  timer0_on();
}