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