addDevice completed

2020-12-17 16:42:59 +01:00
parent 056a9e9edc
commit 4d604935aa
1 changed files with 17 additions and 0 deletions
--- a/cube/User/Src/configCmds.c
+++ b/cube/User/Src/configCmds.c
@ -222,6 +222,23 @@ static bool addDeviceCmd(uint8_t argc, char **args) {
        }
    }

+    uint8_t index = getConfig()->numOfDeviceBlocks;
+    for (uint8_t i = 0; i < getConfig()->numOfDeviceBlocks; i++) {
+        t_deviceBlock tmpDeviceBlock;
+        eepromReadDeviceBlock(i, &tmpDeviceBlock);
+        if (tmpDeviceBlock.period == -1) {
+            index = i;
+            break;
+        }
+    }
+    eepromWriteDeviceBlock(index, &deviceBlock);
+    if (index == getConfig()->numOfDeviceBlocks) {
+        t_configBlock configBlock;
+        eepromReadConfigBlock(&configBlock);
+        configBlock.numOfDeviceBlocks += 1;
+        eepromWriteConfigBlock(&configBlock);
+    }
+
    return retCode;
 }