Changeset 313 for trunk/hal/tsar_mips32/core/hal_remote.c

Timestamp:

Aug 2, 2017, 3:24:57 PM (7 years ago)

Author:

alain

Message:

RSeveral modifs in the page-fault handling.

File:

• trunk/hal/tsar_mips32/core/hal_remote.c (modified) (1 diff)

trunk/hal/tsar_mips32/core/hal_remote.c

@@ -447 +447 @@
 
 } // end hal_remote_strcpy()
+
+////////////////////////////////////////
+void hal_remote_memset( xptr_t   buf_xp,
+                        uint8_t  byte,
+                        uint32_t size )
+{
+    uint32_t save_sr;
+        uint32_t i;
+        uint32_t wsize;
+    uint32_t buf_ptr = (uint32_t)GET_PTR( buf_xp );
+    uint32_t buf_cxy = (uint32_t)GET_CXY( buf_xp );
+    uint32_t word    = ((uint32_t)byte)<<24 |
+                       ((uint32_t)byte)<<16 |
+                       ((uint32_t)byte)<<8  |
+                       ((uint32_t)byte)     ;
+
+    hal_disable_irq( &save_sr );
+
+        if( (buf_ptr & 0x3) ) wsize = 0;  // do it all in bytes
+    else                  wsize = size >> 2;
+
+        for( i = 0 ; i < wsize ; i++ )          // transfer one word per iteration
+        {
+        asm volatile( 
+            ".set noreorder              \n"
+            "mfc2   $15,    $24          \n"  /* $15 <= PADDR_EXT     */ 
+            "mtc2   %0,     $24          \n"  /* PADDR_EXT <= buf_cxy */   
+            "sw     %2,     0(%1)        \n"  /* set one word         */
+            "mtc2   $15,    $24          \n"  /* PADDR_EXT <= $15     */   
+            ".set reorder                \n"
+                    : : "r"(buf_cxy), "r" (buf_ptr+(i<<2)), "r"(byte) : "$15" );                
+        }
+
+        for( i = wsize << 2 ; i < size ; i++ )  // transfer one byte per iteration
+        {
+        asm volatile( 
+            ".set noreorder              \n"
+            "mfc2   $15,    $24          \n"  /* $15 <= PADDR_EXT     */ 
+            "mtc2   %0,     $24          \n"  /* PADDR_EXT <= buf_cxy */   
+            "sb     %2,     0(%1)        \n"  /* set one byte         */
+            "mtc2   $15,    $24          \n"  /* PADDR_EXT <= $15     */   
+            ".set reorder                \n"
+                    : : "r"(buf_cxy), "r"(buf_ptr+i), "r"(word) : "$15" );              
+        }
+
+    hal_restore_irq( save_sr );
+
+}  // end hal_remote_memset()
+