diskio.cpp

Go to the documentation of this file.

 
// ff.h 必须在 diskio.h 之前包含
// clang-format off
#include <ff.h>
#include <diskio.h>
// clang-format on
 
#include "fatfs.hpp"
#include "kernel_log.hpp"
 
extern "C" {
 
auto get_fattime() -> DWORD { return 0; }
 
auto disk_status(BYTE pdrv) -> DSTATUS {
  if (fatfs::FatFsFileSystem::GetBlockDevice(pdrv) == nullptr) {
    return STA_NOINIT;
  }
  return 0;
}
 
auto disk_initialize(BYTE pdrv) -> DSTATUS {
  if (fatfs::FatFsFileSystem::GetBlockDevice(pdrv) == nullptr) {
    return STA_NOINIT;
  }
  return 0;
}
 
auto disk_read(BYTE pdrv, BYTE* buff, LBA_t sector, UINT count) -> DRESULT {
  auto* dev = fatfs::FatFsFileSystem::GetBlockDevice(pdrv);
  if (dev == nullptr) {
    return RES_NOTRDY;
  }
  auto result = dev->ReadSectors(sector, static_cast<uint32_t>(count), buff);
  if (!result) {
    klog::Err("disk_read: pdrv={} sector={} count={} failed",
              static_cast<unsigned>(pdrv), static_cast<uint64_t>(sector),
              static_cast<unsigned>(count));
    return RES_ERROR;
  }
  return RES_OK;
}
 
auto disk_write(BYTE pdrv, const BYTE* buff, LBA_t sector, UINT count)
    -> DRESULT {
  auto* dev = fatfs::FatFsFileSystem::GetBlockDevice(pdrv);
  if (dev == nullptr) {
    return RES_NOTRDY;
  }
  auto result = dev->WriteSectors(sector, static_cast<uint32_t>(count), buff);
  if (!result) {
    klog::Err("disk_write: pdrv={} sector={} count={} failed",
              static_cast<unsigned>(pdrv), static_cast<uint64_t>(sector),
              static_cast<unsigned>(count));
    return RES_ERROR;
  }
  return RES_OK;
}
 
auto disk_ioctl(BYTE pdrv, BYTE cmd, void* buff) -> DRESULT {
  auto* dev = fatfs::FatFsFileSystem::GetBlockDevice(pdrv);
  if (dev == nullptr) {
    return RES_NOTRDY;
  }
  switch (cmd) {
    case CTRL_SYNC: {
      auto r = dev->Flush();
      return r ? RES_OK : RES_ERROR;
    }
    case GET_SECTOR_COUNT:
      if (buff == nullptr) {
        return RES_PARERR;
      }
      static_cast<LBA_t*>(buff)[0] = static_cast<LBA_t>(dev->GetSectorCount());
      return RES_OK;
    case GET_SECTOR_SIZE:
      if (buff == nullptr) {
        return RES_PARERR;
      }
      static_cast<WORD*>(buff)[0] = static_cast<WORD>(dev->GetSectorSize());
      return RES_OK;
    case GET_BLOCK_SIZE:
      if (buff == nullptr) {
        return RES_PARERR;
      }
      static_cast<DWORD*>(buff)[0] = 1;
      return RES_OK;
    case CTRL_TRIM:
      return RES_OK;  // TRIM 不是必需的
    default:
      return RES_PARERR;
  }
}
}