#include <avr/io.h>
#include <avr/pgmspace.h>
#include "led.h"

unsigned char PROGMEM const FontLookup [][5] = {
	{ 0x3E, 0x51, 0x49, 0x45, 0x3E },   // 0
	{ 0x00, 0x42, 0x7F, 0x40, 0x00 },   // 1
	{ 0x42, 0x61, 0x51, 0x49, 0x46 },   // 2
	{ 0x21, 0x41, 0x45, 0x4B, 0x31 },   // 3
	{ 0x18, 0x14, 0x12, 0x7F, 0x10 },   // 4
	{ 0x27, 0x45, 0x45, 0x45, 0x39 },   // 5
	{ 0x3C, 0x4A, 0x49, 0x49, 0x30 },   // 6
	{ 0x01, 0x71, 0x09, 0x05, 0x03 },   // 7
	{ 0x36, 0x49, 0x49, 0x49, 0x36 },   // 8
	{ 0x06, 0x49, 0x49, 0x29, 0x1E },   // 9
//	{ 0x00, 0x00, 0x00, 0x00, 0x00 },  // sp 
//	{ 0x00, 0x00, 0x2f, 0x00, 0x00 },   // !
	{ 0x00, 0x06, 0x09, 0x09, 0x06 },   // ° 10
//	{ 0x38, 0x54, 0xd4, 0x54, 0x18 },   // ę 
	{ 0x00, 0x49, 0x7F, 0x44, 0x00 },   // ł
//	{ 0x7F, 0x48, 0x44, 0x40, 0x40 },   // Ł 11
//	{ 0x46, 0x26, 0x10, 0xc8, 0xc4 },   // %
//	{ 0x08, 0x08, 0x2a, 0x1c, 0x08 },   // ->
//	{ 0x08, 0x1c, 0x2a, 0x08, 0x08 },   // <-
//	{ 0x44, 0x64, 0x55, 0x4C, 0x44 },   // ż
//	{ 0x14, 0x08, 0x3E, 0x08, 0x14 },   // *
//	{ 0x38, 0x44, 0x46, 0x45, 0x38 },   // ó
	{ 0x00, 0x00, 0x50, 0x30, 0x00 },   // , 12
//	{ 0x10, 0x10, 0x10, 0x10, 0x10 },   // -
//	{ 0x00, 0x60, 0x60, 0x00, 0x00 },   // .
//	{ 0x38, 0x44, 0x46, 0x45, 0x28 },   // ć
//	{ 0x00, 0x36, 0x36, 0x00, 0x00 },   // :
//	{ 0x10, 0x20, 0x7f, 0x20, 0x10 },   // ↓ ;
//	{ 0x04, 0x02, 0x7f, 0x02, 0x04 },   // ↑ <
//	{ 0x44, 0x64, 0x56, 0x4D, 0x44 },   // ź =
//	{ 0x00, 0x7e, 0x43, 0x7e, 0x00 },   // bat >
//	{ 0x02, 0x01, 0x51, 0x09, 0x06 },   // ?
//	{ 0x48, 0x54, 0x56, 0x55, 0x20 },   // ś @
//	{ 0x7E, 0x11, 0x11, 0x11, 0x7E },   // A
//	{ 0x20, 0x54, 0x54, 0xd4, 0x78 },   // ą
//	{ 0x7E, 0x11, 0x11, 0x51, 0x7E },   // Ą 
//	{ 0x7F, 0x49, 0x49, 0x49, 0x36 },   // B 
	{ 0x3E, 0x41, 0x41, 0x41, 0x22 },   // C 13
//	{ 0x7F, 0x41, 0x41, 0x22, 0x1C },   // D
//	{ 0x38, 0x44, 0x44, 0x48, 0x7F },   // d
	{ 0,0,0,0,0 }, // spacja 14
	{ 0x10, 0x10, 0x10, 0x10, 0x10 },   // - 15
//	{ 0x00, 0x06, 0x09, 0x49, 0x06 },   // °1 16
//	{ 0x00, 0x46, 0x09, 0x09, 0x46 },   // °2 17
//	{ 0x01, 0x00, 0x01, 0x00, 0x01 },   // kreska u góry 16
//	{ 0x40, 0x00, 0x40, 0x00, 0x40 },   // kreska na dole 17
/*	{ 0x00, 0x00, 0x1e, 0x00, 0x00 },   // | 16
	{ 0x00, 0x1e, 0x00, 0x00, 0x1e },   // || 17
	{ 0x1e, 0x00, 0x1e, 0x00, 0x1e },   // ||| 18*/
	{ 0x04<<1, 0x02<<1, 0x3e<<1, 0x00, 0x00 },   // mała 1 16
	{ 0x32<<1, 0x2a<<1, 0x2a<<1, 0x24<<1, 0x00 },   // mała 2 17
	{ 0x22<<1, 0x2a<<1, 0x2a<<1, 0x14<<1, 0x00 },   // mała 3 18
	{ 0x0e<<1, 0x08<<1, 0x3e<<1, 0x08<<1, 0x00 },
	{ 0x2e<<1, 0x2a<<1, 0x2a<<1, 0x12<<1, 0x00 },


	{ 0x7F, 0x49, 0x49, 0x49, 0x41 },   // E 21

//	{ 0x7F, 0x09, 0x09, 0x09, 0x01 },   // F
//	{ 0x3E, 0x41, 0x49, 0x49, 0x7A },   // G
//	{ 0x7F, 0x08, 0x08, 0x08, 0x7F },   // H
//	{ 0x00, 0x41, 0x7F, 0x41, 0x00 },   // I
//	{ 0x20, 0x40, 0x41, 0x3F, 0x01 },   // J
//	{ 0x7F, 0x08, 0x14, 0x22, 0x41 },   // K
//	{ 0x7F, 0x40, 0x40, 0x40, 0x40 },   // L
//	{ 0x7F, 0x02, 0x0C, 0x02, 0x7F },   // M
//	{ 0x7F, 0x04, 0x08, 0x10, 0x7F },   // N
//	{ 0x3E, 0x41, 0x41, 0x41, 0x3E },   // O
//	{ 0x7F, 0x09, 0x09, 0x09, 0x06 },   // P
//	{ 0x3E, 0x41, 0x51, 0x21, 0x5E },   // Q
//	{ 0x7F, 0x09, 0x19, 0x29, 0x46 },   // R
//	{ 0x46, 0x49, 0x49, 0x49, 0x31 },   // S
//	{ 0x01, 0x01, 0x7F, 0x01, 0x01 },   // T
//	{ 0x3F, 0x40, 0x40, 0x40, 0x3F },   // U
//	{ 0x1F, 0x20, 0x40, 0x20, 0x1F },   // V
//	{ 0x3F, 0x40, 0x38, 0x40, 0x3F },   // W
//	{ 0x63, 0x14, 0x08, 0x14, 0x63 },   // X
//	{ 0x07, 0x08, 0x70, 0x08, 0x07 },   // Y
//	{ 0x61, 0x51, 0x49, 0x45, 0x43 },   // Z
/*	{ 0x00, 0x7F, 0x41, 0x41, 0x00 },   // [
	{ 0x55, 0x2A, 0x55, 0x2A, 0x55 },   // 55
	{ 0x00, 0x41, 0x41, 0x7F, 0x00 },   // ]
	{ 0x7C, 0x08, 0x06, 0x05, 0x78 },   // ń ^
	{ 0x40, 0x40, 0x40, 0x40, 0x40 },   // _
	{ 0x00, 0x01, 0x02, 0x04, 0x00 },   // '
	{ 0x20, 0x54, 0x54, 0x54, 0x78 },   // a
	{ 0x7F, 0x48, 0x44, 0x44, 0x38 },   // b
	{ 0x38, 0x44, 0x44, 0x44, 0x28 },   // c
	{ 0x38, 0x44, 0x44, 0x48, 0x7F },   // d
	{ 0x38, 0x54, 0x54, 0x54, 0x18 },   // e
	{ 0x08, 0x7E, 0x09, 0x01, 0x02 },   // f
	{ 0x0C, 0x52, 0x52, 0x52, 0x3E },   // g
	{ 0x7F, 0x08, 0x04, 0x04, 0x78 },   // h
	{ 0x00, 0x44, 0x7D, 0x40, 0x00 },   // i
	{ 0x20, 0x40, 0x44, 0x3D, 0x00 },   // j
	{ 0x7F, 0x10, 0x28, 0x44, 0x00 },   // k
	{ 0x00, 0x41, 0x7F, 0x40, 0x00 },   // l
	{ 0x7C, 0x04, 0x18, 0x04, 0x78 },   // m
	{ 0x7C, 0x08, 0x04, 0x04, 0x78 },   // n
	{ 0x38, 0x44, 0x44, 0x44, 0x38 },   // o
	{ 0x7C, 0x14, 0x14, 0x14, 0x08 },   // p
	{ 0x08, 0x14, 0x14, 0x18, 0x7C },   // q
	{ 0x7C, 0x08, 0x04, 0x04, 0x08 },   // r
	{ 0x48, 0x54, 0x54, 0x54, 0x20 },   // s
	{ 0x04, 0x3F, 0x44, 0x40, 0x20 },   // t
	{ 0x3C, 0x40, 0x40, 0x20, 0x7C },   // u
	{ 0x1C, 0x20, 0x40, 0x20, 0x1C },   // v
	{ 0x3C, 0x40, 0x30, 0x40, 0x3C },   // w
	{ 0x44, 0x28, 0x10, 0x28, 0x44 },   // x
	{ 0x0C, 0x50, 0x50, 0x50, 0x3C },   // y
	{ 0x44, 0x64, 0x54, 0x4C, 0x44 },   // z*/
};

void write_byte(unsigned char b){
	register unsigned char i;
	for(i=0;i<8;i++){
		LEDPORT &= ~CLK;
		LEDPORT &= ~DIN;
		if(b&128) LEDPORT |= DIN;
		b<<=1;

		LEDPORT |= CLK;
	}
}

void send_config(unsigned char c){
	LEDPORT |= RS;
	LEDPORT &= ~CE;
	LEDPORT &= ~RS;

	write_byte(c);
	LEDPORT |= CE;
	LEDPORT &= ~CLK;
//	LEDPORT |= CLK;
}

void putchar(unsigned char c){
	register unsigned char j;
//	LEDPORT |= RS;
//	LEDPORT &= ~RS;

	LEDPORT &= ~CE;
	for(j=0;j<5;j++){
		//write_byte(pgm_read_byte(&FontLookup[c][j]));
		write_byte(pgm_read_byte(((unsigned char *)FontLookup)+c+(c<<2)+j));
	}
	LEDPORT |= CE;
}
/*
void display(void){
	LEDPORT &= ~CLK;
}*/

void disp_init(void){
	LEDPORT |= RS|CE|CLK;
	LEDDDR |= RS|CE|CLK|DIN;
	send_config(LED_CON0);
	send_config(LED_CON1);
}
/*
void puttext(const char *text){
	char c;
	while((c = pgm_read_byte(text++))){
		putchar(c);
	}
}*/
/*
void clear(void){
	unsigned char i;
	for(i=0;i<8;i++){
		putchar(17);
	}
}*/