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

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

#include "borg_hw.h"

/*
// Diese #defines werden nun durch menuconfig gesetzt

#define ROWPORT  PORTB
#define ROWDDR DDRB

#define COLPORT PORTD
#define COLDDR DDRD

#define PIN_DATA     PC4
#define PIN_CLK      PC6 //active low
#define PIN_LINE_EN  PC5 //active low

*/

#define COLDDR  DDR(COLPORT)
#define ROWDDR  DDR(ROWPORT)

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


inline void rowshow(unsigned char row, unsigned char plane){
	COLPORT |= (1<<PIN_LINE_EN);//blank display
		
	ROWPORT = (ROWPORT & 0xF8) | row;
	

	unsigned char b, d, x;
	for(b=0;b<LINEBYTES;b++){
		d = pixmap[plane][row][b];
		for(x=0;x<8;x++){
			if(d & 0x01){
				COLPORT |= (1<<PIN_DATA);
			}else{
				COLPORT &= ~(1<<PIN_DATA);
			}
			d>>=1;
			COLPORT &= ~(1<<PIN_CLK);
			COLPORT |= (1<<PIN_CLK);
		}
	}
	
	COLPORT &= ~(1<<PIN_LINE_EN);//unblank display
}

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

	if (row == 0){
		switch (plane){
			case 0:
				OCR0 = 7;
				break;
			case 1:
				OCR0 = 20;
				break;
			case 2:
				OCR0 = 40;
		}
	}
	
	rowshow(row, plane);
	
	if(++row == NUM_ROWS){
		row = 0;
		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
	TCNT0 = 0;	// reset timer
	OCR0  = 0x30;	// Compare with this value
	TIMSK = 0x02;	// Compare match Interrupt on
}

void timer0_off(){
	cli();

	COLPORT |= (1<<PIN_LINE_EN);//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;
	
	watchdog_enable();
	timer0_on();
}