unleashed-firmware/lib/toolbox/saved_struct.c

#include "saved_struct.h"
#include <furi.h>
#include <stdint.h>
#include <storage/storage.h>

#define SAVED_STRUCT_TAG    "SAVED_STRUCT"

typedef struct {
    uint8_t magic;
    uint8_t version;
    uint8_t checksum;
    uint8_t flags;
    uint32_t timestamp;
} SavedStructHeader;

bool saved_struct_save(const char* path,
                       void* data,
                       size_t size,
                       uint8_t magic,
                       uint8_t version) {
    furi_assert(path);
    furi_assert(data);
    furi_assert(size);
    SavedStructHeader header;

    FURI_LOG_I(SAVED_STRUCT_TAG, "Saving \"%s\"", path);

    // Store
    Storage* storage = furi_record_open("storage");
    File* file = storage_file_alloc(storage);
    bool result = true;
    bool saved = storage_file_open(file, path, FSAM_WRITE, FSOM_CREATE_ALWAYS);
    if(!saved) {
        FURI_LOG_E(
            SAVED_STRUCT_TAG,
            "Open failed \"%s\". Error: \'%s\'",
            path,
            storage_file_get_error_desc(file));
        result = false;
    }

    if(result) {
        // Calculate checksum
        uint8_t checksum = 0;
        uint8_t* source = data;
        for(size_t i = 0; i < size; i++) {
            checksum += source[i];
        }
        // Set header
        header.magic = magic;
        header.version = version;
        header.checksum = checksum;
        header.flags = 0;
        header.timestamp = 0;

        uint16_t bytes_count = storage_file_write(file, &header, sizeof(header));
        bytes_count += storage_file_write(file, data, size);

        if(bytes_count != (size + sizeof(header))) {
            FURI_LOG_E(
                SAVED_STRUCT_TAG,
                "Write failed \"%s\". Error: \'%s\'",
                path,
                storage_file_get_error_desc(file));
            result = false;
        }
    }

    storage_file_close(file);
    storage_file_free(file);
    furi_record_close("storage");
    return result;
}

bool saved_struct_load(const char* path,
                       void* data,
                       size_t size,
                       uint8_t magic,
                       uint8_t version) {
    FURI_LOG_I(SAVED_STRUCT_TAG, "Loading \"%s\"", path);

    SavedStructHeader header;

    uint8_t* data_read = furi_alloc(size);
    Storage* storage = furi_record_open("storage");
    File* file = storage_file_alloc(storage);
    bool result = true;
    bool loaded = storage_file_open(file, path, FSAM_READ, FSOM_OPEN_EXISTING);
    if (!loaded) {
        FURI_LOG_E(
            SAVED_STRUCT_TAG,
            "Failed to read \"%s\". Error: %s",
            path,
            storage_file_get_error_desc(file));
        result = false;
    }

    if (result) {
        uint16_t bytes_count = storage_file_read(file, &header, sizeof(SavedStructHeader));
        bytes_count += storage_file_read(file, data_read, size);

        if(bytes_count != (sizeof(SavedStructHeader) + size)) {
            FURI_LOG_E(SAVED_STRUCT_TAG, "Size mismatch of file \"%s\"", path);
            result = false;
        }
    }

    if(result && (header.magic != magic || header.version != version)) {
        FURI_LOG_E(
            SAVED_STRUCT_TAG,
            "Magic(%d != %d) or Version(%d != %d) mismatch of file \"%s\"",
            header.magic,
            magic,
            header.version,
            version,
            path);
        result = false;
    }

    if(result) {
        uint8_t checksum = 0;
        const uint8_t* source = (const uint8_t*)data_read;
        for(size_t i = 0; i < size; i++) {
            checksum += source[i];
        }

        if(header.checksum != checksum) {
            FURI_LOG_E(
                SAVED_STRUCT_TAG,
                "Checksum(%d != %d) mismatch of file \"%s\"",
                header.checksum,
                checksum,
                path);
            result = false;
        }
    }

    if (result) {
        memcpy(data, data_read, size);
    }

    storage_file_close(file);
    storage_file_free(file);
    furi_record_close("storage");
    free(data_read);

    return result;
}