board/novacustom/v5.0tnx/board.c: add board ID defs

Signed-off-by: Michał Kopeć <[email protected]>
Dasharo · Sep 12, 2024 · 8ed4199 · 8ed4199
1 parent 3786c8c
commit 8ed4199
Show file tree

Hide file tree

Showing 2 changed files with 66 additions and 10 deletions.
diff --git a/src/board/novacustom/v540tnx/board.c b/src/board/novacustom/v540tnx/board.c
@@ -27,17 +27,45 @@ uint8_t board_id(void) {
     if (cached)
         return board_id;
 
-    // TODO
-
     int16_t id = adc_read_channel(7);
     if (id < 0) {
-        ERROR("Board ID error %ld, defaulting to V560TU\n", id);
+        ERROR("Board ID error %ld, defaulting to V54 GN20P\n", id);
+        board_id = 0;
+        goto exit;
+    }
+
+    if (id < 250) {
+        INFO("Board ID: V54 GN20P\n");
         board_id = 0;
         goto exit;
     }
 
-    INFO("Board ID: V540TU\n");
-    board_id = 1;
+    if (id < 800) {
+        INFO("Board ID: V56 GN20P\n");
+        board_id = 1;
+        goto exit;
+    }
+
+    if (id < 1800) {
+        INFO("Board ID: V54 GN21-X4/X2\n");
+        board_id = 2;
+        goto exit;
+    }
+
+    if (id < 2400) {
+        INFO("Board ID: V54 GN21-X6\n");
+        board_id = 3;
+        goto exit;
+    }
+
+    if (id < 2800) {
+        INFO("Board ID: V56 GN21-X4/X2\n");
+        board_id = 4;
+        goto exit;
+    }
+
+    INFO("Board ID: V56 GN21-X6\n");
+    board_id = 5;
 
 exit:
     cached = true;

diff --git a/src/board/novacustom/v560tnx/board.c b/src/board/novacustom/v560tnx/board.c
@@ -27,17 +27,45 @@ uint8_t board_id(void) {
     if (cached)
         return board_id;
 
-    // TODO
-
     int16_t id = adc_read_channel(7);
     if (id < 0) {
-        ERROR("Board ID error %ld, defaulting to V560TU\n", id);
+        ERROR("Board ID error %ld, defaulting to V54 GN20P\n", id);
+        board_id = 0;
+        goto exit;
+    }
+
+    if (id < 250) {
+        INFO("Board ID: V54 GN20P\n");
         board_id = 0;
         goto exit;
     }
 
-    INFO("Board ID: V540TU\n");
-    board_id = 1;
+    if (id < 800) {
+        INFO("Board ID: V56 GN20P\n");
+        board_id = 1;
+        goto exit;
+    }
+
+    if (id < 1800) {
+        INFO("Board ID: V54 GN21-X4/X2\n");
+        board_id = 2;
+        goto exit;
+    }
+
+    if (id < 2400) {
+        INFO("Board ID: V54 GN21-X6\n");
+        board_id = 3;
+        goto exit;
+    }
+
+    if (id < 2800) {
+        INFO("Board ID: V56 GN21-X4/X2\n");
+        board_id = 4;
+        goto exit;
+    }
+
+    INFO("Board ID: V56 GN21-X6\n");
+    board_id = 5;
 
 exit:
     cached = true;