// Copyright 2015-2016 Espressif Systems (Shanghai) PTE LTD // // Licensed under the Apache License, Version 2.0 (the "License"); // you may not use this file except in compliance with the License. // You may obtain a copy of the License at // http://www.apache.org/licenses/LICENSE-2.0 // // Unless required by applicable law or agreed to in writing, software // distributed under the License is distributed on an "AS IS" BASIS, // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. // See the License for the specific language governing permissions and // limitations under the License. #include #include "nvs.hpp" #include "nvs_flash.h" #include "nvs_storage.hpp" #include "intrusive_list.h" #include "nvs_platform.hpp" #include "esp_partition.h" #include "sdkconfig.h" #ifdef ESP_PLATFORM // Uncomment this line to force output from this module // #define LOG_LOCAL_LEVEL ESP_LOG_DEBUG #include "esp_log.h" static const char* TAG = "nvs"; #else #define ESP_LOGD(...) #endif class HandleEntry : public intrusive_list_node { static uint32_t s_nvs_next_handle; public: HandleEntry() {} HandleEntry(bool readOnly, uint8_t nsIndex, nvs::Storage* StoragePtr) : mHandle(++s_nvs_next_handle), // Begin the handle value with 1 mReadOnly(readOnly), mNsIndex(nsIndex), mStoragePtr(StoragePtr) { } nvs_handle mHandle; uint8_t mReadOnly; uint8_t mNsIndex; nvs::Storage* mStoragePtr; }; #ifdef ESP_PLATFORM SemaphoreHandle_t nvs::Lock::mSemaphore = NULL; #endif using namespace std; using namespace nvs; static intrusive_list s_nvs_handles; uint32_t HandleEntry::s_nvs_next_handle; static intrusive_list s_nvs_storage_list; static nvs::Storage* lookup_storage_from_name(const char *name) { auto it = find_if(begin(s_nvs_storage_list), end(s_nvs_storage_list), [=](Storage& e) -> bool { return (strcmp(e.getPartName(), name) == 0); }); if (it == end(s_nvs_storage_list)) { return NULL; } return it; } extern "C" void nvs_dump(const char *partName) { Lock lock; nvs::Storage* pStorage; pStorage = lookup_storage_from_name(partName); if (pStorage == NULL) { return; } pStorage->debugDump(); return; } extern "C" esp_err_t nvs_flash_init_custom(const char *partName, uint32_t baseSector, uint32_t sectorCount) { ESP_LOGD(TAG, "nvs_flash_init_custom partition=%s start=%d count=%d", partName, baseSector, sectorCount); nvs::Storage* mStorage; mStorage = lookup_storage_from_name(partName); if (mStorage == NULL) { mStorage = new nvs::Storage((const char *)partName); s_nvs_storage_list.push_back(mStorage); } return mStorage->init(baseSector, sectorCount); } #ifdef ESP_PLATFORM extern "C" esp_err_t nvs_flash_init_partition(const char *part_name) { Lock::init(); Lock lock; nvs::Storage* mStorage; mStorage = lookup_storage_from_name(NVS_DEFAULT_PART_NAME); if (mStorage) { return ESP_OK; } const esp_partition_t* partition = esp_partition_find_first( ESP_PARTITION_TYPE_DATA, ESP_PARTITION_SUBTYPE_DATA_NVS, part_name); if (partition == NULL) { return ESP_ERR_NOT_FOUND; } return nvs_flash_init_custom(part_name, partition->address / SPI_FLASH_SEC_SIZE, partition->size / SPI_FLASH_SEC_SIZE); } extern "C" esp_err_t nvs_flash_init(void) { return nvs_flash_init_partition(NVS_DEFAULT_PART_NAME); } extern "C" esp_err_t nvs_flash_erase_partition(const char *part_name) { const esp_partition_t* partition = esp_partition_find_first( ESP_PARTITION_TYPE_DATA, ESP_PARTITION_SUBTYPE_DATA_NVS, part_name); if (partition == NULL) { return ESP_ERR_NOT_FOUND; } return esp_partition_erase_range(partition, 0, partition->size); } extern "C" esp_err_t nvs_flash_erase() { return nvs_flash_erase_partition(NVS_DEFAULT_PART_NAME); } #endif static esp_err_t nvs_find_ns_handle(nvs_handle handle, HandleEntry& entry) { auto it = find_if(begin(s_nvs_handles), end(s_nvs_handles), [=](HandleEntry& e) -> bool { return e.mHandle == handle; }); if (it == end(s_nvs_handles)) { return ESP_ERR_NVS_INVALID_HANDLE; } entry = *it; return ESP_OK; } extern "C" esp_err_t nvs_open_from_partition(const char *part_name, const char* name, nvs_open_mode open_mode, nvs_handle *out_handle) { Lock lock; ESP_LOGD(TAG, "%s %s %d", __func__, name, open_mode); uint8_t nsIndex; nvs::Storage* sHandle; sHandle = lookup_storage_from_name(part_name); if (sHandle == NULL) { return ESP_ERR_NVS_PART_NOT_FOUND; } esp_err_t err = sHandle->createOrOpenNamespace(name, open_mode == NVS_READWRITE, nsIndex); if (err != ESP_OK) { return err; } HandleEntry *handle_entry = new HandleEntry(open_mode==NVS_READONLY, nsIndex, sHandle); s_nvs_handles.push_back(handle_entry); *out_handle = handle_entry->mHandle; return ESP_OK; } extern "C" esp_err_t nvs_open(const char* name, nvs_open_mode open_mode, nvs_handle *out_handle) { if (s_nvs_storage_list.size() == 0) { return ESP_ERR_NVS_NOT_INITIALIZED; } return nvs_open_from_partition(NVS_DEFAULT_PART_NAME, name, open_mode, out_handle); } extern "C" void nvs_close(nvs_handle handle) { Lock lock; ESP_LOGD(TAG, "%s %d", __func__, handle); auto it = find_if(begin(s_nvs_handles), end(s_nvs_handles), [=](HandleEntry& e) -> bool { return e.mHandle == handle; }); if (it == end(s_nvs_handles)) { return; } s_nvs_handles.erase(it); delete static_cast(it); } extern "C" esp_err_t nvs_erase_key(nvs_handle handle, const char* key) { Lock lock; ESP_LOGD(TAG, "%s %s\r\n", __func__, key); HandleEntry entry; auto err = nvs_find_ns_handle(handle, entry); if (err != ESP_OK) { return err; } if (entry.mReadOnly) { return ESP_ERR_NVS_READ_ONLY; } return entry.mStoragePtr->eraseItem(entry.mNsIndex, key); } extern "C" esp_err_t nvs_erase_all(nvs_handle handle) { Lock lock; ESP_LOGD(TAG, "%s\r\n", __func__); HandleEntry entry; auto err = nvs_find_ns_handle(handle, entry); if (err != ESP_OK) { return err; } if (entry.mReadOnly) { return ESP_ERR_NVS_READ_ONLY; } return entry.mStoragePtr->eraseNamespace(entry.mNsIndex); } template static esp_err_t nvs_set(nvs_handle handle, const char* key, T value) { Lock lock; ESP_LOGD(TAG, "%s %s %d %d", __func__, key, sizeof(T), (uint32_t) value); HandleEntry entry; auto err = nvs_find_ns_handle(handle, entry); if (err != ESP_OK) { return err; } if (entry.mReadOnly) { return ESP_ERR_NVS_READ_ONLY; } return entry.mStoragePtr->writeItem(entry.mNsIndex, key, value); } extern "C" esp_err_t nvs_set_i8 (nvs_handle handle, const char* key, int8_t value) { return nvs_set(handle, key, value); } extern "C" esp_err_t nvs_set_u8 (nvs_handle handle, const char* key, uint8_t value) { return nvs_set(handle, key, value); } extern "C" esp_err_t nvs_set_i16 (nvs_handle handle, const char* key, int16_t value) { return nvs_set(handle, key, value); } extern "C" esp_err_t nvs_set_u16 (nvs_handle handle, const char* key, uint16_t value) { return nvs_set(handle, key, value); } extern "C" esp_err_t nvs_set_i32 (nvs_handle handle, const char* key, int32_t value) { return nvs_set(handle, key, value); } extern "C" esp_err_t nvs_set_u32 (nvs_handle handle, const char* key, uint32_t value) { return nvs_set(handle, key, value); } extern "C" esp_err_t nvs_set_i64 (nvs_handle handle, const char* key, int64_t value) { return nvs_set(handle, key, value); } extern "C" esp_err_t nvs_set_u64 (nvs_handle handle, const char* key, uint64_t value) { return nvs_set(handle, key, value); } extern "C" esp_err_t nvs_commit(nvs_handle handle) { Lock lock; // no-op for now, to be used when intermediate cache is added HandleEntry entry; return nvs_find_ns_handle(handle, entry); } extern "C" esp_err_t nvs_set_str(nvs_handle handle, const char* key, const char* value) { Lock lock; ESP_LOGD(TAG, "%s %s %s", __func__, key, value); HandleEntry entry; auto err = nvs_find_ns_handle(handle, entry); if (err != ESP_OK) { return err; } return entry.mStoragePtr->writeItem(entry.mNsIndex, nvs::ItemType::SZ, key, value, strlen(value) + 1); } extern "C" esp_err_t nvs_set_blob(nvs_handle handle, const char* key, const void* value, size_t length) { Lock lock; ESP_LOGD(TAG, "%s %s %d", __func__, key, length); HandleEntry entry; auto err = nvs_find_ns_handle(handle, entry); if (err != ESP_OK) { return err; } return entry.mStoragePtr->writeItem(entry.mNsIndex, nvs::ItemType::BLOB, key, value, length); } template static esp_err_t nvs_get(nvs_handle handle, const char* key, T* out_value) { Lock lock; ESP_LOGD(TAG, "%s %s %d", __func__, key, sizeof(T)); HandleEntry entry; auto err = nvs_find_ns_handle(handle, entry); if (err != ESP_OK) { return err; } return entry.mStoragePtr->readItem(entry.mNsIndex, key, *out_value); } extern "C" esp_err_t nvs_get_i8 (nvs_handle handle, const char* key, int8_t* out_value) { return nvs_get(handle, key, out_value); } extern "C" esp_err_t nvs_get_u8 (nvs_handle handle, const char* key, uint8_t* out_value) { return nvs_get(handle, key, out_value); } extern "C" esp_err_t nvs_get_i16 (nvs_handle handle, const char* key, int16_t* out_value) { return nvs_get(handle, key, out_value); } extern "C" esp_err_t nvs_get_u16 (nvs_handle handle, const char* key, uint16_t* out_value) { return nvs_get(handle, key, out_value); } extern "C" esp_err_t nvs_get_i32 (nvs_handle handle, const char* key, int32_t* out_value) { return nvs_get(handle, key, out_value); } extern "C" esp_err_t nvs_get_u32 (nvs_handle handle, const char* key, uint32_t* out_value) { return nvs_get(handle, key, out_value); } extern "C" esp_err_t nvs_get_i64 (nvs_handle handle, const char* key, int64_t* out_value) { return nvs_get(handle, key, out_value); } extern "C" esp_err_t nvs_get_u64 (nvs_handle handle, const char* key, uint64_t* out_value) { return nvs_get(handle, key, out_value); } static esp_err_t nvs_get_str_or_blob(nvs_handle handle, nvs::ItemType type, const char* key, void* out_value, size_t* length) { Lock lock; ESP_LOGD(TAG, "%s %s", __func__, key); HandleEntry entry; auto err = nvs_find_ns_handle(handle, entry); if (err != ESP_OK) { return err; } size_t dataSize; err = entry.mStoragePtr->getItemDataSize(entry.mNsIndex, type, key, dataSize); if (err != ESP_OK) { return err; } if (length == nullptr) { return ESP_ERR_NVS_INVALID_LENGTH; } else if (out_value == nullptr) { *length = dataSize; return ESP_OK; } else if (*length < dataSize) { *length = dataSize; return ESP_ERR_NVS_INVALID_LENGTH; } else if (*length > dataSize) { *length = dataSize; } return entry.mStoragePtr->readItem(entry.mNsIndex, type, key, out_value, dataSize); } extern "C" esp_err_t nvs_get_str(nvs_handle handle, const char* key, char* out_value, size_t* length) { return nvs_get_str_or_blob(handle, nvs::ItemType::SZ, key, out_value, length); } extern "C" esp_err_t nvs_get_blob(nvs_handle handle, const char* key, void* out_value, size_t* length) { return nvs_get_str_or_blob(handle, nvs::ItemType::BLOB, key, out_value, length); }