Muhammad Safwan / Mbed 2 deprecated 4180_hoverboad_project

Mbed project to control a hoverboard

Dependencies:   mbed wave_player Servo 4DGL-uLCD-SE LSM9DS1_Library_cal HC_SR04_Ultrasonic_Library

SDFileSystem/FATFileSystem/ChaN/diskio.cpp@3:bf0c46975248, 2020-04-29 (annotated)

Committer:
msafwan3
Date:
Wed Apr 29 22:42:25 2020 +0000
Revision:
3:bf0c46975248
Parent:
0:808403b99108 
removed rtos

Who changed what in which revision?

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