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