#include <string.h>
#include <stdio.h>
#include <stdarg.h>

#include "data.h"
#include "pad.h"
#include "PPU.h"
#include "ressource.h"


word debugMap[0x400];
char debug_buffer[255];


void debug_init(void) {
	word i;
	for(i=0; i<0x400; i++) {
		debugMap[i] = 0x00;
	}
}

void _print_screen(word y, char *buffer){
    char i;
    char l;
    l = strlen(buffer);
    waitForVBlank();
	for(i=0; i<32; i++) {
        if (buffer[i] == '\n' ) {
          y++;
          continue;
        }
		if (i<l)
		    VRAMByteWrite((byte) (buffer[i]-32), (word) (0x4000+i+(y*0x20)));
	    else
	        VRAMByteWrite((byte) (' '-32), (word) (0x4000+i+(y*0x20)));
	}
}

void _print_console(char *buffer){
	while(*buffer)
	    *(byte*) 0x3000=*buffer++;
}

void printfc(char *fmt,...){
  va_list ap;
  va_start(ap,fmt);
  vsprintf(debug_buffer,fmt,ap);
  va_end(ap);
  _print_console(debug_buffer);
}

void printfs(word y,char *fmt,...){
  va_list ap;
  va_start(ap,fmt);
  vsprintf(debug_buffer,fmt,ap);
  va_end(ap);
  _print_screen(y,debug_buffer);
}


void debug_enable(void){
	VRAMLoad((word) debugFont_pic, 0x5000, 2048);
	CGRAMLoad((word) debugFont_pal, (byte) 0x00, (word) 16);
	VRAMLoad((word) debugMap, 0x4000, 0x0800);
	setTileMapLocation(0x4000, (byte) 0x00, (byte) 0);
	setCharacterLocation(0x5000, (byte) 0);
	*(byte*) 0x2100 = 0x0f; // enable background
}

int unlink(const char *name){
  printfc("unlink called");
}

int close(int fd){
  printfc("close called");
}

int isatty(int fd){
  printfc("isatty called");
}

int write(int fd,void * buffer, size_t len){
  printfc("write called");
}

long lseek(int fd,long offset, int whence){
  printfc("lseek called");
}