Refactor PHY to support more flexible and scalable architecture.

Signed-off-by: Pol Henarejos <pol.henarejos@cttc.es>

src/fs/phy.c

@@ -0,0 +1,99 @@
+/*
+ * This file is part of the Pico Keys SDK distribution (https://github.com/polhenarejos/pico-keys-sdk).
+ * Copyright (c) 2022 Pol Henarejos.
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, version 3.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include "pico_keys.h"
+#include "file.h"
+
+#ifndef ENABLE_EMULATION
+
+phy_data_t phy_data;
+
+int phy_serialize_data(const phy_data_t *phy, uint8_t *data, uint16_t *len) {
+    if (!phy || !data || !len) {
+        return CCID_ERR_NULL_PARAM;
+    }
+    uint8_t *p = data;
+    if (phy->vidpid_present) {
+        *p++ = PHY_VIDPID;
+        *p++ = phy->vidpid[1];
+        *p++ = phy->vidpid[0];
+        *p++ = phy->vidpid[3];
+        *p++ = phy->vidpid[2];
+    }
+    if (phy->led_gpio_present) {
+        *p++ = PHY_LED_GPIO;
+        *p++ = phy->led_gpio;
+    }
+    if (phy->led_brightness_present) {
+        *p++ = PHY_LED_BTNESS;
+        *p++ = phy->led_brightness;
+    }
+    *p++ = PHY_OPTS;
+    *p++ = phy->opts >> 8;
+    *p++ = phy->opts & 0xff;
+    *len = p - data;
+    return CCID_OK;
+}
+#include <stdio.h>
+int phy_unserialize_data(const uint8_t *data, uint16_t len, phy_data_t *phy) {
+    if (!phy || !data || !len) {
+        return CCID_ERR_NULL_PARAM;
+    }
+    memset(phy, 0, sizeof(phy_data_t));
+    const uint8_t *p = data;
+    while (p < data + len) {
+        printf("TAG %x\n",*p);
+        switch (*p++) {
+            case PHY_VIDPID:
+                memcpy(phy->vidpid, p, 4);
+                phy->vidpid[1] = *p++;
+                phy->vidpid[0] = *p++;
+                phy->vidpid[3] = *p++;
+                phy->vidpid[2] = *p++;
+                phy->vidpid_present = true;
+                break;
+            case PHY_LED_GPIO:
+                phy->led_gpio = *p++;
+                phy->led_gpio_present = true;
+                break;
+            case PHY_LED_BTNESS:
+                phy->led_brightness = *p++;
+                phy->led_brightness_present = true;
+                break;
+            case PHY_OPTS:
+                phy->opts = (*p << 8) | *(p + 1);
+                p += 2;
+                break;
+        }
+    }
+    return CCID_OK;
+}
+
+int phy_init() {
+    memset(&phy_data, 0, sizeof(phy_data_t));
+    if (file_has_data(ef_phy)) {
+        const uint8_t *data = file_get_data(ef_phy);
+        DEBUG_DATA(data, file_get_size(ef_phy));
+        int ret = phy_unserialize_data(data, file_get_size(ef_phy), &phy_data);
+        if (ret != CCID_OK) {
+            return ret;
+        }
+    }
+
+    return CCID_OK;
+}
+#endif