|
|
@@ -12,22 +12,107 @@
|
|
|
#include "esp_vfs_fat.h"
|
|
|
#include "vfs_fat_internal.h"
|
|
|
#include "diskio_impl.h"
|
|
|
-
|
|
|
#include "diskio_rawflash.h"
|
|
|
-
|
|
|
#include "wear_levelling.h"
|
|
|
#include "diskio_wl.h"
|
|
|
|
|
|
static const char* TAG = "vfs_fat_spiflash";
|
|
|
|
|
|
+typedef struct vfs_fat_spiflash_ctx_t {
|
|
|
+ const esp_partition_t *partition; //The partition where the FAT is located
|
|
|
+ bool by_label; //If the partition is mounted by lable or not
|
|
|
+ BYTE pdrv; //Drive number that is mounted
|
|
|
+ FATFS *fs; //FAT structure pointer that is registered
|
|
|
+ wl_handle_t wlhandle; //WL handle
|
|
|
+ esp_vfs_fat_mount_config_t mount_config; //Mount configuration
|
|
|
+} vfs_fat_spiflash_ctx_t;
|
|
|
+
|
|
|
+static vfs_fat_spiflash_ctx_t *s_ctx[FF_VOLUMES] = {};
|
|
|
+
|
|
|
+static bool s_get_context_id_by_label(const char *label, uint32_t *out_id)
|
|
|
+{
|
|
|
+ vfs_fat_spiflash_ctx_t *p_ctx = NULL;
|
|
|
+ for (int i = 0; i < FF_VOLUMES; i++) {
|
|
|
+ p_ctx = s_ctx[i];
|
|
|
+ if (p_ctx) {
|
|
|
+ if (!label && !p_ctx->by_label) {
|
|
|
+ *out_id = i;
|
|
|
+ return true;
|
|
|
+ }
|
|
|
+ if (label && p_ctx->by_label && strncmp(label, p_ctx->partition->label, 20) == 0) {
|
|
|
+ *out_id = i;
|
|
|
+ return true;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return false;
|
|
|
+}
|
|
|
+
|
|
|
+static bool s_get_context_id_by_wl_handle(wl_handle_t wlhandle, uint32_t *out_id)
|
|
|
+{
|
|
|
+ vfs_fat_spiflash_ctx_t *p_ctx = NULL;
|
|
|
+ for (int i = 0; i < FF_VOLUMES; i++) {
|
|
|
+ p_ctx = s_ctx[i];
|
|
|
+ if (p_ctx) {
|
|
|
+ if (p_ctx->wlhandle == wlhandle) {
|
|
|
+ *out_id = i;
|
|
|
+ return true;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return false;
|
|
|
+}
|
|
|
+
|
|
|
+static uint32_t s_get_unused_context_id(void)
|
|
|
+{
|
|
|
+ for (uint32_t i = 0; i < FF_VOLUMES; i++) {
|
|
|
+ if (!s_ctx[i]) {
|
|
|
+ return i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return FF_VOLUMES;
|
|
|
+}
|
|
|
+
|
|
|
+static esp_err_t s_f_mount_rw(FATFS *fs, const char *drv, const esp_vfs_fat_mount_config_t *mount_config)
|
|
|
+{
|
|
|
+ FRESULT fresult = f_mount(fs, drv, 1);
|
|
|
+ if (fresult != FR_OK) {
|
|
|
+ ESP_LOGW(TAG, "f_mount failed (%d)", fresult);
|
|
|
+
|
|
|
+ bool need_mount_again = (fresult == FR_NO_FILESYSTEM || fresult == FR_INT_ERR) && mount_config->format_if_mount_failed;
|
|
|
+ if (!need_mount_again) {
|
|
|
+ return ESP_FAIL;
|
|
|
+ }
|
|
|
+
|
|
|
+ const size_t workbuf_size = 4096;
|
|
|
+ void *workbuf = ff_memalloc(workbuf_size);
|
|
|
+ if (workbuf == NULL) {
|
|
|
+ return ESP_ERR_NO_MEM;
|
|
|
+ }
|
|
|
+
|
|
|
+ size_t alloc_unit_size = esp_vfs_fat_get_allocation_unit_size(CONFIG_WL_SECTOR_SIZE, mount_config->allocation_unit_size);
|
|
|
+ ESP_LOGI(TAG, "Formatting FATFS partition, allocation unit size=%d", alloc_unit_size);
|
|
|
+ const MKFS_PARM opt = {(BYTE)(FM_ANY | FM_SFD), 0, 0, 0, alloc_unit_size};
|
|
|
+ fresult = f_mkfs(drv, &opt, workbuf, workbuf_size);
|
|
|
+ free(workbuf);
|
|
|
+ workbuf = NULL;
|
|
|
+ ESP_RETURN_ON_FALSE(fresult == FR_OK, ESP_FAIL, TAG, "f_mkfs failed (%d)", fresult);
|
|
|
+
|
|
|
+ ESP_LOGI(TAG, "Mounting again");
|
|
|
+ fresult = f_mount(fs, drv, 0);
|
|
|
+ ESP_RETURN_ON_FALSE(fresult == FR_OK, ESP_FAIL, TAG, "f_mount failed after formatting (%d)", fresult);
|
|
|
+ }
|
|
|
+ return ESP_OK;
|
|
|
+}
|
|
|
+
|
|
|
esp_err_t esp_vfs_fat_spiflash_mount_rw_wl(const char* base_path,
|
|
|
const char* partition_label,
|
|
|
const esp_vfs_fat_mount_config_t* mount_config,
|
|
|
wl_handle_t* wl_handle)
|
|
|
{
|
|
|
esp_err_t ret = ESP_OK;
|
|
|
- const size_t workbuf_size = 4096;
|
|
|
- void *workbuf = NULL;
|
|
|
+ vfs_fat_spiflash_ctx_t *ctx = NULL;
|
|
|
+ uint32_t ctx_id = FF_VOLUMES;
|
|
|
|
|
|
esp_partition_subtype_t subtype = partition_label ?
|
|
|
ESP_PARTITION_SUBTYPE_ANY : ESP_PARTITION_SUBTYPE_DATA_FAT;
|
|
|
@@ -57,38 +142,33 @@ esp_err_t esp_vfs_fat_spiflash_mount_rw_wl(const char* base_path,
|
|
|
}
|
|
|
|
|
|
// Try to mount partition
|
|
|
- FRESULT fresult = f_mount(fs, drv, 1);
|
|
|
- if (fresult != FR_OK) {
|
|
|
- ESP_LOGW(TAG, "f_mount failed (%d)", fresult);
|
|
|
- if (!((fresult == FR_NO_FILESYSTEM || fresult == FR_INT_ERR)
|
|
|
- && mount_config->format_if_mount_failed)) {
|
|
|
- ret = ESP_FAIL;
|
|
|
- goto fail;
|
|
|
- }
|
|
|
- workbuf = ff_memalloc(workbuf_size);
|
|
|
- if (workbuf == NULL) {
|
|
|
- ret = ESP_ERR_NO_MEM;
|
|
|
- goto fail;
|
|
|
- }
|
|
|
- size_t alloc_unit_size = esp_vfs_fat_get_allocation_unit_size(
|
|
|
- CONFIG_WL_SECTOR_SIZE,
|
|
|
- mount_config->allocation_unit_size);
|
|
|
- ESP_LOGI(TAG, "Formatting FATFS partition, allocation unit size=%d", alloc_unit_size);
|
|
|
- const MKFS_PARM opt = {(BYTE)(FM_ANY | FM_SFD), 0, 0, 0, alloc_unit_size};
|
|
|
- fresult = f_mkfs(drv, &opt, workbuf, workbuf_size);
|
|
|
- ESP_GOTO_ON_FALSE(fresult == FR_OK, ESP_FAIL, fail, TAG, "f_mkfs failed (%d)", fresult);
|
|
|
- free(workbuf);
|
|
|
- workbuf = NULL;
|
|
|
- ESP_LOGI(TAG, "Mounting again");
|
|
|
- fresult = f_mount(fs, drv, 0);
|
|
|
- ESP_GOTO_ON_FALSE(fresult == FR_OK, ESP_FAIL, fail, TAG, "f_mount failed after formatting (%d)", fresult);
|
|
|
+ ret = s_f_mount_rw(fs, drv, mount_config);
|
|
|
+ if (ret != ESP_OK) {
|
|
|
+ goto fail;
|
|
|
}
|
|
|
+
|
|
|
+ ctx = calloc(sizeof(vfs_fat_spiflash_ctx_t), 1);
|
|
|
+ ESP_GOTO_ON_FALSE(ctx, ESP_ERR_NO_MEM, fail, TAG, "no mem");
|
|
|
+ ctx->partition = data_partition;
|
|
|
+ ctx->by_label = (partition_label != NULL);
|
|
|
+ ctx->pdrv = pdrv;
|
|
|
+ ctx->fs = fs;
|
|
|
+ ctx->wlhandle = *wl_handle;
|
|
|
+ memcpy(&ctx->mount_config, mount_config, sizeof(esp_vfs_fat_mount_config_t));
|
|
|
+ ctx_id = s_get_unused_context_id();
|
|
|
+ //At this stage, we should always get a free context, otherwise program should return already
|
|
|
+ assert (ctx_id != FF_VOLUMES);
|
|
|
+ s_ctx[ctx_id] = ctx;
|
|
|
+
|
|
|
return ESP_OK;
|
|
|
|
|
|
fail:
|
|
|
- free(workbuf);
|
|
|
esp_vfs_fat_unregister_path(base_path);
|
|
|
ff_diskio_unregister(pdrv);
|
|
|
+ if (ctx_id != FF_VOLUMES) {
|
|
|
+ s_ctx[ctx_id] = NULL;
|
|
|
+ }
|
|
|
+ free(ctx);
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
@@ -104,36 +184,80 @@ esp_err_t esp_vfs_fat_spiflash_unmount_rw_wl(const char* base_path, wl_handle_t
|
|
|
// release partition driver
|
|
|
esp_err_t err_drv = wl_unmount(wl_handle);
|
|
|
esp_err_t err = esp_vfs_fat_unregister_path(base_path);
|
|
|
- if (err == ESP_OK) err = err_drv;
|
|
|
+ if (err == ESP_OK) {
|
|
|
+ err = err_drv;
|
|
|
+ }
|
|
|
+
|
|
|
+ uint32_t id = FF_VOLUMES;
|
|
|
+ s_get_context_id_by_wl_handle(wl_handle, &id);
|
|
|
+ free(s_ctx[id]);
|
|
|
+ s_ctx[id] = NULL;
|
|
|
+
|
|
|
return err;
|
|
|
}
|
|
|
|
|
|
-// esp_err_t esp_vfs_fat_spiflash_format_rw_wl(const char* base_path,const char* partition_label, wl_handle_t wl_handle)
|
|
|
-// {
|
|
|
-// esp_err_t err = ESP_FAIL;
|
|
|
-// BYTE pdrv = ff_diskio_get_pdrv_wl(wl_handle);
|
|
|
-// if (pdrv != 0xff) {
|
|
|
-// ESP_LOGD(TAG, "handle ID: pdrv", pdrv);
|
|
|
-// err = esp_vfs_fat_spiflash_unmount_rw_wl(base_path, wl_handle);
|
|
|
-// if (err != ESP_OK) {
|
|
|
-// ESP_LOGE(TAG, "unmounting fail");
|
|
|
-// return err;
|
|
|
-// }
|
|
|
-// }
|
|
|
-
|
|
|
-// const esp_partition_t *partition = esp_partition_find_first(ESP_PARTITION_TYPE_DATA,
|
|
|
-// ESP_PARTITION_SUBTYPE_DATA_FAT,
|
|
|
-// partition_label);
|
|
|
-// if (!partition) {
|
|
|
-// ESP_LOGE(TAG, "Failed to find FATFS partition (type='data', subtype='fat', partition_label='%s'). Check the partition table.", partition_label);
|
|
|
-// return ESP_ERR_NOT_FOUND;
|
|
|
-// }
|
|
|
-// err = esp_partition_erase_range(partition, 0, partition->size);
|
|
|
-// if (err != ESP_OK) {
|
|
|
-
|
|
|
-// }
|
|
|
-
|
|
|
-// }
|
|
|
+esp_err_t esp_vfs_fat_spiflash_format_rw_wl(const char* base_path, const char* partition_label)
|
|
|
+{
|
|
|
+ esp_err_t ret = ESP_OK;
|
|
|
+ bool partition_was_mounted = false;
|
|
|
+
|
|
|
+ wl_handle_t temp_handle = WL_INVALID_HANDLE;
|
|
|
+ uint32_t id = FF_VOLUMES;
|
|
|
+ char drv[3] = {0, ':', 0};
|
|
|
+
|
|
|
+ bool found = s_get_context_id_by_label(partition_label, &id);
|
|
|
+ if (!found) {
|
|
|
+ const esp_vfs_fat_mount_config_t mount_config = {
|
|
|
+ .max_files = 1,
|
|
|
+ .format_if_mount_failed = true,
|
|
|
+ };
|
|
|
+ ESP_RETURN_ON_ERROR(esp_vfs_fat_spiflash_mount_rw_wl(base_path, partition_label, &mount_config, &temp_handle), TAG, "Failed to mount");
|
|
|
+ found = s_get_context_id_by_label(partition_label, &id);
|
|
|
+ assert(found);
|
|
|
+ } else {
|
|
|
+ partition_was_mounted = true;
|
|
|
+ }
|
|
|
+
|
|
|
+ //unmount
|
|
|
+ drv[1] = (char)('0' + s_ctx[id]->pdrv);
|
|
|
+ f_mount(0, drv, 0);
|
|
|
+
|
|
|
+ const size_t workbuf_size = 4096;
|
|
|
+ void *workbuf = ff_memalloc(workbuf_size);
|
|
|
+ if (workbuf == NULL) {
|
|
|
+ ret = ESP_ERR_NO_MEM;
|
|
|
+ goto mount_back;
|
|
|
+ }
|
|
|
+ size_t alloc_unit_size = esp_vfs_fat_get_allocation_unit_size(CONFIG_WL_SECTOR_SIZE, s_ctx[id]->mount_config.allocation_unit_size);
|
|
|
+ ESP_LOGI(TAG, "Formatting FATFS partition, allocation unit size=%d", alloc_unit_size);
|
|
|
+ const MKFS_PARM opt = {(BYTE)(FM_ANY | FM_SFD), 0, 0, 0, alloc_unit_size};
|
|
|
+ FRESULT fresult = f_mkfs(drv, &opt, workbuf, workbuf_size);
|
|
|
+ free(workbuf);
|
|
|
+ workbuf = NULL;
|
|
|
+ ESP_GOTO_ON_FALSE(fresult == FR_OK, ESP_FAIL, mount_back, TAG, "f_mkfs failed (%d)", fresult);
|
|
|
+
|
|
|
+mount_back:
|
|
|
+ if (partition_was_mounted) {
|
|
|
+ esp_err_t err = s_f_mount_rw(s_ctx[id]->fs, drv, &s_ctx[id]->mount_config);
|
|
|
+ if (err != ESP_OK) {
|
|
|
+ ESP_LOGE(TAG, "failed to mount back, go to recycle");
|
|
|
+ goto recycle;
|
|
|
+ }
|
|
|
+ } else {
|
|
|
+ esp_vfs_fat_spiflash_unmount_rw_wl(base_path, s_ctx[id]->wlhandle);
|
|
|
+ }
|
|
|
+ return ret;
|
|
|
+
|
|
|
+recycle:
|
|
|
+ ff_diskio_unregister(s_ctx[id]->pdrv);
|
|
|
+ ff_diskio_clear_pdrv_wl(s_ctx[id]->wlhandle);
|
|
|
+ wl_unmount(s_ctx[id]->wlhandle);
|
|
|
+ esp_vfs_fat_unregister_path(base_path);
|
|
|
+ free(s_ctx[id]);
|
|
|
+ s_ctx[id] = NULL;
|
|
|
+ ESP_LOGE(TAG, "failed to format, resources recycled, please mount again");
|
|
|
+ return ret;
|
|
|
+}
|
|
|
|
|
|
|
|
|
esp_err_t esp_vfs_fat_spiflash_mount_ro(const char* base_path,
|
|
|
@@ -196,7 +320,6 @@ esp_err_t esp_vfs_fat_spiflash_unmount_ro(const char* base_path, const char* par
|
|
|
return err;
|
|
|
}
|
|
|
|
|
|
-
|
|
|
esp_err_t esp_vfs_fat_spiflash_mount(const char* base_path,
|
|
|
const char* partition_label,
|
|
|
const esp_vfs_fat_mount_config_t* mount_config,
|