From 493e61dfbccb7072c1dd1aaa74822c6eaa1cc91d Mon Sep 17 00:00:00 2001
From: Jeremy Soller <jeremy@system76.com>
Date: Mon, 17 Feb 2020 11:02:39 -0700
Subject: [PATCH] Add initial commands

---
 src/board/system76/lemp9/smfi.c | 67 +++++++++++++++++++++++++++++----
 1 file changed, 59 insertions(+), 8 deletions(-)

diff --git a/src/board/system76/lemp9/smfi.c b/src/board/system76/lemp9/smfi.c
index 4149175..ac1590b 100644
--- a/src/board/system76/lemp9/smfi.c
+++ b/src/board/system76/lemp9/smfi.c
@@ -1,15 +1,39 @@
 #include <stdint.h>
+#include <stdio.h>
+#include <string.h>
 
 #include <common/macro.h>
+#include <common/version.h>
 
+// Shared memory host semaphore
+volatile uint8_t __xdata __at(0x1022) SMHSR;
+// Host RAM window control
 volatile uint8_t __xdata __at(0x105A) HRAMWC;
+// Host RAM window 0 base address
 volatile uint8_t __xdata __at(0x105B) HRAMW0BA;
+// Host RAM window 1 base address
 volatile uint8_t __xdata __at(0x105C) HRAMW1BA;
+// Host RAM window 0 access allow size
 volatile uint8_t __xdata __at(0x105D) HRAMW0AAS;
+// Host RAM window 1 access allow size
 volatile uint8_t __xdata __at(0x105E) HRAMW1AAS;
 
-volatile uint8_t __xdata __at(0xC00) smfi_cmd[256];
-volatile uint8_t __xdata __at(0xD00) smfi_dbg[256];
+static volatile uint8_t __xdata __at(0xC00) smfi_cmd[256];
+static volatile uint8_t __xdata __at(0xD00) smfi_dbg[256];
+
+enum SmfiCmd {
+    SMFI_CMD_NONE = 0,
+    SMFI_CMD_PROBE = 1,
+    SMFI_CMD_BOARD = 2,
+    SMFI_CMD_VERSION = 3,
+    //TODO
+};
+
+enum SmfiRes {
+    SMFI_RES_OK = 0,
+    SMFI_RES_ERR = 1,
+    //TODO
+};
 
 void smfi_init(void) {
     int i;
@@ -24,11 +48,6 @@ void smfi_init(void) {
         smfi_dbg[i] = 0x00;
     }
 
-    // Signature
-    smfi_cmd[1] = 0x76;
-    smfi_cmd[2] = 0xEC;
-    // Version
-    smfi_cmd[3] = 0x01;
 
     // H2RAM window 0 address 0xC00 - 0xCFF, read/write
     HRAMW0BA = 0xC0;
@@ -43,5 +62,37 @@ void smfi_init(void) {
 }
 
 void smfi_event(void) {
-    //TODO: when host semaphore occurs, read command
+    if (smfi_cmd[0]) {
+        // Default to success
+        smfi_cmd[1] = SMFI_RES_OK;
+
+        switch (smfi_cmd[0]) {
+            case SMFI_CMD_PROBE:
+                // Signature
+                smfi_cmd[2] = 0x76;
+                smfi_cmd[3] = 0xEC;
+                // Version
+                smfi_cmd[4] = 0x01;
+                break;
+            case SMFI_CMD_BOARD:
+                strncpy(&smfi_cmd[2], board(), ARRAY_SIZE(smfi_cmd) - 2);
+                break;
+            case SMFI_CMD_VERSION:
+                strncpy(&smfi_cmd[2], version(), ARRAY_SIZE(smfi_cmd) - 2);
+                break;
+        }
+
+        // Mark command as finished
+        smfi_cmd[0] = SMFI_CMD_NONE;
+    }
+
+    if (smfi_dbg[0]) {
+        int i;
+        for(i = 1; (i <= (int)smfi_dbg[0]) && (i < ARRAY_SIZE(smfi_dbg)); i++) {
+            putchar(smfi_dbg[i]);
+        }
+
+        // Mark debug transaction as complete
+        smfi_dbg[0] = 0;
+    }
 }