/*-----------------------------------------------------------------------*/
/* Low level disk I/O module skeleton for FatFs     (C)ChaN, 2007        */
/*-----------------------------------------------------------------------*/
/* This is a stub disk I/O module that acts as front end of the existing */
/* disk I/O modules and attach it to FatFs module with common interface. */
/*-----------------------------------------------------------------------*/

#include "diskio.h"
#include "string.h"
#include "sdmmc.h"
//#include "sdhc.h"

#ifndef MEM2_BSS
#define MEM2_BSS
#endif

//static sdhci_t sdhci;
static u8 buffer[512] MEM2_BSS ALIGNED(32);

/*-----------------------------------------------------------------------*/
/* Inidialize a Drive                                                    */

DSTATUS disk_initialize (
	BYTE drv				/* Physical drive nmuber (0..) */
)
{
	if (sdmmc_check_card(SDMMC_DEFAULT_DEVICE) == SDMMC_NO_CARD)
		return STA_NOINIT;

	sdmmc_ack_card(SDMMC_DEFAULT_DEVICE);
	return disk_status(drv);
}



/*-----------------------------------------------------------------------*/
/* Return Disk Status                                                    */

DSTATUS disk_status (
	BYTE drv		/* Physical drive nmuber (0..) */
)
{
//	if (sd_inserted(&sdhci) == 0)
//		return STA_NODISK;

	if (sdmmc_check_card(SDMMC_DEFAULT_DEVICE) == SDMMC_INSERTED)
		return 0;
	else
		return STA_NODISK;
}



/*-----------------------------------------------------------------------*/
/* Read Sector(s)                                                        */

DRESULT disk_read (
	BYTE drv,		/* Physical drive nmuber (0..) */
	BYTE *buff,		/* Data buffer to store read data */
	DWORD sector,	/* Sector address (LBA) */
	BYTE count		/* Number of sectors to read (1..255) */
)
{
	int i;
	DRESULT res;

	res = RES_OK;
	for (i = 0; i < count; i++) {
		if (sdmmc_read(SDMMC_DEFAULT_DEVICE, sector+i, 1, buffer) != 0){
			res = RES_ERROR;
			break;
		}

		memcpy(buff + i * 512, buffer, 512);
	}

	return res;
}



/*-----------------------------------------------------------------------*/
/* Write Sector(s)                                                       */

#if _READONLY == 0
DRESULT disk_write (
	BYTE drv,			/* Physical drive nmuber (0..) */
	const BYTE *buff,	/* Data to be written */
	DWORD sector,		/* Sector address (LBA) */
	BYTE count			/* Number of sectors to write (1..255) */
)
{
	int i;
	DRESULT res;

	res = RES_OK;
	for (i = 0; i < count; i++) {
		memcpy(buffer, buff + i * 512, 512);

/*		if(sd_write(&sdhci, sector + i, 1, buffer) != 0) {
			res = RES_ERROR;
			break;
		}*/
	}

	return res;
}
#endif /* _READONLY */



/*-----------------------------------------------------------------------*/
/* Miscellaneous Functions                                               */

DRESULT disk_ioctl (
	BYTE drv,		/* Physical drive nmuber (0..) */
	BYTE ctrl,		/* Control code */
	void *buff		/* Buffer to send/receive control data */
)
{
	if (ctrl == CTRL_SYNC)
		return RES_OK;

	return RES_PARERR;
}