Xbee CountUp

Dependencies:   mbed

Fork of HeptaXbee_CountUp by 智也 大野

Committer:
tomoya123
Date:
Tue Dec 13 07:55:03 2016 +0000
Revision:
1:715b80d2a02b
Parent:
0:0a7fa0911e6c
Xbee CountUp

Who changed what in which revision?

UserRevisionLine numberNew 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 }