Changeset 165 for soft/giet_vm/sys/common.c

Timestamp:

Jul 4, 2012, 2:51:18 PM (12 years ago)

Author:

alain

Message:

Introducing various modifications in kernel initialisation

File:

• soft/giet_vm/sys/common.c (modified) (4 diffs)

soft/giet_vm/sys/common.c

@@ -9 +9 @@
 ///////////////////////////////////////////////////////////////////////////////////
 
+#include <sys_handler.h>
 #include <common.h>
 #include <drivers.h>
 #include <stdarg.h>
+
+////////////////////////////////////////////////////////////////////////////
+// _get_lock()
+////////////////////////////////////////////////////////////////////////////
+inline void _get_lock( unsigned int* plock )
+{
+    register unsigned int  delay = (_proctime() & 0xF) << 4;
+
+    asm volatile (
+            "_lock_llsc:             \n"
+            "ll   $2,    0(%0)       \n" /* $2 <= _ioc_lock current value */
+            "bnez $2,    _lock_delay \n" /* delay if _ioc_lock already taken */
+            "li   $3,    1           \n" /* $3 <= argument for sc */
+            "sc   $3,    0(%0)       \n" /* try to set _ioc_lock */
+            "bnez $3,    _lock_ok    \n" /* exit if atomic */
+            "_lock_delay:            \n"
+            "move $4,    %1          \n" /* $4 <= delay */
+            "_lock_loop:             \n"
+            "addi $4,    $4,    -1   \n" /* $4 <= $4 - 1 */
+            "beqz $4,    _lock_loop  \n" /* test end delay */
+            "j           _lock_llsc  \n" /* retry */
+            "_lock_ok:               \n"
+            :
+            :"r"(plock), "r"(delay)
+            :"$2", "$3", "$4");
+}
+
+////////////////////////////////////////////////////////////////////////////
+// _release_lock()
+////////////////////////////////////////////////////////////////////////////
+inline void _release_lock( unsigned int* plock )
+{
+    *plock = 0;
+}
 
 ////////////////////////////////////////////////////////////////////////////
@@ -156 +191 @@
     return ret;
 }
+
 ///////////////////////////////////////////////////////////////////////////////////
 //      _it_mask()
@@ -163 +199 @@
 {
     asm volatile(
-            "mfc0  $2, $12     \n"
-            "ori   $2, $2, 1   \n"
-            "mtc0  $2, $12     \n"
-            ::: "$2"
+            "lui   $27,      0xFFFF   \n"
+            "ori   $27, $27, 0xFFFE   \n"
+            "mfc0  $26, $12           \n"
+            "and   $26, $26, $27      \n"
+            "mtc0  $26, $12           \n"
+            ::: "$26", "$27"
             );
 }
@@ -176 +214 @@
 {
     asm volatile(
-            "mfc0  $2, $12     \n"
-            "addi  $2, $2, -1  \n"
-            "mtc0  $2, $12     \n"
-            ::: "$2"
+            "mfc0  $26, $12      \n"
+            "ori   $26, $26, 1   \n"
+            "mtc0  $26, $12      \n"
+            ::: "$26"
             );
 }
+
 /////////////////////////////////////////////////////////////////////////////
 //      access functions to mapping_info data structure