Changeset 457 for trunk/hal/tsar_mips32/core/hal_switch.S

Timestamp:

Aug 2, 2018, 11:47:13 AM (6 years ago)

Author:

alain

Message:

This version modifies the exec syscall and fixes a large number of small bugs.
The version number has been updated (0.1)

File:

• trunk/hal/tsar_mips32/core/hal_switch.S (modified) (4 diffs)

trunk/hal/tsar_mips32/core/hal_switch.S

@@ -26 +26 @@
     .global  hal_do_cpu_switch
     .global  hal_do_cpu_save
+    .global  hal_do_cpu_restore
 
     .set     noat 
@@ -90 +91 @@
         sw      $27,  33*4($26)           /* save c2_mode to slot 33 */
 
+    sync                            
+
     /* restore new thread context */
  
@@ -144 +147 @@
         mtc2    $27,  $1                   /* restore c2_mode from slot 33 */
     mtc0        $26,  $12                  /* restore c0_sr from slot 34 */
-
-    sync                            
 
     jr      $31                        /* return to caller */
@@ -211 +212 @@
     nop
 
+#---------------------------------------------------------------------------------
+# The hal_do_cpu_restore()function makes the following assumption:
+# - register $4 contains a pointer on the target thread context.
+#---------------------------------------------------------------------------------
+hal_do_cpu_restore:
+
+    move    $26,  $4                  /* $26 <= &context */
+
+    lw      $27,   0*4($26)         
+    mtc0    $27,   $14                 /* restore C0_epc from slot 0 */
+
+    lw      $1,    1*4($26)         
+    lw      $2,    2*4($26)         
+    lw      $3,    3*4($26)         
+    lw      $4,    4*4($26)         
+    lw      $5,    5*4($26)         
+    lw      $6,    6*4($26)         
+    lw      $7,    7*4($26)         
+    lw      $8,    8*4($26)         
+    lw      $9,    9*4($26)         
+    lw      $10,  10*4($26)         
+    lw      $11,  11*4($26)         
+    lw      $12,  12*4($26)         
+    lw      $13,  13*4($26)         
+    lw      $14,  14*4($26)         
+    lw      $15,  15*4($26)         
+        lw      $16,  16*4($26)         
+        lw      $17,  17*4($26)         
+    lw      $18,  18*4($26)         
+    lw      $19,  19*4($26)         
+    lw      $20,  20*4($26)         
+    lw      $21,  21*4($26)         
+    lw      $22,  22*4($26)         
+    lw      $23,  23*4($26)         
+    lw      $24,  24*4($26)         
+    lw      $25,  25*4($26)         
+
+    lw      $27,  26*4($26)         
+    mthi    $27                        /* restore hi from slot 26 */
+    lw      $27,  27*4($26)         
+    mtlo    $27                        /* restore lo from slot 27 */
+
+        lw      $28,  28*4($26)         
+        lw      $29,  29*4($26)         
+        lw      $30,  30*4($26)         
+        lw      $31,  31*4($26)            /* restore ra from slot 31 */
+
+        lw      $27,  32*4($26)
+        mtc2    $27,  $0                   /* restore c2_ptpr from slot 32 */
+
+        lw      $27,  35*4($26)      
+    mtc0        $27,  $4, 2                /* restore c0_th from slot 35 */
+
+        lw      $27,  33*4($26)
+        lw      $26,  34*4($26)
+
+        mtc2    $27,  $1                   /* restore c2_mode from slot 33 */
+    mtc0        $26,  $12                  /* restore c0_sr from slot 34 */
+
+    jr      $31                        /* return to caller */
+    nop
+
         .set reorder                    
     .set at