#include <stdint.h>
#include <conio.h>
#include <string.h>
#include <stdlib.h>

#include "devices/board_io.h"
#include "devices/uart.h"
#include "devices/sd_card.h"
#include "devices/sd_print.h"
#include "filesystem/fat.h"

#define KERNEL_LOAD_ADDR 0xD000

uint8_t buf[512];

int main() {
    // array to hold responses
    uint8_t res[5], token;
    uint32_t addr = 0x00000000;
	uint16_t i;

	cputs("Start\r\n");

    // initialize sd card
    if(SD_init() != SD_SUCCESS)
    {
        cputs("Error init SD CARD\r\n");
    }
    else
    {
        cputs("SD Card init\r\n");

        // read sector 0
        // cputs("\r\nReading sector: 0x");
        // ((uint8_t)(addr >> 24));
        // cprintf("%x", (uint8_t)(addr >> 16));
        // cprintf("%x", (uint8_t)(addr >> 8));
        // cprintf("%x", (uint8_t)addr);
        // res[0] = SD_readSingleBlock(addr, buf, &token);
        // cputs("\r\nResponse:\r\n");
        // //SD_printR1(res[0]);

        // if no error, print buffer
        // if((res[0] == 0x00) && (token == SD_START_TOKEN))
        //     SD_printBuf(buf);
        // else if error token received, print
        // else if(!(token & 0xF0))
        // {
        //     cputs("Ercputsror token:\r\n");
        //     SD_printDataErrToken(token);
        // }

        // update address to 0x00000100
        // addr = 0x00000100;

        // // fill buffer with 0x55
        // for(i = 0; i < 512; i++) buf[i] = 0x55;

        // cputs("Writing 0x55 to sector: 0x");
        // cprintf("%x", (uint8_t)(addr >> 24));
        // cprintf("%x", (uint8_t)(addr >> 16));
        // cprintf("%x", (uint8_t)(addr >> 8));
        // cprintf("%x", (uint8_t)addr);

        // // write data to sector
        // res[0] = SD_writeSingleBlock(addr, buf, &token);

        // cputs("\r\nResponse:\r\n");
        // //SD_printR1(res[0]);

        // // if no errors writing
        // if(res[0] == 0x00)
        // {
        //     if(token == SD_DATA_ACCEPTED)
        //         cputs("Write successful\r\n");
        // }
    }

    while(1) ;

}