Upgrade gcc4mbed project used by Smoothie.

[clinton/Smoothieware.git] / src / libs / ChaNFS / CHAN_FS / diskio.cpp

/*-----------------------------------------------------------------------*/\r
/* Low level disk I/O module skeleton for FatFs     (C)ChaN, 2007        */\r
/*-----------------------------------------------------------------------*/\r
/* This is a stub disk I/O module that acts as front end of the existing */\r
/* disk I/O modules and attach it to FatFs module with common interface. */\r
/*-----------------------------------------------------------------------*/\r
\r
#include "diskio.h"\r
#include <stdio.h>\r
#include <string.h>\r
#include "FATFileSystem.h"\r
\r
#include "mbed.h"\r
\r
DSTATUS disk_initialize (\r
	BYTE drv				/* Physical drive nmuber (0..) */\r
) \r
{\r
	FFSDEBUG("disk_initialize on drv [%d]\n", drv);\r
	return (DSTATUS)FATFileSystem::_ffs[drv]->disk_initialize();\r
}\r
\r
DSTATUS disk_status (\r
	BYTE drv		/* Physical drive nmuber (0..) */\r
) \r
{\r
	FFSDEBUG("disk_status on drv [%d]\n", drv);\r
	return (DSTATUS)FATFileSystem::_ffs[drv]->disk_status();\r
}\r
\r
DRESULT disk_read (\r
	BYTE drv,		/* Physical drive nmuber (0..) */\r
	BYTE *buff,		/* Data buffer to store read data */\r
	DWORD sector,	/* Sector address (LBA) */\r
	BYTE count		/* Number of sectors to read (1..255) */\r
)\r
{\r
	FFSDEBUG("disk_read(sector %d, count %d) on drv [%d]\n", sector, count, drv);\r
	for(int s=sector; s<sector+count; s++) {\r
		FFSDEBUG(" disk_read(sector %d)\n", s);\r
		int res = FATFileSystem::_ffs[drv]->disk_read((char*)buff, s);\r
		if(res) {\r
			return RES_PARERR;\r
		}\r
		buff += 512;\r
	}\r
	return RES_OK;\r
}\r
\r
#if _READONLY == 0\r
DRESULT disk_write (\r
	BYTE drv,			/* Physical drive nmuber (0..) */\r
	const BYTE *buff,	/* Data to be written */\r
	DWORD sector,		/* Sector address (LBA) */\r
	BYTE count			/* Number of sectors to write (1..255) */\r
)\r
{\r
	FFSDEBUG("disk_write(sector %d, count %d) on drv [%d]\n", sector, count, drv);\r
	for(int s=sector; s<sector+count; s++) {\r
		FFSDEBUG(" disk_write(sector %d)\n", s);\r
		int res = FATFileSystem::_ffs[drv]->disk_write((char*)buff, sector);\r
		if(res) {\r
			return RES_PARERR;\r
		}\r
		buff += 512;\r
	}\r
	return RES_OK;\r
}\r
#endif /* _READONLY */\r
\r
DRESULT disk_ioctl (\r
	BYTE drv,		/* Physical drive nmuber (0..) */\r
	BYTE ctrl,		/* Control code */\r
	void *buff		/* Buffer to send/receive control data */\r
)\r
{\r
	FFSDEBUG("disk_ioctl(%d)\n", ctrl);\r
	switch(ctrl) {\r
		case CTRL_SYNC:\r
			if(FATFileSystem::_ffs[drv] == NULL) {\r
				return RES_NOTRDY;\r
			} else if(FATFileSystem::_ffs[drv]->disk_sync()) {\r
				return RES_ERROR;\r
			} \r
			return RES_OK;\r
		case GET_SECTOR_COUNT:\r
			if(FATFileSystem::_ffs[drv] == NULL) {\r
				return RES_NOTRDY;\r
			} else {\r
				int res = FATFileSystem::_ffs[drv]->disk_sectors();\r
				if(res > 0) {\r
					*((DWORD*)buff) = res; // minimum allowed\r
					return RES_OK;\r
				} else {\r
					return RES_ERROR;\r
				}\r
			}\r
		case GET_BLOCK_SIZE:\r
			*((DWORD*)buff) = 1; // default when not known\r
			return RES_OK;\r
\r
	}\r
	return RES_PARERR;\r
}\r
\r