cpu/sh2/sh2.c

   1 #include <string.h>
   2 #include "sh2.h"
   3
   4 #define I 0xf0
   5
   6 void sh2_init(SH2 *sh2, int is_slave)
   7 {
   8         memset(sh2, 0, sizeof(*sh2));
   9         sh2->is_slave = is_slave;
  10 }
  11
  12 void sh2_reset(SH2 *sh2)
  13 {
  14         sh2->pc = p32x_sh2_read32(0, sh2->is_slave);
  15         sh2->r[15] = p32x_sh2_read32(4, sh2->is_slave);
  16         sh2->sr = I;
  17         sh2->vbr = 0;
  18         sh2->pending_int_irq = 0;
  19 }
  20
  21 static void sh2_do_irq(SH2 *sh2, int level, int vector)
  22 {
  23         sh2->irq_callback(sh2->is_slave, level);
  24
  25         sh2->r[15] -= 4;
  26         p32x_sh2_write32(sh2->r[15], sh2->sr, sh2->is_slave);   /* push SR onto stack */
  27         sh2->r[15] -= 4;
  28         p32x_sh2_write32(sh2->r[15], sh2->pc, sh2->is_slave);   /* push PC onto stack */
  29
  30         /* set I flags in SR */
  31         sh2->sr = (sh2->sr & ~I) | (level << 4);
  32
  33         /* fetch PC */
  34         sh2->pc = p32x_sh2_read32(sh2->vbr + vector * 4, sh2->is_slave);
  35
  36         /* 13 cycles at best */
  37         sh2->cycles_done += 13;
  38 //      sh2->icount -= 13;
  39 }
  40
  41 void sh2_irl_irq(SH2 *sh2, int level)
  42 {
  43         sh2->pending_irl = level;
  44         if (level <= ((sh2->sr >> 4) & 0x0f))
  45                 return;
  46
  47         sh2_do_irq(sh2, level, 64 + level/2);
  48 }
  49
  50 void sh2_internal_irq(SH2 *sh2, int level, int vector)
  51 {
  52         sh2->pending_int_irq = level;
  53         sh2->pending_int_vector = vector;
  54         if (level <= ((sh2->sr >> 4) & 0x0f))
  55                 return;
  56
  57         sh2_do_irq(sh2, level, vector);
  58         sh2->pending_int_irq = 0; // auto-clear
  59 }
  60