SDSTM32DiskIO.h

 
/* Includes ------------------------------------------------------------------*/
#pragma once
 
#include "BaseIO.h"
 
#define _USE_WRITE 1 /* 1: Enable disk_write function */
#define _USE_IOCTL 1 /* 1: Enable disk_ioctl function */
 
/* use the default SD timout as defined in the platform BSP driver*/
#if defined(SDMMC_DATATIMEOUT)
#define SD_TIMEOUT SDMMC_DATATIMEOUT
#elif defined(SD_DATATIMEOUT)
#define SD_TIMEOUT SD_DATATIMEOUT
#else
#define SD_TIMEOUT 30 * 1000
#endif
 
#define SD_DEFAULT_BLOCK_SIZE 512
 
namespace fatfs {
 
class SDSTM32DiskIO : public BaseIO {
 public:
  DSTATUS disk_initialize(BYTE lun) override {
    stat = STA_NOINIT;
#if !defined(DISABLE_SD_INIT)
 
    if (BSP_SD_Init() == MSD_OK) {
      stat = SD_CheckStatus(lun);
    }
 
#else
    Stat = SD_CheckStatus(lun);
#endif
    return stat;
  }
 
  DSTATUS disk_status(BYTE lun) override { return SD_CheckStatus(lun); }
 
  DRESULT disk_read(BYTE lun, BYTE *buff, DWORD sector, UINT count) {
    (void)lun;
    DRESULT res = RES_ERROR;
 
    if (BSP_SD_ReadBlocks((uint32_t *)buff, (uint32_t)(sector), count,
                          SD_TIMEOUT) == MSD_OK) {
      /* wait until the read operation is finished */
      while (BSP_SD_GetCardState() != MSD_OK) {
      }
      res = RES_OK;
    }
 
    return res;
  }
 
#if _USE_WRITE == 1
  DRESULT disk_write(BYTE lun, const BYTE *buff, DWORD sector, UINT count) {
    (void)lun;
    DRESULT res = RES_ERROR;
 
    if (BSP_SD_WriteBlocks((uint32_t *)buff, (uint32_t)(sector), count,
                           SD_TIMEOUT) == MSD_OK) {
      /* wait until the Write operation is finished */
      while (BSP_SD_GetCardState() != MSD_OK) {
      }
      res = RES_OK;
    }
 
    return res;
  }
#endif /* _USE_WRITE == 1 */
 
#if _USE_IOCTL == 1
  DRESULT disk_ioctl(BYTE lun, ioctl_cmd_t cmd, void *buff) {
    (void)lun;
    DRESULT res = RES_ERROR;
    BSP_SD_CardInfo CardInfo;
 
    if (stat & STA_NOINIT) return RES_NOTRDY;
 
    switch (cmd) {
      /* Make sure that no pending write process */
      case CTRL_SYNC:
        res = RES_OK;
        break;
 
      /* Get number of sectors on the disk (DWORD) */
      case GET_SECTOR_COUNT:
        BSP_SD_GetCardInfo(&CardInfo);
        *(DWORD *)buff = CardInfo.LogBlockNbr;
        res = RES_OK;
        break;
 
      /* Get R/W sector size (WORD) */
      case GET_SECTOR_SIZE:
        BSP_SD_GetCardInfo(&CardInfo);
        *(WORD *)buff = CardInfo.LogBlockSize;
        res = RES_OK;
        break;
 
      /* Get erase block size in unit of sector (DWORD) */
      case GET_BLOCK_SIZE:
        BSP_SD_GetCardInfo(&CardInfo);
        *(DWORD *)buff = CardInfo.LogBlockSize / SD_DEFAULT_BLOCK_SIZE;
        res = RES_OK;
        break;
 
      default:
        res = RES_PARERR;
    }
 
    return res;
  }
#endif /* _USE_IOCTL == 1 */
 
protected:
  /* Disk status */
  volatile DSTATUS stat = STA_NOINIT;
 
  DSTATUS SD_CheckStatus(BYTE lun) {
    (void)lun;
    stat = STA_NOINIT;
 
    if (BSP_SD_GetCardState() == MSD_OK) {
      stat &= ~STA_NOINIT;
    }
 
    return stat;
  }
};
 
}  // namespace fatfs