mirror of
https://github.com/DarkFlippers/unleashed-firmware.git
synced 2024-12-18 19:01:47 +03:00
4705812d24
* Storage: remove unused error from SDInfo * FatFS: remove sd_spi_io * HAL: sd card api * Update: use sd hal * FatFS: use sd hal * Storage: use sd hal * API: sd hal * Fix TODO workflow * SD Hal: Fix source buffer overflow * fix for fix! * HAL: cleanup sd detection api * HAL: FURI_HAL_SD_SPI_DEBUG flag * HAL: FuriHalSdStatus -> FuriStatus * API: downgrade * Change define logic * HAL: presence
120 lines
3.2 KiB
C
120 lines
3.2 KiB
C
#include <furi.h>
|
|
#include <furi_hal.h>
|
|
#include "user_diskio.h"
|
|
#include "sector_cache.h"
|
|
|
|
static DSTATUS driver_initialize(BYTE pdrv);
|
|
static DSTATUS driver_status(BYTE pdrv);
|
|
static DRESULT driver_read(BYTE pdrv, BYTE* buff, DWORD sector, UINT count);
|
|
static DRESULT driver_write(BYTE pdrv, const BYTE* buff, DWORD sector, UINT count);
|
|
static DRESULT driver_ioctl(BYTE pdrv, BYTE cmd, void* buff);
|
|
|
|
Diskio_drvTypeDef sd_fatfs_driver = {
|
|
driver_initialize,
|
|
driver_status,
|
|
driver_read,
|
|
driver_write,
|
|
driver_ioctl,
|
|
};
|
|
|
|
/**
|
|
* @brief Initializes a Drive
|
|
* @param pdrv: Physical drive number (0..)
|
|
* @retval DSTATUS: Operation status
|
|
*/
|
|
static DSTATUS driver_initialize(BYTE pdrv) {
|
|
UNUSED(pdrv);
|
|
return RES_OK;
|
|
}
|
|
|
|
/**
|
|
* @brief Gets Disk Status
|
|
* @param pdrv: Physical drive number (0..)
|
|
* @retval DSTATUS: Operation status
|
|
*/
|
|
static DSTATUS driver_status(BYTE pdrv) {
|
|
UNUSED(pdrv);
|
|
DSTATUS status = 0;
|
|
if(furi_hal_sd_get_card_state() != FuriStatusOk) {
|
|
status = STA_NOINIT;
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* @brief Reads Sector(s)
|
|
* @param pdrv: Physical drive number (0..)
|
|
* @param *buff: Data buffer to store read data
|
|
* @param sector: Sector address (LBA)
|
|
* @param count: Number of sectors to read (1..128)
|
|
* @retval DRESULT: Operation result
|
|
*/
|
|
static DRESULT driver_read(BYTE pdrv, BYTE* buff, DWORD sector, UINT count) {
|
|
UNUSED(pdrv);
|
|
FuriStatus status = furi_hal_sd_read_blocks((uint32_t*)buff, (uint32_t)(sector), count);
|
|
return status == FuriStatusOk ? RES_OK : RES_ERROR;
|
|
}
|
|
|
|
/**
|
|
* @brief Writes Sector(s)
|
|
* @param pdrv: Physical drive number (0..)
|
|
* @param *buff: Data to be written
|
|
* @param sector: Sector address (LBA)
|
|
* @param count: Number of sectors to write (1..128)
|
|
* @retval DRESULT: Operation result
|
|
*/
|
|
static DRESULT driver_write(BYTE pdrv, const BYTE* buff, DWORD sector, UINT count) {
|
|
UNUSED(pdrv);
|
|
FuriStatus status = furi_hal_sd_write_blocks((uint32_t*)buff, (uint32_t)(sector), count);
|
|
return status == FuriStatusOk ? RES_OK : RES_ERROR;
|
|
}
|
|
|
|
/**
|
|
* @brief I/O control operation
|
|
* @param pdrv: Physical drive number (0..)
|
|
* @param cmd: Control code
|
|
* @param *buff: Buffer to send/receive control data
|
|
* @retval DRESULT: Operation result
|
|
*/
|
|
static DRESULT driver_ioctl(BYTE pdrv, BYTE cmd, void* buff) {
|
|
DRESULT res = RES_ERROR;
|
|
FuriHalSdInfo sd_info;
|
|
|
|
DSTATUS status = driver_status(pdrv);
|
|
if(status & 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:
|
|
furi_hal_sd_info(&sd_info);
|
|
*(DWORD*)buff = sd_info.logical_block_count;
|
|
res = RES_OK;
|
|
break;
|
|
|
|
/* Get R/W sector size (WORD) */
|
|
case GET_SECTOR_SIZE:
|
|
furi_hal_sd_info(&sd_info);
|
|
*(WORD*)buff = sd_info.logical_block_size;
|
|
res = RES_OK;
|
|
break;
|
|
|
|
/* Get erase block size in unit of sector (DWORD) */
|
|
case GET_BLOCK_SIZE:
|
|
furi_hal_sd_info(&sd_info);
|
|
*(DWORD*)buff = sd_info.logical_block_size;
|
|
res = RES_OK;
|
|
break;
|
|
|
|
default:
|
|
res = RES_PARERR;
|
|
}
|
|
|
|
return res;
|
|
}
|