Changeset 703 for trunk/softs/tsar_boot

Timestamp:

May 26, 2014, 12:06:18 PM (10 years ago)

Author:

cfuguet

Message:

tsar_boot:

• Improvement of memset function. When buffer not word aligned, write first bytes in a byte basis and then, write remaining bytes using 4 byte words.

File:

• trunk/softs/tsar_boot/src/reset_utils.c (modified) (3 diffs)

trunk/softs/tsar_boot/src/reset_utils.c

@@ -120 +120 @@
     unsigned int *dst = _dst;
     const unsigned int *src = _src;
-    if ( !((unsigned int)dst & 3) && !((unsigned int)src & 3) )
-    {
-        while (n > 3) 
-        {
+    if (!((unsigned int)dst & 3) && !((unsigned int)src & 3)) {
+        while (n > 3) {
             *dst++ = *src++;
             n -= 4;
@@ -131 +129 @@
     unsigned char *cdst = (unsigned char*) dst;
     unsigned char *csrc = (unsigned char*) src;
-    while (n--) 
-    {
+    while (n--) {
         *cdst++ = *csrc++;
     }
@@ -153 +150 @@
 
     unsigned char val = (unsigned char) c;
+
+    /*
+     * Set not word aligned bytes at start of destination buffer
+     */
+    unsigned char* cdst = (unsigned char*) _dst;
+    while (((addr_t)cdst & 3) && len--) {
+        *cdst++ = val;
+    }
+
+    /*
+     * Set 4 bytes words on destination buffer
+     */
     unsigned int word = (val << 24) | (val << 16) | (val << 8 ) | val;
-
-    /*
-     * Write 4 bytes when destination buffer is aligned to 4 bytes
-     * and size is greater or equal to 4 
-     */
-    unsigned int *dst = _dst;
-    if ( !((unsigned int)dst & 3) )
-    {
-        while (len > 3) 
-        {
-            *dst++ = word;
-            len -= 4;
-        }
-    }
-
-    /*
-     * Write 1 byte when destination buffer is not aligned to 4 bytes
-     * or size is smaller than 4 
-     */
-    unsigned char* cdst = (unsigned char*) _dst;
-    while(len--)
-    {
-        *cdst++ = (unsigned char) c;
-    }
-
+    addr_t *wdst = (addr_t*)cdst;
+    while (len > 3) {
+        *wdst++ = word;
+        len -= 4;
+    }
+
+    /*
+     * Set not word aligned bytes at end of destination buffer
+     */
+    cdst = (unsigned char*) wdst;
+    while(len--) {
+        *cdst++ = val;
+    }
     return _dst;
 }