this one works ok

Dependencies:   mbed

Fork of Demo_NucleoF4xx_SD_Card by 不韋 呂

Committer:
Timoteo
Date:
Thu Dec 01 14:13:54 2016 +0000
Revision:
2:a27636d90999
Parent:
0:08b4a59451e5
mbed ok

Who changed what in which revision?

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