#include <stdlib.h>
#include <stdio.h>
#include <unistd.h>
#include <termios.h>
#include <fcntl.h>
#include <string.h>
#include <sys/errno.h>

#include "lcd.h"
#include "debug.h"

//////////////////////////////////////////////////////////////////////////
////////////////////// For Debugging Output //////////////////////////////
//////////////////////////////////////////////////////////////////////////

// TODO: somehow allow access to the driver->framebuffer to each
// function...

int
debug_init (struct lcd_logical_driver *driver, char *args)
{
	printf ("debug_init(%s)\n", device);

	if (!driver->framebuf) {
		printf ("Allocating frame buffer (%ix%i)\n", lcd.wid, lcd.hgt);
		driver->framebuf = malloc (lcd.wid * lcd.hgt);
	}

	if (!driver->framebuf) {
		debug_close ();
		return -1;
	}

	if (driver->framebuf)
		printf ("Frame buffer: %i\n", (int) driver->framebuf);

	debug_clear ();

	driver->clear = debug_clear;
	driver->string = debug_string;
	driver->chr = debug_chr;
	driver->vbar = debug_vbar;
	driver->hbar = debug_hbar;
	driver->init_num = debug_init_num;
	driver->num = debug_num;

	driver->init = debug_init;
	driver->close = debug_close;
	driver->flush = debug_flush;
	driver->flush_box = debug_flush_box;
	driver->contrast = debug_contrast;
	driver->backlight = debug_backlight;
	driver->set_char = debug_set_char;
	driver->icon = debug_icon;
	driver->init_vbar = debug_init_vbar;
	driver->init_hbar = debug_init_hbar;
	driver->draw_frame = debug_draw_frame;

	driver->getkey = debug_getkey;

	return 200;						  // 200 is arbitrary.  (must be 1 or more)
}

void
debug_close ()
{
// Ack!  This shouldn't crash the program, but does..  Why??

	printf ("debug_close()\n");

// This is the line which crashes.
	if (driver->framebuf)
		free (driver->framebuf);

	if (driver->framebuf)
		printf ("Frame buffer: %i\n", (int) driver->framebuf);
	driver->framebuf = NULL;
//  printf("debug_close() finished\n");
}

/////////////////////////////////////////////////////////////////
// Clears the LCD screen
//
void
debug_clear ()
{
	printf ("clear()\n");

	memset (driver->framebuf, ' ', lcd.wid * lcd.hgt);

}

//////////////////////////////////////////////////////////////////
// Flushes all output to the lcd...
//
void
debug_flush ()
{
	printf ("flush()\n");

	lcd.draw_frame ();
}

/////////////////////////////////////////////////////////////////
// Prints a string on the lcd display, at position (x,y).  The
// upper-left is (1,1), and the lower right should be (20,4).
//
void
debug_string (int x, int y, char string[])
{

	int i;

	printf ("string(%i, %i):%s \n", x, y, string);

	x -= 1;							  // Convert 1-based coords to 0-based...
	y -= 1;

	for (i = 0; string[i]; i++) {
		driver->framebuf[(y * lcd.wid) + x + i] = string[i];
	}
}

/////////////////////////////////////////////////////////////////
// Prints a character on the lcd display, at position (x,y).  The
// upper-left is (1,1), and the lower right should be (20,4).
//
void
debug_chr (int x, int y, char c)
{
	printf ("character(%i, %i):%c\n", x, y, c);

	y--;
	x--;

	lcd.framebuf[(y * lcd.wid) + x] = c;
}

void
debug_contrast (int contrast)
{
	printf ("Contrast: %i\n", contrast);
}

void
debug_backlight (int on)
{
	if (on) {
		printf ("Backlight ON\n");
	} else {
		printf ("Backlight OFF\n");
	}
}

void
debug_init_vbar ()
{
	printf ("Vertical bars.\n");
}

void
debug_init_hbar ()
{
	printf ("Horizontal bars.\n");
}

void
debug_init_num ()
{
	printf ("Big Numbers.\n");
}

void
debug_num (int x, int num)
{
	printf ("BigNum(%i, %i)\n", x, num);
}

void
debug_set_char (int n, char *dat)
{
	printf ("Set Character %i\n", n);
}

/////////////////////////////////////////////////////////////////
// Draws a vertical bar; erases entire column onscreen.
//
void
debug_vbar (int x, int len)
{
	int y;

	printf ("Vbar(%i, %i)\n", x, len);

	for (y = lcd.hgt; y > 0 && len > 0; y--) {
		debug_chr (x, y, '|');

		len -= lcd.cellhgt;
	}

}

/////////////////////////////////////////////////////////////////
// Draws a horizontal bar to the right.
//
void
debug_hbar (int x, int y, int len)
{
	printf ("Hbar(%i, %i, %i)\n", x, y, len);

	for (; x < lcd.wid && len > 0; x++) {
		debug_chr (x, y, '-');

		len -= lcd.cellwid;
	}

}

/////////////////////////////////////////////////////////////////
// Sets character 0 to an icon...
//
void
debug_icon (int which, char dest)
{
	printf ("Char %i is icon %i\n", dest, which);
}

void
debug_flush_box (int lft, int top, int rgt, int bot)
{
	printf ("Flush Box(%i, %i)-(%i, %i)\n", lft, top, rgt, bot);

	debug_flush ();

}

void
debug_draw_frame (char *dat)
{
	int i, j;

	char out[LCD_MAX_WIDTH];

	printf ("draw_frame()\n");

	if (!dat)
		return;

//  printf("Frame (%ix%i): \n%s\n", lcd.wid, lcd.hgt, dat);

	for (i = 0; i < lcd.wid; i++) {
		out[i] = '-';
	}
	out[lcd.wid] = 0;
	printf ("+%s+\n", out);

	for (i = 0; i < lcd.hgt; i++) {
		for (j = 0; j < lcd.wid; j++) {
			out[j] = dat[j + (i * lcd.wid)];
		}
		out[lcd.wid] = 0;
		printf ("|%s|\n", out);

	}

	for (i = 0; i < lcd.wid; i++) {
		out[i] = '-';
	}
	out[lcd.wid] = 0;
	printf ("+%s+\n", out);

}

char
debug_getkey ()
{
	printf ("Trying to grab keypress.\n");
	return 0;
}