Atsushi Hattori / Mbed 2 deprecated 20210627_Logger

hattori&ide

Dependencies:   mbed

ChaNFSUSB/ChaNFS/CHAN_FS/diskio.c@0:f77369cabd75, 18 months ago (annotated)

Committer:
hattori_atsushi
Date:
Sun Dec 18 08:16:01 2022 +0000
Revision:
0:f77369cabd75
hattori

Who changed what in which revision?

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