Update stage1 code to latest implimentation. Zero out bss during early init.

1 files changed, 25 insertions, 1 deletions

diff --git a/libs/NVRam/nvm.c b/libs/NVRam/nvm.c
index 9e69ecc..dbbad58 100644
--- a/libs/NVRam/nvm.c
+++ b/libs/NVRam/nvm.c
@@ -223,7 +223,7 @@ void NVRam_read(uint32_t address, uint32_t *buffer, size_t words)
 
 void NVRam_writeWord(uint32_t address, uint32_t data)
 {
-    if(data !=  NVRam_readWord(address))
+    if(data != NVRam_readWord(address))
     {
         // Only write if different.
 
@@ -240,12 +240,27 @@ void NVRam_writeWord(uint32_t address, uint32_t data)
 
 void NVRam_write(uint32_t address, uint32_t *buffer, size_t words)
 {
+#if 0
     if (!words)
     {
         // No bytes to read.
         return;
     }
 
+    // Reduce beginning of buffer until we find the first different work.
+    while(buffer[0] == NVRam_readWord(address))
+    {
+        address += 4;
+        buffer++;
+        words--;
+    }
+
+    // Trim words at end of buffer if they don't need to change.s
+    while(words && (buffer[words-1] == NVRam_readWord(address + (words-1)*4)))
+    {
+        words--;
+    }
+
     // First word.
     RegNVMCommand_t cmd;
     cmd.r32 = 0;
@@ -269,4 +284,13 @@ void NVRam_write(uint32_t address, uint32_t *buffer, size_t words)
         // If we have more than one word, clear the first bit.
         cmd.bits.First = 0;
     }
+#else
+    while (words)
+    {
+        NVRam_writeWord(address, *buffer);
+        buffer++;
+        words--;
+        address += 4;
+    }
+#endif
 }