#include <avr/pgmspace.h>
#include <inttypes.h>
#include <stdio.h>
#include <glcd.h>

int put(char c) {
	// Warten bis Platz im Buffer
	while ( !( UCSR0A & (1<<UDRE)) );
	// Char senden
	UDR0 = c;
	
	return 0;
}

int get(void) {
	// Auf Daten warten
	while ( !(UCSR0A & (1<<RXC)) );
	// Empfangene Daten returnen
	return UDR0;
}

void recvPicture(void) {
	uint8_t x=0, y=175;
	glcdColor_t pix;
	
	for(uint16_t i=0; i<23232; i++) {
		pix = get()<<8;
		pix |= get();
		glcdSetPixel(x, y--, pix);
		if(y == 255) {
			y=175;
			x++;
		}
	}
}

int main(void) {
	
	#ifndef USE_AUTOINIT
	    glcdDisplayInit();
	#endif
	
	UCSR0A = (1<<U2X);
	UCSR0B = (1<<TXEN)|(1<<RXEN);
	UBRR0L = 4;
	
	fdevopen(put, get, 0);
	puts_P(PSTR("S65 LCD Test"));
	
	glcdFillRect(0, 0, 131, 175, BLACK);
	
	while(1) {
		recvPicture();
	}
}