#include "drivers/gfx.h"
#include "arm11/console.h"
#include "arm11/drivers/timer.h"
#include "drivers/tmio.h"
#include "arm11/fmt.h"
#include "arm11/drivers/hid.h"
#include "drivers/mmc/sdmmc.h"
#include "arm11/drivers/codec.h"
#include "arm11/power.h"



// 2 sector SDIO3 DMA:
/*
# 4 bytes burst with 16 transfers. Total 64 bytes per burst.
# Source fixed address and destination incrementing.
# Source and destination unprivileged, non-secure data access.
MOV CCR, SB16 SS32 SAF SP2 DB16 DS32 DAI DP2
MOV SAR, 0x10300000
MOV DAR, 0x20000000

FLUSHP 5


# Wait for a burst request.
WFP 5, burst
LP 7
	LD
	ST
LPEND
LDPB 5
ST
WFP 5, burst
LP 7
	LD
	ST
LPEND
LDPB 5
ST
WMB
END
*/
static u32 printCardInfos(void)
{
	SdmmcInfo info;
	SDMMC_getDevInfo(SDMMC_DEV_CARD, &info);

	ee_printf("Card infos:\n type: %u\n prot: %u\n rca: 0x%X\n sectors: %lu (~%lu MiB)\n ccc: 0x%X\n CID: ",
	          info.type, info.prot, info.rca, info.sectors, info.sectors / 2048, info.ccc);
	for(u32 i = 0; i < 4; i++)
	{
		ee_printf("%08lX", info.cid[i]);
	}
	ee_printf("\n Bus width: %u bit\n Clock: %lu Hz\n", info.busWidth, info.clock);

	return info.sectors;
}

int main(void)
{
	GFX_init(GFX_BGR8, GFX_BGR565, GFX_TOP_2D);
	GFX_setLcdLuminance(80);
	consoleInit(GFX_LCD_BOT, NULL);

	TIMER_sleepMs(1000);
	TMIO_init();

	ee_puts("Insert SD/MMC and press A.");
	while(1)
	{
		while(1)
		{
			hidScanInput();
			if(hidGetExtraKeys(0) & (KEY_POWER | KEY_POWER_HELD)) goto pooff;
			if(hidKeysDown() & KEY_A) break;
			GFX_waitForVBlank0();
		}

		ee_printf("\x1b[1;0H\x1b[0J\x1b[1;0H");
		ee_printf("Card inserted: %u\n", TMIO_cardDetected());
		u32 tries = 3;
		u32 initRes;
		do
		{
			initRes = SDMMC_init(SDMMC_DEV_CARD);
			TIMER_sleepMs(10);
		} while(--tries && initRes != 0);
		const u32 sectors = printCardInfos();
		u32 buf[1536 / 4] = {0};
		const u32 read = SDMMC_readSectors(SDMMC_DEV_CARD, 0, buf, 1);
		const u32 read2 = SDMMC_readSectors(SDMMC_DEV_CARD, sectors - 2, &buf[512 / 4], 2);
		SDMMC_deinit(SDMMC_DEV_CARD);
		ee_printf("init: %lu (try %lu), read: %lu, read2: %lu, sector[127]: 0x%lX\n", initRes, 3 - tries, read, read2, buf[511 / 4]);
	}

pooff:
	CODEC_deinit();
	GFX_deinit();
	power_off();

	return 0;
}