J&W / Mbed 2 deprecated Rejestrator

Dependencies:   mbed Rejestrator

Dependents:   Rejestrator

Committer:
Waldek
Date:
Sat Apr 18 17:01:57 2015 +0000
Revision:
0:fa31f8461c63
working version, stop

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Waldek 0:fa31f8461c63 1 /*-----------------------------------------------------------------------*/
Waldek 0:fa31f8461c63 2 /* Low level disk I/O module skeleton for FatFs (C)ChaN, 2007 */
Waldek 0:fa31f8461c63 3 /*-----------------------------------------------------------------------*/
Waldek 0:fa31f8461c63 4 /* This is a stub disk I/O module that acts as front end of the existing */
Waldek 0:fa31f8461c63 5 /* disk I/O modules and attach it to FatFs module with common interface. */
Waldek 0:fa31f8461c63 6 /*-----------------------------------------------------------------------*/
Waldek 0:fa31f8461c63 7 #include "ffconf.h"
Waldek 0:fa31f8461c63 8 #include "diskio.h"
Waldek 0:fa31f8461c63 9
Waldek 0:fa31f8461c63 10 #include "mbed_debug.h"
Waldek 0:fa31f8461c63 11 #include "FATFileSystem.h"
Waldek 0:fa31f8461c63 12
Waldek 0:fa31f8461c63 13 using namespace mbed;
Waldek 0:fa31f8461c63 14
Waldek 0:fa31f8461c63 15 DSTATUS disk_initialize (
Waldek 0:fa31f8461c63 16 BYTE drv /* Physical drive nmuber (0..) */
Waldek 0:fa31f8461c63 17 )
Waldek 0:fa31f8461c63 18 {
Waldek 0:fa31f8461c63 19 debug_if(FFS_DBG, "disk_initialize on drv [%d]\n", drv);
Waldek 0:fa31f8461c63 20 return (DSTATUS)FATFileSystem::_ffs[drv]->disk_initialize();
Waldek 0:fa31f8461c63 21 }
Waldek 0:fa31f8461c63 22
Waldek 0:fa31f8461c63 23 DSTATUS disk_status (
Waldek 0:fa31f8461c63 24 BYTE drv /* Physical drive nmuber (0..) */
Waldek 0:fa31f8461c63 25 )
Waldek 0:fa31f8461c63 26 {
Waldek 0:fa31f8461c63 27 debug_if(FFS_DBG, "disk_status on drv [%d]\n", drv);
Waldek 0:fa31f8461c63 28 return (DSTATUS)FATFileSystem::_ffs[drv]->disk_status();
Waldek 0:fa31f8461c63 29 }
Waldek 0:fa31f8461c63 30
Waldek 0:fa31f8461c63 31 DRESULT disk_read (
Waldek 0:fa31f8461c63 32 BYTE drv, /* Physical drive nmuber (0..) */
Waldek 0:fa31f8461c63 33 BYTE *buff, /* Data buffer to store read data */
Waldek 0:fa31f8461c63 34 DWORD sector, /* Sector address (LBA) */
Waldek 0:fa31f8461c63 35 BYTE count /* Number of sectors to read (1..255) */
Waldek 0:fa31f8461c63 36 )
Waldek 0:fa31f8461c63 37 {
Waldek 0:fa31f8461c63 38 debug_if(FFS_DBG, "disk_read(sector %d, count %d) on drv [%d]\n", sector, count, drv);
Waldek 0:fa31f8461c63 39 for(DWORD s=sector; s<sector+count; s++) {
Waldek 0:fa31f8461c63 40 debug_if(FFS_DBG, " disk_read(sector %d)\n", s);
Waldek 0:fa31f8461c63 41 int res = FATFileSystem::_ffs[drv]->disk_read((uint8_t*)buff, s);
Waldek 0:fa31f8461c63 42 if(res) {
Waldek 0:fa31f8461c63 43 return RES_PARERR;
Waldek 0:fa31f8461c63 44 }
Waldek 0:fa31f8461c63 45 buff += 512;
Waldek 0:fa31f8461c63 46 }
Waldek 0:fa31f8461c63 47 return RES_OK;
Waldek 0:fa31f8461c63 48 }
Waldek 0:fa31f8461c63 49
Waldek 0:fa31f8461c63 50 #if _READONLY == 0
Waldek 0:fa31f8461c63 51 DRESULT disk_write (
Waldek 0:fa31f8461c63 52 BYTE drv, /* Physical drive nmuber (0..) */
Waldek 0:fa31f8461c63 53 const BYTE *buff, /* Data to be written */
Waldek 0:fa31f8461c63 54 DWORD sector, /* Sector address (LBA) */
Waldek 0:fa31f8461c63 55 BYTE count /* Number of sectors to write (1..255) */
Waldek 0:fa31f8461c63 56 )
Waldek 0:fa31f8461c63 57 {
Waldek 0:fa31f8461c63 58 debug_if(FFS_DBG, "disk_write(sector %d, count %d) on drv [%d]\n", sector, count, drv);
Waldek 0:fa31f8461c63 59 for(DWORD s = sector; s < sector + count; s++) {
Waldek 0:fa31f8461c63 60 debug_if(FFS_DBG, " disk_write(sector %d)\n", s);
Waldek 0:fa31f8461c63 61 int res = FATFileSystem::_ffs[drv]->disk_write((uint8_t*)buff, s);
Waldek 0:fa31f8461c63 62 if(res) {
Waldek 0:fa31f8461c63 63 return RES_PARERR;
Waldek 0:fa31f8461c63 64 }
Waldek 0:fa31f8461c63 65 buff += 512;
Waldek 0:fa31f8461c63 66 }
Waldek 0:fa31f8461c63 67 return RES_OK;
Waldek 0:fa31f8461c63 68 }
Waldek 0:fa31f8461c63 69 #endif /* _READONLY */
Waldek 0:fa31f8461c63 70
Waldek 0:fa31f8461c63 71 DRESULT disk_ioctl (
Waldek 0:fa31f8461c63 72 BYTE drv, /* Physical drive nmuber (0..) */
Waldek 0:fa31f8461c63 73 BYTE ctrl, /* Control code */
Waldek 0:fa31f8461c63 74 void *buff /* Buffer to send/receive control data */
Waldek 0:fa31f8461c63 75 )
Waldek 0:fa31f8461c63 76 {
Waldek 0:fa31f8461c63 77 debug_if(FFS_DBG, "disk_ioctl(%d)\n", ctrl);
Waldek 0:fa31f8461c63 78 switch(ctrl) {
Waldek 0:fa31f8461c63 79 case CTRL_SYNC:
Waldek 0:fa31f8461c63 80 if(FATFileSystem::_ffs[drv] == NULL) {
Waldek 0:fa31f8461c63 81 return RES_NOTRDY;
Waldek 0:fa31f8461c63 82 } else if(FATFileSystem::_ffs[drv]->disk_sync()) {
Waldek 0:fa31f8461c63 83 return RES_ERROR;
Waldek 0:fa31f8461c63 84 }
Waldek 0:fa31f8461c63 85 return RES_OK;
Waldek 0:fa31f8461c63 86 case GET_SECTOR_COUNT:
Waldek 0:fa31f8461c63 87 if(FATFileSystem::_ffs[drv] == NULL) {
Waldek 0:fa31f8461c63 88 return RES_NOTRDY;
Waldek 0:fa31f8461c63 89 } else {
Waldek 0:fa31f8461c63 90 DWORD res = FATFileSystem::_ffs[drv]->disk_sectors();
Waldek 0:fa31f8461c63 91 if(res > 0) {
Waldek 0:fa31f8461c63 92 *((DWORD*)buff) = res; // minimum allowed
Waldek 0:fa31f8461c63 93 return RES_OK;
Waldek 0:fa31f8461c63 94 } else {
Waldek 0:fa31f8461c63 95 return RES_ERROR;
Waldek 0:fa31f8461c63 96 }
Waldek 0:fa31f8461c63 97 }
Waldek 0:fa31f8461c63 98 case GET_BLOCK_SIZE:
Waldek 0:fa31f8461c63 99 *((DWORD*)buff) = 1; // default when not known
Waldek 0:fa31f8461c63 100 return RES_OK;
Waldek 0:fa31f8461c63 101
Waldek 0:fa31f8461c63 102 }
Waldek 0:fa31f8461c63 103 return RES_PARERR;
Waldek 0:fa31f8461c63 104 }