Changeset 632 for soft

Timestamp:

Jul 18, 2015, 3:18:32 PM (9 years ago)

Author:

alain

Message:

Introduce two new atomic read-the-write functions, that can be used
to set or reset a bit field in a shared 32 bits word:

_atomic_or()
_atpmic_and()

Location:

soft/giet_vm/giet_common

Files:

• kernel_locks.c (modified) (2 diffs)
• kernel_locks.h (modified) (2 diffs)

soft/giet_vm/giet_common/kernel_locks.c

@@ -26 +26 @@
         "ll   $12,   0($10)            \n"   /* $12 <= *ptr              */
         "addu $13,   $11,    $12       \n"   /* $13 <= *ptr + increment  */
-        "sc   $13,   0($10)            \n"   /* M[ptr] <= new            */ 
+        "sc   $13,   0($10)            \n"   /* *ptr <= $12              */ 
         "beqz $13,   1234b             \n"   /* retry if failure         */
         "move %0,    $12               \n"   /* value <= *ptr if success */
@@ -34 +34 @@
 
     return value;
+}
+
+////////////////////////////////////
+void _atomic_or( unsigned int* ptr,
+                 unsigned int  mask )
+{
+    asm volatile (
+        "1789:                         \n"
+        "move $10,   %0                \n"   /* $10 <= ptr               */
+        "move $11,   %1                \n"   /* $11 <= mask              */
+        "ll   $12,   0($10)            \n"   /* $12 <= *ptr              */
+        "or   $12,   $11,    $12       \n"   /* $12 <= *ptr | mask       */
+        "sc   $12,   0($10)            \n"   /* *ptr <= $12              */ 
+        "beqz $12,   1789b             \n"   /* retry if failure         */
+        "nop                           \n"  
+        :
+        : "r" (ptr), "r" (mask)
+        : "$10", "$11", "$12", "memory" );
+}
+
+////////////////////////////////////
+void _atomic_and( unsigned int* ptr,
+                  unsigned int  mask )
+{
+    asm volatile (
+        "1945:                         \n"
+        "move $10,   %0                \n"   /* $10 <= ptr               */
+        "move $11,   %1                \n"   /* $11 <= mask              */
+        "ll   $12,   0($10)            \n"   /* $12 <= *ptr              */
+        "and  $12,   $11,    $12       \n"   /* $13 <= *ptr & mask       */
+        "sc   $12,   0($10)            \n"   /* *ptr <= new              */ 
+        "beqz $12,   1945b             \n"   /* retry if failure         */
+        "nop                           \n"  
+        :
+        : "r" (ptr), "r" (mask)
+        : "$10", "$11", "$12", "memory" );
 }
 

soft/giet_vm/giet_common/kernel_locks.h

@@ -13 +13 @@
 
 #include "hard_config.h"
+
+
+//////////////////////////////////////////////////////////////////////////////
+//      Atomic access functions using LL/SC instructions
+//////////////////////////////////////////////////////////////////////////////
+
+extern unsigned int _atomic_increment( unsigned int* ptr,
+                                       int  increment );
+
+extern void _atomic_or( unsigned int* ptr,
+                        unsigned int  mask );
+
+extern void _atomic_and( unsigned int* ptr,
+                         unsigned int  mask );
 
 //////////////////////////////////////////////////////////////////////////////
@@ -38 +52 @@
     unsigned int padding[14];    // for 64 bytes alignment
 } spin_lock_t;
-
-extern unsigned int _atomic_increment( unsigned int* ptr,
-                                       int  increment );
 
 extern void _spin_lock_init( spin_lock_t* lock );