// boot.c
// bootscreen functions
// 2014, rok.krajnc@gmail.com


#include "string.h"
#include "stdio.h"
#include "minimig_boot.h"
#include "../../hardware.h"
#include "../../user_io.h"
#include "../../spi.h"
#include "../../file_io.h"
#include "minimig_config.h"
#include "minimig_fdd.h"
#include "../../cfg.h"

static uint8_t buffer[1024];

static void mem_upload_init(unsigned long addr)
{
	spi_uio_cmd32le_cont(UIO_MM2_WR, addr);
}

static void mem_upload_fini()
{
	DisableIO();
}

static void mem_write16(unsigned short x)
{
	spi8((((x) >> 8) & 0xff)); spi8(((x)& 0xff));
}

//// boot cursor positions ////
unsigned short bcurx = 0;
unsigned short bcury = 96;

static int bootscreen_adr = 0x80000 + /*120*/112 * 640 / 8;

void BootHome()
{
	bootscreen_adr = 0x80000 + /*120*/112 * 640 / 8;
}

static const char boot_font[96][8] =
{
	{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 },  // SPACE
	{ 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x18, 0x00 },  // !
	{ 0x6C, 0x6C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 },  // "
	{ 0x6C, 0x6C, 0xFE, 0x6C, 0xFE, 0x6C, 0x6C, 0x00 },  // #
	{ 0x18, 0x3E, 0x60, 0x3C, 0x06, 0x7C, 0x18, 0x00 },  // $
	{ 0x00, 0x66, 0xAC, 0xD8, 0x36, 0x6A, 0xCC, 0x00 },  // %
	{ 0x38, 0x6C, 0x68, 0x76, 0xDC, 0xCE, 0x7B, 0x00 },  // &
	{ 0x18, 0x18, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00 },  // '
	{ 0x0C, 0x18, 0x30, 0x30, 0x30, 0x18, 0x0C, 0x00 },  // (
	{ 0x30, 0x18, 0x0C, 0x0C, 0x0C, 0x18, 0x30, 0x00 },  // )
	{ 0x00, 0x66, 0x3C, 0xFF, 0x3C, 0x66, 0x00, 0x00 },  // *
	{ 0x00, 0x18, 0x18, 0x7E, 0x18, 0x18, 0x00, 0x00 },  // +
	{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x30 },  // ,
	{ 0x00, 0x00, 0x00, 0x7E, 0x00, 0x00, 0x00, 0x00 },  // -
	{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00 },  // .
	{ 0x03, 0x06, 0x0C, 0x18, 0x30, 0x60, 0xC0, 0x00 },  // /
	{ 0x3C, 0x66, 0x6E, 0x7E, 0x76, 0x66, 0x3C, 0x00 },  // 0
	{ 0x18, 0x38, 0x78, 0x18, 0x18, 0x18, 0x18, 0x00 },  // 1
	{ 0x3C, 0x66, 0x06, 0x0C, 0x18, 0x30, 0x7E, 0x00 },  // 2
	{ 0x3C, 0x66, 0x06, 0x1C, 0x06, 0x66, 0x3C, 0x00 },  // 3
	{ 0x1C, 0x3C, 0x6C, 0xCC, 0xFE, 0x0C, 0x0C, 0x00 },  // 4
	{ 0x7E, 0x60, 0x7C, 0x06, 0x06, 0x66, 0x3C, 0x00 },  // 5
	{ 0x1C, 0x30, 0x60, 0x7C, 0x66, 0x66, 0x3C, 0x00 },  // 6
	{ 0x7E, 0x06, 0x06, 0x0C, 0x18, 0x18, 0x18, 0x00 },  // 7
	{ 0x3C, 0x66, 0x66, 0x3C, 0x66, 0x66, 0x3C, 0x00 },  // 8
	{ 0x3C, 0x66, 0x66, 0x3E, 0x06, 0x0C, 0x38, 0x00 },  // 9
	{ 0x00, 0x18, 0x18, 0x00, 0x00, 0x18, 0x18, 0x00 },  // :
	{ 0x00, 0x18, 0x18, 0x00, 0x00, 0x18, 0x18, 0x30 },  // ;
	{ 0x00, 0x06, 0x18, 0x60, 0x18, 0x06, 0x00, 0x00 },  // <
	{ 0x00, 0x00, 0x7E, 0x00, 0x7E, 0x00, 0x00, 0x00 },  // =
	{ 0x00, 0x60, 0x18, 0x06, 0x18, 0x60, 0x00, 0x00 },  // >
	{ 0x3C, 0x66, 0x06, 0x0C, 0x18, 0x00, 0x18, 0x00 },  // ?
	{ 0x7C, 0xC6, 0xDE, 0xD6, 0xDE, 0xC0, 0x78, 0x00 },  // @
	{ 0x3C, 0x66, 0x66, 0x7E, 0x66, 0x66, 0x66, 0x00 },  // A
	{ 0x7C, 0x66, 0x66, 0x7C, 0x66, 0x66, 0x7C, 0x00 },  // B
	{ 0x1E, 0x30, 0x60, 0x60, 0x60, 0x30, 0x1E, 0x00 },  // C
	{ 0x78, 0x6C, 0x66, 0x66, 0x66, 0x6C, 0x78, 0x00 },  // D
	{ 0x7E, 0x60, 0x60, 0x78, 0x60, 0x60, 0x7E, 0x00 },  // E
	{ 0x7E, 0x60, 0x60, 0x78, 0x60, 0x60, 0x60, 0x00 },  // F
	{ 0x3C, 0x66, 0x60, 0x6E, 0x66, 0x66, 0x3E, 0x00 },  // G
	{ 0x66, 0x66, 0x66, 0x7E, 0x66, 0x66, 0x66, 0x00 },  // H
	{ 0x3C, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3C, 0x00 },  // I
	{ 0x06, 0x06, 0x06, 0x06, 0x06, 0x66, 0x3C, 0x00 },  // J
	{ 0xC6, 0xCC, 0xD8, 0xF0, 0xD8, 0xCC, 0xC6, 0x00 },  // K
	{ 0x60, 0x60, 0x60, 0x60, 0x60, 0x60, 0x7E, 0x00 },  // L
	{ 0xC6, 0xEE, 0xFE, 0xD6, 0xC6, 0xC6, 0xC6, 0x00 },  // M
	{ 0xC6, 0xE6, 0xF6, 0xDE, 0xCE, 0xC6, 0xC6, 0x00 },  // N
	{ 0x3C, 0x66, 0x66, 0x66, 0x66, 0x66, 0x3C, 0x00 },  // O
	{ 0x7C, 0x66, 0x66, 0x7C, 0x60, 0x60, 0x60, 0x00 },  // P
	{ 0x78, 0xCC, 0xCC, 0xCC, 0xCC, 0xDC, 0x7E, 0x00 },  // Q
	{ 0x7C, 0x66, 0x66, 0x7C, 0x6C, 0x66, 0x66, 0x00 },  // R
	{ 0x3C, 0x66, 0x70, 0x3C, 0x0E, 0x66, 0x3C, 0x00 },  // S
	{ 0x7E, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00 },  // T
	{ 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x3C, 0x00 },  // U
	{ 0x66, 0x66, 0x66, 0x66, 0x3C, 0x3C, 0x18, 0x00 },  // V
	{ 0xC6, 0xC6, 0xC6, 0xD6, 0xFE, 0xEE, 0xC6, 0x00 },  // W
	{ 0xC3, 0x66, 0x3C, 0x18, 0x3C, 0x66, 0xC3, 0x00 },  // X
	{ 0xC3, 0x66, 0x3C, 0x18, 0x18, 0x18, 0x18, 0x00 },  // Y
	{ 0xFE, 0x0C, 0x18, 0x30, 0x60, 0xC0, 0xFE, 0x00 },  // Z
	{ 0x3C, 0x30, 0x30, 0x30, 0x30, 0x30, 0x3C, 0x00 },  // [
	{ 0xC0, 0x60, 0x30, 0x18, 0x0C, 0x06, 0x03, 0x00 },  // Backslash
	{ 0x3C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x3C, 0x00 },  // ]
	{ 0x10, 0x38, 0x6C, 0xC6, 0x00, 0x00, 0x00, 0x00 },  // ^
	{ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFE },  // _
	{ 0x18, 0x18, 0x0C, 0x00, 0x00, 0x00, 0x00, 0x00 },  // `
	{ 0x00, 0x00, 0x3C, 0x06, 0x3E, 0x66, 0x3E, 0x00 },  // a
	{ 0x60, 0x60, 0x7C, 0x66, 0x66, 0x66, 0x7C, 0x00 },  // b
	{ 0x00, 0x00, 0x3C, 0x60, 0x60, 0x60, 0x3C, 0x00 },  // c
	{ 0x06, 0x06, 0x3E, 0x66, 0x66, 0x66, 0x3E, 0x00 },  // d
	{ 0x00, 0x00, 0x3C, 0x66, 0x7E, 0x60, 0x3C, 0x00 },  // e
	{ 0x1C, 0x30, 0x7C, 0x30, 0x30, 0x30, 0x30, 0x00 },  // f
	{ 0x00, 0x00, 0x3E, 0x66, 0x66, 0x3E, 0x06, 0x3C },  // g
	{ 0x60, 0x60, 0x7C, 0x66, 0x66, 0x66, 0x66, 0x00 },  // h
	{ 0x18, 0x00, 0x18, 0x18, 0x18, 0x18, 0x0C, 0x00 },  // i
	{ 0x0C, 0x00, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x78 },  // j
	{ 0x60, 0x60, 0x66, 0x6C, 0x78, 0x6C, 0x66, 0x00 },  // k
	{ 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x0C, 0x00 },  // l
	{ 0x00, 0x00, 0xEC, 0xFE, 0xD6, 0xC6, 0xC6, 0x00 },  // m
	{ 0x00, 0x00, 0x7C, 0x66, 0x66, 0x66, 0x66, 0x00 },  // n
	{ 0x00, 0x00, 0x3C, 0x66, 0x66, 0x66, 0x3C, 0x00 },  // o
	{ 0x00, 0x00, 0x7C, 0x66, 0x66, 0x7C, 0x60, 0x60 },  // p
	{ 0x00, 0x00, 0x3E, 0x66, 0x66, 0x3E, 0x06, 0x06 },  // q
	{ 0x00, 0x00, 0x7C, 0x66, 0x60, 0x60, 0x60, 0x00 },  // r
	{ 0x00, 0x00, 0x3C, 0x60, 0x3C, 0x06, 0x7C, 0x00 },  // s
	{ 0x30, 0x30, 0x7C, 0x30, 0x30, 0x30, 0x1C, 0x00 },  // t
	{ 0x00, 0x00, 0x66, 0x66, 0x66, 0x66, 0x3E, 0x00 },  // u
	{ 0x00, 0x00, 0x66, 0x66, 0x66, 0x3C, 0x18, 0x00 },  // v
	{ 0x00, 0x00, 0xC6, 0xC6, 0xD6, 0xFE, 0x6C, 0x00 },  // w
	{ 0x00, 0x00, 0xC6, 0x6C, 0x38, 0x6C, 0xC6, 0x00 },  // x
	{ 0x00, 0x00, 0x66, 0x66, 0x66, 0x3C, 0x18, 0x30 },  // y
	{ 0x00, 0x00, 0x7E, 0x0C, 0x18, 0x30, 0x7E, 0x00 },  // z
	{ 0x0E, 0x18, 0x18, 0x70, 0x18, 0x18, 0x0E, 0x00 },  // {
	{ 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00 },  // |
	{ 0x70, 0x18, 0x18, 0x0E, 0x18, 0x18, 0x70, 0x00 },  // }
	{ 0x72, 0x9C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 },  // ~
	{ 0xFE, 0xFE, 0xFE, 0xFE, 0xFE, 0xFE, 0xFE, 0x00 }   //
};

static void BootEnableMem()
{
	// TEMP enable 1MB memory
	spi_uio_cmd8(UIO_MM2_MEM, 0x5);
}

static void BootClearScreen(int adr, int size)
{
	int i;
	mem_upload_init(adr);
	for (i = 0; i<size; i++)
	{
		mem_write16(0x0000);
		//mem_write16(i);
	}
	mem_upload_fini();
}

static void BootUploadLogo()
{
	fileTYPE file = {};
	int x, y;
	int i = 0;
	int adr;

	if (FileOpen(&file, user_io_make_filepath(HomeDir, LOGO_FILE)) || FileOpen(&file, LOGO_FILE)) {
		FileReadSec(&file, buffer);
		mem_upload_init(SCREEN_BPL1 + LOGO_OFFSET);
		adr = SCREEN_BPL1 + LOGO_OFFSET;
		for (y = 0; y<LOGO_HEIGHT; y++)
		{
			for (x = 0; x<LOGO_WIDTH / 16; x++)
			{
				if (i == 512)
				{
					mem_upload_fini();
					FileReadSec(&file, buffer);
					mem_upload_init(adr);
					i = 0;
				}
				spi8(buffer[i++]);
				spi8(buffer[i++]);
				//for (tmp=0; tmp<0x80000; tmp++);
				//printf("i=%03d  x=%03d  y=%03d  dat[0]=0x%08x  dat[1]=0x%08x\n", i, x, y, buffer[i], buffer[i+1]);
				adr += 2;
			}
			mem_upload_fini();
			mem_upload_init(SCREEN_BPL1 + LOGO_OFFSET + (y + 1)*(SCREEN_WIDTH / 8));
			adr = SCREEN_BPL1 + LOGO_OFFSET + (y + 1)*(SCREEN_WIDTH / 8);
		}
		mem_upload_fini();
		mem_upload_init(SCREEN_BPL2 + LOGO_OFFSET);
		adr = SCREEN_BPL2 + LOGO_OFFSET;
		for (y = 0; y<LOGO_HEIGHT; y++)
		{
			for (x = 0; x<LOGO_WIDTH / 16; x++)
			{
				if (i == 512)
				{
					mem_upload_fini();
					FileReadSec(&file, buffer);
					mem_upload_init(adr);
					i = 0;
				}
				spi8(buffer[i++]);
				spi8(buffer[i++]);
				adr += 2;
			}
			mem_upload_fini();
			mem_upload_init(SCREEN_BPL2 + LOGO_OFFSET + (y + 1)*(SCREEN_WIDTH / 8));
			adr = SCREEN_BPL2 + LOGO_OFFSET + (y + 1)*(SCREEN_WIDTH / 8);
		}
		mem_upload_fini();
		FileClose(&file);
	}
}

static void BootUploadBall()
{
	fileTYPE file = {};
	int x;
	int i = 0;
	int adr;

	if (FileOpen(&file, user_io_make_filepath(HomeDir, BALL_FILE)) || FileOpen(&file, BALL_FILE))
	{
		FileReadSec(&file, buffer);
		mem_upload_init(BALL_ADDRESS);
		adr = BALL_ADDRESS;
		for (x = 0; x<BALL_SIZE / 2; x++)
		{
			if (i == 512)
			{
				mem_upload_fini();
				FileReadSec(&file, buffer);
				mem_upload_init(adr);
				i = 0;
			}
			spi8(buffer[i++]);
			spi8(buffer[i++]);
			adr += 2;
		}
		mem_upload_fini();
		FileClose(&file);
	}
}

static void BootUploadCopper()
{
	fileTYPE file = {};
	int x;
	int i = 0;
	int adr;

	if (FileOpen(&file, user_io_make_filepath(HomeDir, COPPER_FILE)) || FileOpen(&file, COPPER_FILE))
	{
		FileReadSec(&file, buffer);
		mem_upload_init(COPPER_ADDRESS);
		adr = COPPER_ADDRESS;
		for (x = 0; x<COPPER_SIZE / 2; x++)
		{
			if (i == 512)
			{
				mem_upload_fini();
				FileReadSec(&file, buffer);
				mem_upload_init(adr);
				i = 0;
			}
			spi8(buffer[i++]);
			spi8(buffer[i++]);
			adr += 2;
		}
		mem_upload_fini();
		FileClose(&file);
	}
	else {
		mem_upload_init(COPPER_ADDRESS);
		mem_write16(0x00e0); mem_write16(0x0008);
		mem_write16(0x00e2); mem_write16(0x0000);
		mem_write16(0x00e4); mem_write16(0x0008);
		mem_write16(0x00e6); mem_write16(0x5000);
		mem_write16(0x0100); mem_write16(0xa200);
		mem_write16(0xffff); mem_write16(0xfffe);
		mem_upload_fini();
	}
}

static void BootCustomInit()
{
	//move.w #$0000,$dff1fc  ; FMODE, slow fetch mode for AGA compatibility
	mem_upload_init(0xdff1fc);
	mem_write16(0x0000);
	mem_upload_fini();

	//move.w #$0002,$dff02e  ; COPCON, enable danger mode
	mem_upload_init(0xdff02e);
	mem_write16(0x0002);
	mem_upload_fini();

	//move.l #Copper1,$dff080  ; COP1LCH, copper 1 pointer
	//move.l #Copper2,$dff084  ; CPO2LCH, copper 2 pointer
	mem_upload_init(0xdff080);
	mem_write16(0x0008); mem_write16(0xe680);
	mem_write16(0x0008); mem_write16(0xe69c);
	mem_upload_fini();

	//move.w #$2c81,$dff08e  ; DIWSTRT, screen upper left corner
	//move.w #$f4c1,$dff090  ; DIWSTOP, screen lower right corner
	//move.w #$003c,$dff092  ; DDFSTRT, display data fetch start
	//move.w #$00d4,$dff094  ; DDFSTOP, display data fetch stop
	//move.w #$87c0,$dff096  ; DMACON, enable important bits
	//move.w #$0000,$dff098  ; CLXCON, TODO
	//move.w #$7fff,$dff09a  ; INTENA, disable all interrupts
	//move.w #$7fff,$dff09c  ; INTREQ, disable all interrupts
	//move.w #$0000,$dff09e  ; ADKCON, TODO
	mem_upload_init(0xdff08e);
	//mem_write16(0x1d64);
	//mem_write16(0x38c7);
	//mem_write16(0x0028);
	//mem_write16(0x00d8);
	mem_write16(0x2c81);
	mem_write16(0xf4c1);
	mem_write16(0x003c);
	mem_write16(0x00d4);
	mem_write16(0x87c0);
	mem_write16(0x0000);
	mem_write16(0x7fff);
	mem_write16(0x7fff);
	mem_upload_fini();

	//move.w #(bpl1>>16)&$ffff,$dff0e0  ; BPL1PTH
	//move.w #bpl1&$ffff,$dff0e2    ; BPL1PTL
	//move.w #(bpl2>>16)&$ffff,$dff0e4  ; BPL2PTH
	//move.w #bpl2&$ffff,$dff0e6    ; BPL2PTL
	mem_upload_init(0xdff0e0);
	mem_write16(0x0008); mem_write16(0x0000);
	mem_write16(0x0008); mem_write16(0x5000);
	mem_upload_fini();

	//move.w #$a200,$dff100  ; BPLCON0, two bitplanes & colorburst enabled
	//move.w #$0000,$dff102  ; BPLCON1, bitplane control scroll value
	//move.w #$0000,$dff104  ; BPLCON2, misc bitplane bits
	//move.w #$0000,$dff106  ; BPLCON3, TODO
	//move.w #$0000,$dff108  ; BPL1MOD, bitplane modulo for odd planes
	//move.w #$0000,$dff10a  ; BPL2MOD, bitplane modulo for even planes
	mem_upload_init(0xdff100);
	mem_write16(0xa200);
	mem_write16(0x0000);
	mem_write16(0x0000);
	mem_write16(0x0000);
	mem_write16(0x0000);
	mem_write16(0x0000);
	mem_upload_fini();

	//move.w #$09f0,$dff040  ; BLTCON0
	//move.w #$0000,$dff042  ; BLTCON1
	//move.w #$ffff,$dff044  ; BLTAFWM, blitter first word mask for srcA
	//move.w #$ffff,$dff046  ; BLTALWM, blitter last word mask for srcA
	mem_upload_init(0xdff040);
	mem_write16(0x09f0);
	mem_write16(0x0000);
	mem_write16(0xffff);
	mem_write16(0xffff);
	mem_upload_fini();

	//move.w #$0000,$dff064  ; BLTAMOD
	//move.w #BLITS,$dff066  ; BLTDMOD
	mem_upload_init(0xdff064);
	mem_write16(0x0000);
	mem_write16(BLITS);
	mem_upload_fini();

	//move.w #$0000,$dff180  ; COLOR00
	//move.w #$0aaa,$dff182  ; COLOR01
	//move.w #$0a00,$dff184  ; COLOR02
	//move.w #$0000,$dff186  ; COLOR03
	mem_upload_init(0xdff180);
	mem_write16(0x0000);
	mem_write16(0x0aaa);
	mem_write16(0x0a00);
	mem_write16(0x000a);
	mem_upload_fini();

	//move.w #$0000,$dff088  ; COPJMP1, restart copper at location 1
	mem_upload_init(0xdff088);
	mem_write16(0x0000);
	mem_upload_fini();
}

void BootInit()
{
	puts("Running minimig setup");

	spi_uio_cmd8(UIO_MM2_RST, SPI_RST_USR | SPI_RST_CPU | SPI_CPU_HLT);
	spi_uio_cmd8(UIO_MM2_RST, SPI_RST_CPU | SPI_CPU_HLT);

	if (cfg.bootscreen)
	{
		//default video config till real config loaded.
		minimig_ConfigVideo(0x40);
		minimig_ConfigAudio(0);

		WaitTimer(100);

		BootEnableMem();
		BootClearScreen(SCREEN_ADDRESS, SCREEN_MEM_SIZE);
		BootUploadLogo();
		BootUploadBall();
		BootUploadCopper();
		BootCustomInit();

		WaitTimer(500);
		BootPrintEx("Minimig-AGA by Rok Krajnc. MiSTer port by Sorgelig.");
		BootPrintEx(" ");
		BootPrintEx("Original Minimig by Dennis van Weeren");
		BootPrintEx("Updates by Jakub Bednarski, Tobias Gubener, Sascha Boing, A.M. Robinson & others");
		BootPrintEx(" ");
	}

	minimig_config.kickstart[0] = 0;
	minimig_cfg_load(0);
}

void BootPrintEx(const char * str)
{
	unsigned char i, j;
	unsigned char len;

	printf(str);
	printf("\n");

	len = strlen(str);
	len = (len>80) ? 80 : len;

	for (j = 0; j<8; j++)
	{
		mem_upload_init(bootscreen_adr);
		for (i = 0; i<len; i += 2)
		{
			spi8(boot_font[str[i] - 32][j]);
			if (i == (len - 1))
				spi8(boot_font[0][j]);
			else
				spi8(boot_font[str[i + 1] - 32][j]);
		}
		mem_upload_fini();
		bootscreen_adr += 640 / 8;
	}
}