6c62131f |
1 | #include <stdio.h> |
2 | #include "../r3000a.h" |
3 | #include "../cdrom.h" |
4 | #include "../psxdma.h" |
5 | #include "../mdec.h" |
6 | #include "events.h" |
7 | |
8 | extern int pending_exception; |
9 | |
10 | //#define evprintf printf |
11 | #define evprintf(...) |
12 | |
13 | u32 event_cycles[PSXINT_COUNT]; |
14 | |
15 | void schedule_timeslice(void) |
16 | { |
17 | u32 i, c = psxRegs.cycle; |
18 | u32 irqs = psxRegs.interrupt; |
19 | s32 min, dif; |
20 | |
21 | min = PSXCLK; |
22 | for (i = 0; irqs != 0; i++, irqs >>= 1) { |
23 | if (!(irqs & 1)) |
24 | continue; |
25 | dif = event_cycles[i] - c; |
26 | //evprintf(" ev %d\n", dif); |
27 | if (0 < dif && dif < min) |
28 | min = dif; |
29 | } |
30 | next_interupt = c + min; |
31 | } |
32 | |
6c62131f |
33 | typedef void (irq_func)(); |
34 | |
35 | static irq_func * const irq_funcs[] = { |
36 | [PSXINT_SIO] = sioInterrupt, |
37 | [PSXINT_CDR] = cdrInterrupt, |
38 | [PSXINT_CDREAD] = cdrPlayReadInterrupt, |
39 | [PSXINT_GPUDMA] = gpuInterrupt, |
40 | [PSXINT_MDECOUTDMA] = mdec1Interrupt, |
41 | [PSXINT_SPUDMA] = spuInterrupt, |
42 | [PSXINT_MDECINDMA] = mdec0Interrupt, |
43 | [PSXINT_GPUOTCDMA] = gpuotcInterrupt, |
44 | [PSXINT_CDRDMA] = cdrDmaInterrupt, |
45 | [PSXINT_CDRLID] = cdrLidSeekInterrupt, |
d3d41455 |
46 | [PSXINT_IRQ10] = irq10Interrupt, |
6c62131f |
47 | [PSXINT_SPU_UPDATE] = spuUpdate, |
48 | [PSXINT_RCNT] = psxRcntUpdate, |
49 | }; |
50 | |
51 | /* local dupe of psxBranchTest, using event_cycles */ |
52 | static void irq_test(psxCP0Regs *cp0) |
53 | { |
54 | u32 cycle = psxRegs.cycle; |
55 | u32 irq, irq_bits; |
56 | |
57 | for (irq = 0, irq_bits = psxRegs.interrupt; irq_bits != 0; irq++, irq_bits >>= 1) { |
58 | if (!(irq_bits & 1)) |
59 | continue; |
60 | if ((s32)(cycle - event_cycles[irq]) >= 0) { |
61 | // note: irq_funcs() also modify psxRegs.interrupt |
62 | psxRegs.interrupt &= ~(1u << irq); |
63 | irq_funcs[irq](); |
64 | } |
65 | } |
66 | |
c41449cb |
67 | cp0->n.Cause &= ~0x400; |
68 | if (psxHu32(0x1070) & psxHu32(0x1074)) |
69 | cp0->n.Cause |= 0x400; |
70 | if (((cp0->n.Cause | 1) & cp0->n.SR & 0x401) == 0x401) { |
71 | psxException(0, 0, cp0); |
6c62131f |
72 | pending_exception = 1; |
73 | } |
74 | } |
75 | |
76 | void gen_interupt(psxCP0Regs *cp0) |
77 | { |
78 | evprintf(" +ge %08x, %u->%u (%d)\n", psxRegs.pc, psxRegs.cycle, |
79 | next_interupt, next_interupt - psxRegs.cycle); |
80 | |
81 | irq_test(cp0); |
82 | //pending_exception = 1; |
83 | |
84 | schedule_timeslice(); |
85 | |
86 | evprintf(" -ge %08x, %u->%u (%d)\n", psxRegs.pc, psxRegs.cycle, |
87 | next_interupt, next_interupt - psxRegs.cycle); |
88 | } |
89 | |
90 | |