dd

Dependencies:   C12832 LM75B mbed

Committer:
pfe
Date:
Tue Apr 21 10:16:20 2015 +0000
Revision:
0:05a20e3e3179
dd

Who changed what in which revision?

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