123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116 |
- /*
- * fat_disk.c
- */
-
- #include <string.h>
- #include <stdlib.h>
-
- #include "pico/stdlib.h"
- #include "ff.h"
- #include "diskio.h"
-
- #include "config.h"
- #include "log.h"
- #include "fat_disk.h"
-
- static uint8_t disk[DISK_BLOCK_COUNT * DISK_BLOCK_SIZE];
-
- void fat_disk_init(void) {
- BYTE work[FF_MAX_SS];
- FRESULT res = f_mkfs("", 0, work, sizeof(work));
- if (res != FR_OK) {
- debug("error: f_mkfs returned %d", res);
- return;
- }
- }
-
- uint8_t *fat_disk_get_sector(uint32_t sector) {
- return disk + (sector * DISK_BLOCK_SIZE);
- }
-
- /*
- * FatFS ffsystem.c
- */
-
- void* ff_memalloc(UINT msize) {
- return malloc((size_t)msize);
- }
-
- void ff_memfree(void* mblock) {
- free(mblock);
- }
-
- /*
- * FatFS diskio.c
- */
-
- DSTATUS disk_status(BYTE pdrv) {
- if (pdrv != 0) {
- debug("invalid drive number %d", pdrv);
- return STA_NODISK;
- }
-
- return 0;
- }
-
- DSTATUS disk_initialize(BYTE pdrv) {
- if (pdrv != 0) {
- debug("invalid drive number %d", pdrv);
- return STA_NODISK;
- }
-
- return 0;
- }
-
- DRESULT disk_read(BYTE pdrv, BYTE *buff, LBA_t sector, UINT count) {
- if (pdrv != 0) {
- debug("invalid drive number %d", pdrv);
- return RES_PARERR;
- }
-
- if ((sector + count) > DISK_BLOCK_COUNT) {
- debug("invalid read ((%lu + %u) > %u)", sector, count, DISK_BLOCK_COUNT);
- return RES_ERROR;
- }
-
- memcpy(buff, disk + (sector * DISK_BLOCK_SIZE), count * DISK_BLOCK_SIZE);
- return RES_OK;
- }
-
- DRESULT disk_write(BYTE pdrv, const BYTE *buff, LBA_t sector, UINT count) {
- if (pdrv != 0) {
- debug("invalid drive number %d", pdrv);
- return RES_PARERR;
- }
-
- if ((sector + count) > DISK_BLOCK_COUNT) {
- debug("invalid read ((%lu + %u) > %u)", sector, count, DISK_BLOCK_COUNT);
- return RES_ERROR;
- }
-
- memcpy(disk + (sector * DISK_BLOCK_SIZE), buff, count * DISK_BLOCK_SIZE);
- return RES_OK;
- }
-
- DRESULT disk_ioctl(BYTE pdrv, BYTE cmd, void *buff) {
- if (pdrv != 0) {
- debug("invalid drive number %d", pdrv);
- return RES_PARERR;
- }
-
- switch (cmd) {
- case GET_SECTOR_COUNT:
- *((LBA_t *)buff) = DISK_BLOCK_COUNT;
- break;
-
- case GET_SECTOR_SIZE:
- *((WORD *)buff) = DISK_BLOCK_SIZE;
- break;
-
- case GET_BLOCK_SIZE:
- *((DWORD *)buff) = 1; // non flash memory media
- break;
- }
-
- return RES_OK;
- }
|