From 4bfe981455ec87866aa4ff5fba03fc7f833ed049 Mon Sep 17 00:00:00 2001
From: Jeremy Soller <jeremy@system76.com>
Date: Mon, 17 Feb 2020 10:16:48 -0700
Subject: [PATCH] Clear SMFI regions and fix size of H2RAM window 1

---
 src/board/system76/lemp9/smfi.c | 18 +++++++++++++++---
 1 file changed, 15 insertions(+), 3 deletions(-)

diff --git a/src/board/system76/lemp9/smfi.c b/src/board/system76/lemp9/smfi.c
index 250db74..4149175 100644
--- a/src/board/system76/lemp9/smfi.c
+++ b/src/board/system76/lemp9/smfi.c
@@ -1,5 +1,7 @@
 #include <stdint.h>
 
+#include <common/macro.h>
+
 volatile uint8_t __xdata __at(0x105A) HRAMWC;
 volatile uint8_t __xdata __at(0x105B) HRAMW0BA;
 volatile uint8_t __xdata __at(0x105C) HRAMW1BA;
@@ -10,8 +12,18 @@ volatile uint8_t __xdata __at(0xC00) smfi_cmd[256];
 volatile uint8_t __xdata __at(0xD00) smfi_dbg[256];
 
 void smfi_init(void) {
-    // Semaphore
-    smfi_cmd[0] = 0x00;
+    int i;
+
+    // Clear command region
+    for (i = 0; i < ARRAY_SIZE(smfi_cmd); i++) {
+        smfi_cmd[i] = 0x00;
+    }
+
+    // Clear debug region
+    for (i = 0; i < ARRAY_SIZE(smfi_dbg); i++) {
+        smfi_dbg[i] = 0x00;
+    }
+
     // Signature
     smfi_cmd[1] = 0x76;
     smfi_cmd[2] = 0xEC;
@@ -24,7 +36,7 @@ void smfi_init(void) {
 
     // H2RAM window 1 address 0xD00 - 0xDFF, read/write
     HRAMW1BA = 0xD0;
-    HRAMW0AAS = 0x04;
+    HRAMW1AAS = 0x04;
 
     // Enable H2RAM window 0 and 1 using LPC I/O
     HRAMWC |= 0x13;