mirror of
https://github.com/RaySollium99/picodrive.git
synced 2025-09-05 15:27:46 -04:00
f0d7b1faa1
git-svn-id: file:///home/notaz/opt/svn/PicoDrive@832 be3aeb3a-fb24-0410-a615-afba39da0efa
79 lines
1.5 KiB
C
79 lines
1.5 KiB
C
#include <string.h>
|
|
#include "sh2.h"
|
|
#include "compiler.h"
|
|
|
|
#define I 0xf0
|
|
|
|
SH2 *sh2; // active sh2
|
|
|
|
int sh2_init(SH2 *sh2, int is_slave)
|
|
{
|
|
int ret = 0;
|
|
|
|
memset(sh2, 0, sizeof(*sh2));
|
|
sh2->is_slave = is_slave;
|
|
#ifdef DRC_SH2
|
|
ret = sh2_drc_init(sh2);
|
|
#endif
|
|
return ret;
|
|
}
|
|
|
|
void sh2_finish(SH2 *sh2)
|
|
{
|
|
#ifdef DRC_SH2
|
|
sh2_drc_finish(sh2);
|
|
#endif
|
|
}
|
|
|
|
void sh2_reset(SH2 *sh2)
|
|
{
|
|
sh2->pc = p32x_sh2_read32(0, sh2);
|
|
sh2->r[15] = p32x_sh2_read32(4, sh2);
|
|
sh2->sr = I;
|
|
sh2->vbr = 0;
|
|
sh2->pending_int_irq = 0;
|
|
}
|
|
|
|
void sh2_do_irq(SH2 *sh2, int level, int vector)
|
|
{
|
|
sh2->irq_callback(sh2->is_slave, level);
|
|
|
|
sh2->r[15] -= 4;
|
|
p32x_sh2_write32(sh2->r[15], sh2->sr, sh2); /* push SR onto stack */
|
|
sh2->r[15] -= 4;
|
|
p32x_sh2_write32(sh2->r[15], sh2->pc, sh2); /* push PC onto stack */
|
|
|
|
/* set I flags in SR */
|
|
sh2->sr = (sh2->sr & ~I) | (level << 4);
|
|
|
|
/* fetch PC */
|
|
sh2->pc = p32x_sh2_read32(sh2->vbr + vector * 4, sh2);
|
|
|
|
/* 13 cycles at best */
|
|
sh2->cycles_done += 13;
|
|
// sh2->icount -= 13;
|
|
}
|
|
|
|
void sh2_irl_irq(SH2 *sh2, int level)
|
|
{
|
|
sh2->pending_irl = level;
|
|
if (level > sh2->pending_int_irq)
|
|
sh2->pending_level = level;
|
|
else
|
|
sh2->pending_level = sh2->pending_int_irq;
|
|
|
|
sh2->test_irq = 1;
|
|
}
|
|
|
|
void sh2_internal_irq(SH2 *sh2, int level, int vector)
|
|
{
|
|
// FIXME: multiple internal irqs not handled..
|
|
// assuming internal irqs never clear until accepted
|
|
sh2->pending_int_irq = level;
|
|
sh2->pending_int_vector = vector;
|
|
if (level > sh2->pending_level)
|
|
sh2->pending_level = level;
|
|
|
|
sh2->test_irq = 1;
|
|
}
|
|
|