rtos sd encoder systems

Dependencies:   mbed

Committer:
eembed
Date:
Fri Aug 30 11:55:47 2019 +0000
Revision:
3:a921792d9913
Parent:
0:5459cdde6298
commit before edit; ~JKD;

Who changed what in which revision?

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