feat: config manager

2026-05-05 01:17:15 +08:00
parent 572d017ec5
commit fb8624b61b
9 changed files with 263 additions and 15 deletions
@@ -0,0 +1,110 @@
+//
+// Created by awalol on 2026/5/4.
+//
+
+#include "config.h"
+
+#include <cmath>
+#include <cstring>
+
+#include "utils.h"
+#include "hardware/flash.h"
+#include "hardware/sync.h"
+
+constexpr uint32_t CONFIG_MAGIC = 0x66ccff00;
+constexpr uint16_t CONFIG_VERSION = 1;
+constexpr uint32_t CONFIG_FLASH_OFFSET = PICO_FLASH_SIZE_BYTES - FLASH_SECTOR_SIZE;
+static Config config{};
+
+// 编译期保护
+// 判断Config结构体是否能放进flash 256bytes
+static_assert(sizeof(Config) <= FLASH_PAGE_SIZE);
+// 配置区起始地址必须按 flash sector 对齐。
+static_assert(CONFIG_FLASH_OFFSET % FLASH_SECTOR_SIZE == 0);
+
+uint32_t calc_config_crc(const Config &con) {
+    return crc32(reinterpret_cast<const uint8_t *>(&con.body), sizeof(Config_body));
+}
+
+const Config *flash_config() {
+    return reinterpret_cast<const Config *>(XIP_BASE + CONFIG_FLASH_OFFSET);
+}
+
+void config_valid() {
+    // valid config and set default value
+    if (config.magic != CONFIG_MAGIC) {
+        config.magic = CONFIG_MAGIC;
+        printf("[Config] Config Magic Header is invalid\n");
+    }
+    if (config.version != CONFIG_VERSION) {
+        config.version = CONFIG_VERSION;
+        printf("[Config] Config Version is invalid\n");
+    }
+    if (config.size != sizeof(Config_body)) {
+        config.size = sizeof(Config_body);
+        printf("[Config] Config Body size is invalid\n");
+    }
+    auto body = &config.body;
+    if (std::isnan(body->haptics_gain) || body->haptics_gain < 1.0f || body->haptics_gain > 2.0f) {
+        body->haptics_gain = 1.0f;
+        printf("[Config] Haptics Gain value is invalid\n");
+    }
+    if (std::isnan(body->speaker_volume) || body->speaker_volume < 1.0f || body->speaker_volume > 2.0f) {
+        body->speaker_volume = 2.0f;
+        printf("[Config] Speaker Volume is invalid\n");
+    }
+    if (body->disable_inactive_disconnect > 1) {
+        body->disable_inactive_disconnect = 0;
+        printf("[Config] disable_auto_disconnect is invalid\n");
+    }
+    if (body->disable_pico_led > 1) {
+        body->disable_pico_led = 0;
+        printf("[Config] disable_pico_led is invalid\n");
+    }
+    if (body->polling_rate_mode > 2) {
+        body->polling_rate_mode = 0;
+        printf("[Config] polling_rate_mode is invalid\n");
+    }
+    if (body->haptics_buffer_length < 16 || body->haptics_buffer_length > 255) {
+        body->haptics_buffer_length = 48;
+        printf("[Config] haptics_buffer_length is invalid\n");
+    }
+}
+
+void config_load() {
+    memcpy(&config, flash_config(), sizeof(Config));
+
+    config_valid();
+}
+
+bool config_save() {
+    config.crc32 = calc_config_crc(config);
+    alignas(4) uint8_t page[FLASH_PAGE_SIZE];
+    memset(page, 0xff, sizeof(page));
+    memcpy(page, &config, sizeof(Config));
+
+    const uint32_t interrupts = save_and_disable_interrupts();
+    flash_range_erase(CONFIG_FLASH_OFFSET, FLASH_SECTOR_SIZE);
+    flash_range_program(CONFIG_FLASH_OFFSET, page, sizeof(page));
+    restore_interrupts(interrupts);
+
+    Config verify{};
+    memcpy(&verify, flash_config(), sizeof(verify));
+    const auto verify_crc32 = calc_config_crc(verify);
+    if (verify_crc32 == config.crc32) {
+        printf("[Config] Config write flash verify success\n");
+        return true;
+    }
+    printf("[Config] Config write flash verify failed\n");
+    return false;
+}
+
+const Config_body& get_config() {
+    return config.body;
+}
+
+void set_config(const uint8_t *new_config, const uint16_t len) {
+    const auto copy_len = len < sizeof(Config_body) ? len : sizeof(Config_body);
+    memcpy(&config.body, new_config, copy_len);
+    config_valid();
+}