disk_wrapper.cpp

Go to the documentation of this file.

#include <zephyr/drivers/disk.h>
#include <zephyr/init.h>
#include <zephyr/kernel.h>
#include <zephyr/storage/disk_access.h>
 
static int
offset_disk_init(struct disk_info *disk)
{
  int rc = disk_access_init(CONFIG_STM32_SDMMC_DEFAULT_DISK_NAME);
  return rc;
}
 
static int
offset_disk_status(struct disk_info *disk)
{
  /* Fix me */
  return DISK_STATUS_OK;
}
 
static int
offset_disk_read(struct disk_info *disk, uint8_t *buff, uint32_t sector,
                 uint32_t count)
{
  return disk_access_read(CONFIG_STM32_SDMMC_DEFAULT_DISK_NAME, buff,
                          sector + CONFIG_DISK_START_SECTOR, count);
}
 
static int
offset_disk_write(struct disk_info *disk, const uint8_t *buff, uint32_t sector,
                  uint32_t count)
{
  return disk_access_write(CONFIG_STM32_SDMMC_DEFAULT_DISK_NAME, buff,
                           sector + CONFIG_DISK_START_SECTOR, count);
}
 
static int
offset_disk_ioctl(struct disk_info *disk, uint8_t cmd, void *buff)
{
  int ret = disk_access_ioctl(CONFIG_STM32_SDMMC_DEFAULT_DISK_NAME, cmd, buff);
  if (ret != 0) {
    return ret;
  }
 
  if (cmd == DISK_IOCTL_GET_SECTOR_COUNT) {
    uint32_t *count = (uint32_t *)buff;
    *count -= CONFIG_DISK_START_SECTOR;
  }
 
  return 0;
}
 
static struct disk_operations offset_sd_ops = {
    .init   = offset_disk_init,
    .status = offset_disk_status,
    .read   = offset_disk_read,
    .write  = offset_disk_write,
    .ioctl  = offset_disk_ioctl,
};
 
static struct disk_info offset_disk_info = {
    .name = CONFIG_DISK_NAME,
    .ops  = &offset_sd_ops,
};
 
/* Automatically register at boot */
static int
offset_disk_register_init(void)
{
  return disk_access_register(&offset_disk_info);
}
SYS_INIT(offset_disk_register_init, APPLICATION,
         CONFIG_APPLICATION_INIT_PRIORITY);