#include "oswald.h"
#include "oswald_strings.h"
#include "oswald_fonts.h"
#include "oswald_hal.h"

#include "oswald_graphics.h"

// dummies for MW replacement stuff

void SetFont(etFontType Type)
{
}

u8t WriteLcdString(const uint8_t x, const uint8_t y, const char *str)
{
	return 1;
}

void WriteLcdNumber(const uint8_t x, const uint8_t y, const int16_t number)
{
}

u8t WriteLcdCharacter(const uint8_t x, const uint8_t y, const uint8_t Character)
{
	return 1;
}


void oswald_draw_bitmap_offset(const unsigned int xstart, const unsigned int ystart, const unsigned int xoff, const unsigned int yoff, const unsigned int  width, const unsigned int  height, const void *bmp)
{
	unsigned int x, y;
	uint8_t *cb;

	if (bmp == NULL)
		return;

	// we only draw set pixel, unset pixel remain as they are
	for (y=yoff; y<height; y++) {
		for (x=xoff; x<width; x++) {
			cb = (uint8_t *)(bmp + (y * ((width / 8) + ((width % 8) ? 1 : 0))) + (x / 8));
			if (*cb & (1 << (x % 8)))
				hal_lcd_set_pixel((xstart + x) - xoff, (ystart + y) - yoff, TRUE);
		}
	}
}

#if 0
/*inline*/ void oswald_draw_bitmap(const unsigned int xstart, const unsigned int ystart, const unsigned int width, const unsigned int height, const void *bmp)
{
	unsigned int x, y;
	uint8_t *cb;

	// we only draw set pixel, unset pixel remain as they are
	for (y=0; y<height; y++) {
		for (x=0; x<width; x++) {
			cb = (uint8_t *)(bmp + (y * ((width / 8) + ((width % 8) ? 1 : 0))) + (x / 8));
			if (*cb & (1 << (x % 8)))
				hal_lcd_set_pixel((xstart + x), (ystart + y), TRUE);
		}
	}
}
#else
void oswald_draw_bitmap(const unsigned int xstart, const unsigned int ystart, const unsigned int width, const unsigned int height, const void *bmp)
{
	// seems we are triggering a MSPGCC compiler bug here...
	// if we do not do this trick then bmp becomes 0x00 when passed a livel higher!
	volatile unsigned int num;

	num = (unsigned int) bmp;

	oswald_draw_bitmap_offset(xstart, ystart, 0, 0, width, height, bmp);
}
#endif

void oswald_draw_line(const uint8_t xstart, const uint8_t ystart, const uint8_t xend, const uint8_t yend)
{
	int x, y, t, dx, dy, incx, incy, pdx, pdy, ddx, ddy, es, el, err;
 
	dx = xend - xstart;
	dy = yend - ystart;
 
	incx = (dx >= 0) ? 1 : -1;
	incy = (dy >= 0) ? 1 : -1;

	if (dx<0)
		dx = -dx;
	if (dy<0)
		dy = -dy;
 
	if (dx>dy) {
		pdx = incx; pdy = 0;
		ddx=incx; ddy=incy;
		es =dy;   el =dx;
	} else {
		pdx=0;    pdy=incy;
		ddx=incx; ddy=incy;
		es =dx;   el =dy;
	}
 
	x = xstart;
	y = ystart;
	err = el/2;
	hal_lcd_set_pixel(x, y, TRUE);
 
	for (t = 0; t < el; ++t) {
		err -= es; 
		if (err < 0) {
			err += el;
			x += ddx;
			y += ddy;
		} else {
			x += pdx;
			y += pdy;
		}
		hal_lcd_set_pixel(x, y, TRUE);
	}
	// hal_lcd_update_display();
}

void oswald_draw_line_ww(const uint8_t xstart, const uint8_t ystart, const uint8_t xend, const uint8_t yend, const uint8_t thickness)
{
	int i, x, y, t, dx, dy, incx, incy, pdx, pdy, ddx, ddy, es, el, err;
 
	dx = xend - xstart;
	dy = yend - ystart;
 
	incx = (dx >= 0) ? 1 : -1;
	incy = (dy >= 0) ? 1 : -1;

	if (dx<0)
		dx = -dx;
	if (dy<0)
		dy = -dy;
 
	if (dx>dy) {
		pdx = incx;
		pdy = 0;
		ddx=incx;
		ddy=incy;
		es =dy;
		el =dx;
	} else {
		pdx=0;
		pdy=incy;
		ddx=incx;
		ddy=incy;
		es =dx;
		el =dy;
	}
 
	x = xstart;
	y = ystart;
	err = el/2;
	hal_lcd_set_pixel(x, y, TRUE);
	for (i=1; i<thickness; i++) {
		hal_lcd_set_pixel(x-i, y, TRUE);
		hal_lcd_set_pixel(x+i, y, TRUE);
		hal_lcd_set_pixel(x, y-i, TRUE);
		hal_lcd_set_pixel(x, y+i, TRUE);
	}
 
	for (t = 0; t < el; ++t) {
		err -= es; 
		if (err < 0) {
			err += el;
			x += ddx;
			y += ddy;
		} else {
			x += pdx;
			y += pdy;
		}
		hal_lcd_set_pixel(x, y, TRUE);
		for (i=1; i<thickness; i++) {
			hal_lcd_set_pixel(x-i, y, TRUE);
			hal_lcd_set_pixel(x+i, y, TRUE);
			hal_lcd_set_pixel(x, y-i, TRUE);
			hal_lcd_set_pixel(x, y+i, TRUE);
		}
	}
	// hal_lcd_update_display();
}

uint8_t oswald_write_character(const uint8_t x, const uint8_t y, const oswald_font_face face, const uint8_t Character)
{
#if 0
	u8t CharacterHeight = GetCharacterHeight();
	u8t CharacterWidth = GetCharacterWidth(Character);
	u16t bitmap[MAX_FONT_ROWS];
	register lx, ly;

	GetCharacterBitmap(Character, bitmap);

	// printf("cw=%d ch=%d\n", CharacterWidth, CharacterHeight);
	for (ly=0; ly<CharacterHeight; ly++) {
		for (lx=0; lx<CharacterWidth; lx++) {
			if (bitmap[ly] & (1<<lx)) {
				hal_lcd_set_pixel(lx+x, ly+y, TRUE);
				// printf(".");
			} /*else {
				hal_lcd_set_pixel(lx+x, ly+y, FALSE);
				// printf(" ");
			}*/
		}
		// printf("\n");
	}

	return CharacterWidth + GetFontSpacing();
#else
	uint8_t *cdata = oswald_fonts[face].data;
	int csize;

	if (Character == 32) // space / blank
		return oswald_fonts[face].width / 2;

	csize = ((oswald_fonts[face].width / 8) + ((oswald_fonts[face].width % 8) ? 1 : 0)) * oswald_fonts[face].height;
	//csize += (oswald_fonts[face].height / 8) + ((oswald_fonts[face].height % 8) ? 1 : 0);

	// g_printerr("fp = 0x%08lx cdata = 0x%08lx\n", font_7x12, cdata);

	cdata = (cdata + (csize * (int)Character));

	//g_printerr("%02x\n", oswald_fonts[face].data[0][0]);
	//g_printerr("char %02x face %d %dx%d csize %d\n", Character, face, oswald_fonts[face].width, oswald_fonts[face].height, csize);
	//g_printerr("char %02x %02x %02x\n", (uint8_t)cdata[0], (uint8_t)cdata[1], (uint8_t)cdata[2]);

	// oswald_draw_bitmap(x, y, oswald_fonts[face].height, oswald_fonts[face].height, cdata);
	//oswald_draw_bitmap(x, y, ((oswald_fonts[face].width / 8) + ((oswald_fonts[face].width % 8) ? 1 : 0))*8, oswald_fonts[face].height, cdata);
	oswald_draw_bitmap_offset(x, y, (oswald_fonts[face].width % 8) > 0 ? (8-(oswald_fonts[face].width % 8)) : 0, 0, ((oswald_fonts[face].width / 8) + ((oswald_fonts[face].width % 8) ? 1 : 0))*8, oswald_fonts[face].height, cdata);

	return oswald_fonts[face].width;
#endif
}

void oswald_write_string(const uint8_t x, const uint8_t y, const oswald_font_face face, char *str)
{
	uint8_t lx, i, strl;

	strl = oswald_strlen(str);
	if (strl == 0)
		return;

	lx = x;
	for (i=0; i<strl; i++) {
		lx += oswald_write_character(lx, y, face, str[i]);
	}
}


void oswald_write_number(const uint8_t x, const uint8_t y, const oswald_font_face face, const int16_t number)
{
	uint8_t lx, i, strl;
	char str[8];

	itoa(number, str, 10);
	strl = oswald_strlen(str);
	if (strl == 0)
		return;

	lx = x;
	for (i=0; i<strl; i++) {
		lx += oswald_write_character(lx, y, face, str[i]);
	}
}