Changeset 798 for soft/giet_vm/giet_kernel/giet.s

Timestamp:

Mar 2, 2016, 3:08:27 PM (8 years ago)

Author:

meunier

Message:

• Bug fixes in Rosenfeld

File:

• soft/giet_vm/giet_kernel/giet.s (modified) (1 diff)

soft/giet_vm/giet_kernel/giet.s

@@ -39 +39 @@
 _giet:
     mfc0    $27,    $13                 /* $27 <= Cause register */
-    la      $26,    _cause_vector       /* $26 <= _cause_vector */
-    andi    $27,    $27,    0x3c            /* $27 <= XCODE*4 */
-    addu    $26,    $26,    $27             /* $26 <= &_cause_vector[XCODE] */
-    lw      $26,    ($26)               /* $26 <=  _cause_vector[XCODE] */
-    jr      $26                         /* Jump to handler indexed by XCODE */
+    andi    $27,    $27,    0x3c        /* $27 <= XCODE*4 */
+    beq     $27,    $0,     do_jump     /* jump if interrupt */
+    addiu   $26,    $0,     0x20
+    beq     $27,    $26,    do_jump     /* jump if syscall */
+    /* Other exception: saving registers for future display */
+    addiu   $27,    $29,    -38*4
+    sw      $29,    (29*4)($27)
+    or      $29,    $27,    $0
+    
+    .set noat
+    sw      $1,     (1*4)($29)
+    .set at
+    sw      $2,     (2*4)($29)
+    sw      $3,     (3*4)($29)
+    sw      $4,     (4*4)($29)
+    sw      $5,     (5*4)($29)
+    sw      $6,     (6*4)($29)
+    sw      $7,     (7*4)($29)
+    sw      $8,     (8*4)($29)
+    sw      $9,     (9*4)($29)
+    sw      $10,    (10*4)($29)
+    sw      $11,    (11*4)($29)
+    sw      $12,    (12*4)($29)
+    sw      $13,    (13*4)($29)
+    sw      $14,    (14*4)($29)
+    sw      $15,    (15*4)($29)
+    sw      $24,    (24*4)($29)
+    sw      $25,    (25*4)($29)
+    sw      $16,    (16*4)($29)
+    mfc0    $16,    $14               /* Read EPC */
+    sw      $17,    (17*4)($29)
+    mfc0    $17,    $13               /* read CR (used later) */
+    sw      $18,    (18*4)($29)
+    mfc0    $18,    $12               /* Read current SR (used later) */
+    sw      $19,    (19*4)($29)
+    sw      $20,    (20*4)($29)
+    sw      $21,    (21*4)($29)
+    sw      $22,    (22*4)($29)
+    sw      $23,    (23*4)($29)
+    sw      $30,    (30*4)($29)
+    sw      $28,    (28*4)($29)
+    mflo    $14                       /* read LO */
+    mfhi    $15                       /* read HI */
+    sw      $31,    (31*4)($29)       /* save RA */
+    sw      $16,    (32*4)($29)       /* Save EPC */
+    sw      $17,    (33*4)($29)       /* Save CR */
+    sw      $18,    (34*4)($29)       /* Save SR */
+    sw      $14,    (35*4)($29)       /* save LO */
+    sw      $15,    (36*4)($29)       /* save HI */
+    or      $4,     $0, $27 
+    
+    
+do_jump:
+    mfc0    $27,    $13               /* $27 <= Cause register */
+    andi    $27,    $27,    0x3c      /* $27 <= XCODE*4 */
+    la      $26,    _cause_vector     /* $26 <= _cause_vector */
+    addu    $26,    $26,    $27       /* $26 <= &_cause_vector[XCODE] */
+    lw      $26,    0($26)            /* $26 <=  _cause_vector[XCODE] */
+    jr      $26                       /* Jump to handler indexed by XCODE */
 
     .endfunc