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

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




word debugMap[0x400];
static char debug_buffer[512];
static char screen_buffer[512];


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


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

    // hex(24 << 10 | 24 << 5 | 24 )
    // '0x6318'

    *(byte*) 0x2121 = 0x00;
    *(byte*) 0x2122 = 0x18;
    *(byte*) 0x2122 = 0x63;


}

void clears(void) {
    word i,y;
    for(y=0; y<20; y++){
      waitForVBlank();
      for(i=0; i<32; i++){
        *(byte*)0x2115 = 0x80;
        *(word*)0x2116 = 0x4000+i+(y*0x20);
        *(byte*)0x2118 = 0;
      }
  }
}

void _print_char(word y,word x,  char c){
  waitForVBlank();
  VRAMByteWrite((byte) (c-32), (word) (0x4000+x+(y*0x20)));
}

void _print_screen(word y, char *buffer){
    char l;
    char x = 0;
    l = strlen(buffer);
    waitForVBlank();
    while(*buffer){
        if (*buffer == '\n' ) {
            while(x++<32){
              *(byte*)0x2115 = 0x80;
              *(word*)0x2116 = 0x4000+x+(y*0x20);
              *(byte*)0x2118 = 0;
            }
            x = 0;
            y++;
            buffer++;
            waitForVBlank();
            continue;
        }
        *(byte*)0x2115 = 0x80;
        *(word*)0x2116 = 0x4000+x+(y*0x20);
        *(byte*)0x2118 = *buffer-32;
        x++;
        buffer++;
        //waitForVBlank();
    }
}
void _print_console(const 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);
  //memset(debug_buffer,0,255);

}

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

void printc_packet(unsigned long addr,unsigned int len,byte *packet){
	unsigned int i,j;
	unsigned int sum = 0;
	unsigned int clear=0;
	
	for (i=0;i<len;i+=16) {
		
		sum = 0;
		for (j=0;j<16;j++) {
			sum +=packet[i+j];
		}
		if (!sum){
			clear=1;
			continue;
		}
		if (clear){
			printfc("*\n");
			clear = 0;
		}	
		printfc("%lx:", addr + i);
		for (j=0;j<16;j++) {
			printfc(" %x", packet[i+j]);
		}
		printfc(" |");
		for (j=0;j<16;j++) {
			if (packet[i+j]>=33 && packet[i+j]<=126 )
				printfc("%c", packet[i+j]);
			else
				printfc(".");
		}
		printfc("|\n");
	}
}

/* keep the linker happy */
int open(const char * _name, int _mode){
    _print_console("open called\n");
    return -1;
}

int close(int fd){
    _print_console("close called\n");
    return -1;
    
} 

size_t read(int fd, void * buff, size_t len){
    _print_console("read called\n");
    return 0;
} 

size_t write(int fd, void * buffer, size_t len){
    _print_console("write called\n");
    return 0;
}

long lseek(int fd, long off, int count){
    _print_console("lseek called\n");
    return 0;
} 

int unlink(const char * name){
    _print_console("unlink called\n");
    return -1;
}

int isatty(){
    _print_console("isatty called\n");
    return 1;
}